primary_thread.c

JAPAN RTOS TOPPERS/JSP kernel 1.4 PreRelease simulation environment JSP kernel Windows simulation

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 * 
 *  忋婰挊嶌尃幰偼丆埲壓偺 (1)乣(4) 偺忦審偐丆Free Software Foundation 
 *  偵傛偭偰岞昞偝傟偰偄傞 GNU General Public License 偺 Version 2 偵婰
 *  弎偝傟偰偄傞忦審傪枮偨偡応崌偵尷傝丆杮僜僼僩僂僃傾乮杮僜僼僩僂僃傾
 *  傪夵曄偟偨傕偺傪娷傓丏埲壓摨偠乯傪巊梡丒暋惢丒夵曄丒嵞攝晍乮埲壓丆
 *  棙梡偲屇傇乯偡傞偙偲傪柍彏偱嫋戻偡傞丏
 *  (1) 杮僜僼僩僂僃傾傪僜乕僗僐乕僪偺宍偱棙梡偡傞応崌偵偼丆忋婰偺挊嶌
 *      尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕偑丆偦偺傑傑偺宍偱僜乕
 *      僗僐乕僪拞偵娷傑傟偰偄傞偙偲丏
 *  (2) 杮僜僼僩僂僃傾傪丆儔僀僽儔儕宍幃側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒傞宍偱嵞攝晍偡傞応崌偵偼丆嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡
 *      幰儅僯儏傾儖側偳乯偵丆忋婰偺挊嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰
 *      偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
 *  (3) 杮僜僼僩僂僃傾傪丆婡婍偵慻傒崬傓側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒側偄宍偱嵞攝晍偡傞応崌偵偼丆師偺偄偢傟偐偺忦審傪枮偨偡偙
 *      偲丏
 *    (a) 嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡幰儅僯儏傾儖側偳乯偵丆忋婰偺挊
 *        嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
 *    (b) 嵞攝晍偺宍懺傪丆暿偵掕傔傞曽朄偵傛偭偰丆TOPPERS僾儘僕僃僋僩偵
 *        曬崘偡傞偙偲丏
 *  (4) 杮僜僼僩僂僃傾偺棙梡偵傛傝捈愙揑傑偨偼娫愙揑偵惗偠傞偄偐側傞懝
 *      奞偐傜傕丆忋婰挊嶌尃幰偍傛傃TOPPERS僾儘僕僃僋僩傪柶愑偡傞偙偲丏
 * 
 *  杮僜僼僩僂僃傾偼丆柍曐徹偱採嫙偝傟偰偄傞傕偺偱偁傞丏忋婰挊嶌尃幰偍
 *  傛傃TOPPERS僾儘僕僃僋僩偼丆杮僜僼僩僂僃傾偵娭偟偰丆偦偺揔梡壜擻惈傕
 *  娷傔偰丆偄偐側傞曐徹傕峴傢側偄丏傑偨丆杮僜僼僩僂僃傾偺棙梡偵傛傝捈
 *  愙揑傑偨偼娫愙揑偵惗偠偨偄偐側傞懝奞偵娭偟偰傕丆偦偺愑擟傪晧傢側偄丏
 * 
 *  @(#) $Id: primary_thread.c,v 1.5 2003/07/30 09:30:42 takayuki Exp $
 */



#include "jsp_kernel.h"
#include "task.h"
#include "vwindows.h"
#include "hal_msg.h"
#include "hw_timer.h"
#include <objbase.h>
#include <shellapi.h>
#include "resource.h"
#include "eventlog.h"

#include "cpu_rename.h"

#ifndef _MSC_VER
	#error "Visual C++ is needed for performing compilation of TOPPERS/JSP Windows"
#endif

#define FPU_CONTEXTSIZE 108

struct tagDestructionProcedureQueue
{
	struct tagDestructionProcedureQueue * Next;
	void (*DestructionProcedure)(void *);
	void * Parameter;
};


 /*
  *   僾儘僩僞僀僾愰尵
  */
extern void kernel_start();
extern void kernel_exit();

extern void _cdecl InitializeComSupportModule(void);
extern void _cdecl FinalizeComSupportModule(void);

 /*
  *   戝堟曄悢
  */
HINSTANCE ProcessInstance;
HANDLE    PrimaryThreadHandle;
HWND      PrimaryDialogHandle;
HANDLE    CurrentRunningThreadHandle;
BOOL      ShutdownPostponementRequest;

static HANDLE WorkerThreadHandle = INVALID_HANDLE_VALUE;
static struct tagDestructionProcedureQueue * DestructionProcedureQueue;

 /*
  * 僇乕僱儖僗僞乕僞
  *   kernel_start偼嵟屻偵exit_and_dispatch傪屇傇偺偱丄僐儞僥僉僗僩攋婞偵
  *   旛偊偰怴偟偄僗儗僢僪傪惗惉偡傞丅
  */

static DWORD WINAPI
KernelStarter(LPVOID param)
{
	kernel_start();
	return 0;
}

 /*
  * 僞僗僋椺奜婲摦儖乕僠儞
  *   僐儞僥僉僗僩傪堦抳偝偣傞偨傔丄
  *   僞僗僋椺奜傪摦偐偟偨僞僗僋偺僗儗僢僪忋偱摦嶌偝偣傞偨傔偺儖乕僠儞
  */
void __declspec(naked) TaskExceptionPerformer(void)
{
		/* 儗僕僗僞戅旔 */
	__asm	pusha
	__asm	sub		esp, FPU_CONTEXTSIZE
	__asm	fsave	[esp]

		/* 僞僗僋椺奜偺婲摦 */
	__asm	call	call_texrtn

		/* 妱崬傒儅僗僋栠偟 */
	__asm	mov		ebx, DWORD PTR runtsk
	__asm	mov		eax, [ebx]TCB.tskctxb.InterruptLevel
	__asm	push	eax
	__asm	call	chg_ims
	__asm	add		esp, 4

		/* 儗僕僗僞暅婣 */
	__asm	finit
	__asm	frstor	[esp]
	__asm	add		esp, FPU_CONTEXTSIZE
	__asm	popa
	__asm	ret
}


 /*
  * 嫮惂幷抐儖乕僠儞
  *   墳摎傪曉偝側偄僆僽僕僃僋僩攋婞僾儘僔僕儍懳嶔
  */
DWORD WINAPI
ForceShutdownHandler(LPVOID param)
{
	do {
		ShutdownPostponementRequest = FALSE;
		Sleep(5000);
	} while(ShutdownPostponementRequest == TRUE);
	ExitProcess(0);
	return 0;
}

 /*
  * 僨僶僢僌帪梡僟僀傾儘僌偺儊僢僙乕僕僴儞僪儔
  */
Inline LRESULT CALLBACK
PrimaryDialogCommandHandler(WPARAM wParam, LPARAM lParam)
{
	static BOOL lock_flag;

	switch(wParam)
	{
			/* 乽僋儘僢僋偺嫙媼傪掆巭偡傞乿儃僞儞 */
		case IDC_CLOCKSUPPLY:
		{
			int state;

			state = SendDlgItemMessage(PrimaryDialogHandle, IDC_CLOCKSUPPLY,BM_GETCHECK,0,0);
			switch(state)
			{
					/* 僋儘僢僋掆巭 -> 僋儘僢僋傪巭傔傞 and 崱摦偄偰偄傞僗儗僢僪傪嫮惂掆巭 */
			case BST_CHECKED:
				if((lock_flag = sense_lock()) != TRUE)
					dis_int(0);
				hw_timer_terminate();
				if(CurrentRunningThreadHandle != INVALID_HANDLE_VALUE)
					SuspendThread(CurrentRunningThreadHandle);
				break;

					/* 僋儘僢僋嫙媼嵞奐 -> 嵟屻偵巭傔偨僗儗僢僪偺嵞奐 and 僋儘僢僋嫙媼嵞奐 */
			case BST_UNCHECKED:
				if(CurrentRunningThreadHandle != INVALID_HANDLE_VALUE)
					ResumeThread(CurrentRunningThreadHandle);
				hw_timer_initialize();
				if(lock_flag != TRUE)
					ena_int(0);
				break;
			}
			break;
		}

	default:
		return FALSE;
	}

	return TRUE;
}

	/*
	 * TOPPERS/JSP 僗儗僢僪儌僨儖 僇乕僱儖儊僢僙乕僕僴儞僪儔
	 */
Inline LRESULT CALLBACK
HALMessageHandler(WPARAM wParam,LPARAM lParam)
{
	switch(wParam)
	{
			/*
			 *乽僞僗僋傪攋婞偟偰偔偩偝偄乿儊僢僙乕僕 
			 *  lParam : 攋婞懳徾僞僗僋偺TCB偺傾僪儗僗
			 */
	case HALMSG_DESTROY:

		if(lParam == 0) 
		{

				/* 偄傑摦偄偰偄傞僗儗僢僪偑偁傞 */
			if(CurrentRunningThreadHandle != INVALID_HANDLE_VALUE)
			{
				TerminateThread(CurrentRunningThreadHandle,0);
				CloseHandle(CurrentRunningThreadHandle);
				if(runtsk != 0)
					runtsk->tskctxb.ThreadHandle = INVALID_HANDLE_VALUE;
			}
		}
		lParam = 0;
		CurrentRunningThreadHandle = INVALID_HANDLE_VALUE;
		runtsk = 0l;

			/*
			 *乽僞僗僋傪愗傝懼偊偰偔偩偝偄乿儊僢僙乕僕
			 *  lParam : 僨傿僗僷僢僠愭僞僗僋偺TCB傾僪儗僗
			 */
	case HALMSG_DISPATCH:
		{
			assert(lParam == 0);

				/* 偄傑摦偄偰偄傞僞僗僋偑偁傟偽丄偦傟傪巭傔傞 */
			if(CurrentRunningThreadHandle != INVALID_HANDLE_VALUE)
			{
				wait_for_thread_suspension_completion(CurrentRunningThreadHandle);

				if(runtsk != 0 && runtsk->tskctxb.ThreadHandle == CurrentRunningThreadHandle)
					vget_ims(&runtsk->tskctxb.InterruptLevel);
			}

				/*
				* 僞僗僋愗懼 
				*/
			if((runtsk = schedtsk) != 0l)
			{

				CurrentRunningThreadHandle = runtsk->tskctxb.ThreadHandle;

					/* 僞僗僋椺奜偑偍偙偭偨傜 */
				if (runtsk->enatex && runtsk->texptn != 0) 
				{
						/* 僞僗僋椺奜婲摦儖乕僠儞傊偲嵎偟懼偊傞 */
					CONTEXT context;
					context.ContextFlags = CONTEXT_FULL;
					GetThreadContext(CurrentRunningThreadHandle,&context);
					*(DWORD *)(context.Esp -= 4) = context.Eip;
					context.Eip = (DWORD)TaskExceptionPerformer;
					SetThreadContext(CurrentRunningThreadHandle,&context);
				}else
					chg_ims(runtsk->tskctxb.InterruptLevel);
				
				LOG_DSP_LEAVE(runtsk);
				ResumeThread(runtsk->tskctxb.ThreadHandle);
			}else
			{
					/* 摦偐偡傕偺偑側偄 */