[363] | 1 | /*
|
---|
| 2 | * TOPPERS/JSP Kernel
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
| 4 | * Just Standard Profile Kernel
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 8 | *
|
---|
| 9 | * ä¸è¨èä½æ¨©è
|
---|
| 10 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãï¼Free Software Foundation
|
---|
| 11 | * ã«ãã£ã¦å
|
---|
| 12 | ¬è¡¨ããã¦ãã GNU General Public License ã® Version 2 ã«è¨
|
---|
| 13 | * è¿°ããã¦ããæ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§ã¢
|
---|
| 14 | * ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
---|
| 15 | å¸ï¼ä»¥ä¸ï¼
|
---|
| 16 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 17 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
| 18 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
| 19 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 20 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 21 | * ç¨ã§ããå½¢ã§åé
|
---|
| 22 | å¸ããå ´åã«ã¯ï¼åé
|
---|
| 23 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
| 24 | * è
|
---|
| 25 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
| 26 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 27 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 28 | * ç¨ã§ããªãå½¢ã§åé
|
---|
| 29 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
| 30 | * ã¨ï¼
|
---|
| 31 | * (a) åé
|
---|
| 32 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 33 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
| 34 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 35 | * (b) åé
|
---|
| 36 | å¸ã®å½¢æ
|
---|
| 37 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
| 38 | * å ±åãããã¨ï¼
|
---|
| 39 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
| 40 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 41 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 42 | 責ãããã¨ï¼
|
---|
| 43 | *
|
---|
| 44 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 45 | ã
|
---|
| 46 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ã
|
---|
| 47 | * å«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´
|
---|
| 48 | * æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
---|
| 49 | *
|
---|
| 50 | * @(#) $Id: cpu_config.c,v 1.15 2003/12/15 07:19:22 takayuki Exp $
|
---|
| 51 | */
|
---|
| 52 |
|
---|
| 53 |
|
---|
| 54 | /*
|
---|
| 55 | * ããã»ããµä¾åã¢ã¸ã¥ã¼ã«ï¼Windowsç¨ï¼
|
---|
| 56 | */
|
---|
| 57 | #include <cpu_rename.h>
|
---|
| 58 |
|
---|
| 59 | #include <s_services.h>
|
---|
| 60 |
|
---|
| 61 | #include "jsp_kernel.h"
|
---|
| 62 | #include "check.h"
|
---|
| 63 | #include "task.h"
|
---|
| 64 |
|
---|
| 65 | #include <hal_msg.h>
|
---|
| 66 |
|
---|
| 67 | volatile char CPUStatus = CPU_STAT_LOCK; //CPUç¶æ
|
---|
| 68 | ãã©ã°
|
---|
| 69 |
|
---|
| 70 | /*
|
---|
| 71 | * ã¿ã¹ã¯ãã£ã¹ãããã£
|
---|
| 72 | * ãã£ã¹ãããã£æ¬ä½ã¯primary_thread.cã«ãã
|
---|
| 73 | * ããã§ã¯ç®¡çã¹ã¬ããã«ãã£ã¹ãããä¾é ¼ãåºãã ã
|
---|
| 74 | */
|
---|
| 75 | void
|
---|
| 76 | dispatch()
|
---|
| 77 | {
|
---|
| 78 | LOG_DSP_ENTER_TSK(runtsk);
|
---|
| 79 | HALDispatchRequest();
|
---|
| 80 | }
|
---|
| 81 |
|
---|
| 82 | /* å²è¾¼ã¿ç¨ãã£ã¹ããã㣠(åºåãããã°æ
|
---|
| 83 | å ±ã®ã¿ãç°ãªã) */
|
---|
| 84 | void
|
---|
| 85 | idispatch()
|
---|
| 86 | {
|
---|
| 87 | LOG_DSP_ENTER_INT(runtsk);
|
---|
| 88 | HALDispatchRequest();
|
---|
| 89 | }
|
---|
| 90 |
|
---|
| 91 |
|
---|
| 92 | /*
|
---|
| 93 | * ç¾å¨ã®ã³ã³ããã¹ããæ¨ã¦ã¦ãã£ã¹ããã
|
---|
| 94 | * exit_and_dispatch ã¯ï¼CPUããã¯ç¶æ
|
---|
| 95 | ã§å¼ã³åºããªããã°ãªããªãï¼
|
---|
| 96 | *
|
---|
| 97 | * ç¾å¨å®è¡ä¸ã®ã¿ã¹ã¯ã®TCBãæå®ãã¦ç ´æ£ä¾é ¼ãç ´æ£å¾èªåçã«ãã£ã¹ãããã£ã¸ã
|
---|
| 98 | */
|
---|
| 99 | void
|
---|
| 100 | exit_and_dispatch()
|
---|
| 101 | {
|
---|
| 102 | HANDLE handle;
|
---|
| 103 |
|
---|
| 104 | HALDestroyRequest(runtsk);
|
---|
| 105 |
|
---|
| 106 | if((handle = (HANDLE)TlsGetValue(TLS_THREADHANDLE)) != NULL)
|
---|
| 107 | CloseHandle(handle);
|
---|
| 108 |
|
---|
| 109 | TlsFree(TLS_THREADHANDLE);
|
---|
| 110 | TlsFree(TLS_LOGMASK);
|
---|
| 111 |
|
---|
| 112 | ExitThread(0);
|
---|
| 113 | }
|
---|
| 114 |
|
---|
| 115 |
|
---|
| 116 | /*
|
---|
| 117 | * ããã»ããµä¾åã®åæå
|
---|
| 118 | */
|
---|
| 119 |
|
---|
| 120 | void
|
---|
| 121 | cpu_initialize()
|
---|
| 122 | {
|
---|
| 123 | kprintf(("cpu_initialize()\n"));
|
---|
| 124 |
|
---|
| 125 | /*
|
---|
| 126 | * å²è¾¼ã¿ã¨ãã¥ã¬ã¼ã¿ã®åæå
|
---|
| 127 | */
|
---|
| 128 | ini_int();
|
---|
| 129 |
|
---|
| 130 | /*
|
---|
| 131 | * æä¸ä½æ§é åä¾å¤ãã³ãã©ã®è¨å®
|
---|
| 132 | */
|
---|
| 133 | ini_exc();
|
---|
| 134 | }
|
---|
| 135 |
|
---|
| 136 | /*
|
---|
| 137 | * ããã»ããµä¾åã®çµäºå¦ç
|
---|
| 138 | */
|
---|
| 139 | void
|
---|
| 140 | cpu_terminate()
|
---|
| 141 | {
|
---|
| 142 | kprintf(("cpu_terminate()\n"));
|
---|
| 143 |
|
---|
| 144 | fin_int(); //å²è¾¼ã¿ã¨ãã¥ã¬ã¼ã¿ã®åæ¢
|
---|
| 145 | fin_exc(); //æä¸ä½æ§é åä¾å¤ãã³ãã©ã®è§£é¤
|
---|
| 146 | }
|
---|
| 147 |
|
---|
| 148 |
|
---|
| 149 | /*
|
---|
| 150 | * ã¿ã¹ã¯èµ·åã«ã¼ãã³
|
---|
| 151 | *
|
---|
| 152 | */
|
---|
| 153 |
|
---|
| 154 | DWORD WINAPI
|
---|
| 155 | activate_r( LPVOID param)
|
---|
| 156 | {
|
---|
| 157 | TCB * tcb = (TCB *)param;
|
---|
| 158 |
|
---|
| 159 | TlsAlloc();
|
---|
| 160 | TlsSetValue(TLS_LOGMASK, 0);
|
---|
| 161 | TlsSetValue(TLS_THREADHANDLE, tcb->tskctxb.ThreadHandle);
|
---|
| 162 |
|
---|
| 163 | kprintf(("Task %d : activated\n", (tcb - tcb_table) + 1));
|
---|
| 164 |
|
---|
| 165 | (*(void(*)(VP_INT))tcb->tinib->task)(tcb->tinib->exinf);
|
---|
| 166 | ext_tsk();
|
---|
| 167 | return 0;
|
---|
| 168 | }
|
---|
| 169 |
|
---|
| 170 | /*
|
---|
| 171 | * atexitã§ç»é²ãããé¢æ°ã®èªåºã (Windowsã¯ä½ãããªã -> CRTã«ä»»ãã)
|
---|
| 172 | */
|
---|
| 173 | void call_atexit(void)
|
---|
| 174 | {}
|
---|
| 175 |
|
---|
| 176 |
|
---|
| 177 | /*
|
---|
| 178 | * è´å½çãªå¤±æã«å¯¾ãã対å¦ã«ã¼ãã³
|
---|
| 179 | */
|
---|
| 180 | void FatalAssertion(int exp, LPCSTR format, ...)
|
---|
| 181 | {
|
---|
| 182 | extern HANDLE PrimaryThreadHandle;
|
---|
| 183 | extern HANDLE CurrentRunningThreadHandle;
|
---|
| 184 |
|
---|
| 185 | if(!exp)
|
---|
| 186 | {
|
---|
| 187 | va_list vl;
|
---|
| 188 | char buffer[1024];
|
---|
| 189 |
|
---|
| 190 | /* ã¨ã©ã¼ãèµ·ããåå ãçªãæ¢ãã */
|
---|
| 191 | wsprintf(buffer, "Critical assertion fail occured !!\nGetLastError = 0x%08x\n\n", GetLastError());
|
---|
| 192 |
|
---|
| 193 | /* ã«ã¼ãã«ãåãåºãã¦ããã... */
|
---|
| 194 | if(PrimaryThreadHandle != NULL)
|
---|
| 195 | {
|
---|
| 196 | /* ã«ã¼ãã«ã®å®è¡ãæ¢ãã */
|
---|
| 197 | dis_int(0);
|
---|
| 198 | if(CurrentRunningThreadHandle != NULL)
|
---|
| 199 | SuspendThread(CurrentRunningThreadHandle);
|
---|
| 200 | hw_timer_terminate();
|
---|
| 201 | }
|
---|
| 202 |
|
---|
| 203 | /* è¦å表示 */
|
---|
| 204 | va_start(vl, format);
|
---|
| 205 | wvsprintf(buffer + lstrlen(buffer), format, vl);
|
---|
| 206 | MessageBox(PrimaryDialogHandle, buffer, "Assertion Failed", MB_OK|MB_ICONERROR);
|
---|
| 207 |
|
---|
| 208 | /* ã«ã¼ãã«åæ¢ */
|
---|
| 209 | HALQuitRequest();
|
---|
| 210 | }
|
---|
| 211 | }
|
---|
| 212 |
|
---|
| 213 | /*
|
---|
| 214 | * ãã°åºåãã©ããããã®å¶å¾¡
|
---|
| 215 | */
|
---|
| 216 | void set_logcontrol(BOOL enable)
|
---|
| 217 | {
|
---|
| 218 | BOOL result;
|
---|
| 219 | result = TlsSetValue(TLS_LOGMASK, (LPVOID)(enable == TRUE ? 0 : 1));
|
---|
| 220 | if(result == 0)
|
---|
| 221 | {
|
---|
| 222 | TlsAlloc();
|
---|
| 223 | TlsSetValue(TLS_LOGMASK, (LPVOID)(enable == TRUE ? 0 : 1));
|
---|
| 224 | }
|
---|
| 225 | }
|
---|
| 226 |
|
---|
| 227 | /*
|
---|
| 228 | * ã«ã¼ãã«ã®ãããã°ç¨printf
|
---|
| 229 | */
|
---|
| 230 | void _kernel_debugprintf(const char * format, ... )
|
---|
| 231 | {
|
---|
| 232 | va_list vl;
|
---|
| 233 | int words;
|
---|
| 234 | DWORD count;
|
---|
| 235 | char buffer[1024];
|
---|
| 236 |
|
---|
| 237 | va_start(vl, format);
|
---|
| 238 | words = wvsprintf(buffer, format, vl);
|
---|
| 239 |
|
---|
| 240 | if(words != 0)
|
---|
| 241 | WriteFile(GetStdHandle(STD_OUTPUT_HANDLE), buffer, words, &count, NULL);
|
---|
| 242 | }
|
---|
| 243 |
|
---|
| 244 | #ifdef _MSC_VER //cygwinã®å ´åã¯cpu_insn.Sã«è¨è¿°
|
---|
| 245 |
|
---|
| 246 | /*
|
---|
| 247 | * ã¿ã¹ã¯ä¾å¤èµ·åã«ã¼ãã³
|
---|
| 248 | * ã³ã³ããã¹ããä¸è´ãããããã
|
---|
| 249 | * ã¿ã¹ã¯ä¾å¤ãåãããã¿ã¹ã¯ã®ã¹ã¬ããä¸ã§åä½ãããããã®ã«ã¼ãã³
|
---|
| 250 | */
|
---|
| 251 | void __declspec(naked) TaskExceptionPerformer(void)
|
---|
| 252 | {
|
---|
| 253 | /* ã¬ã¸ã¹ã¿éé¿ */
|
---|
| 254 | __asm pusha
|
---|
| 255 | __asm sub esp, FPU_CONTEXTSIZE
|
---|
| 256 | __asm fsave [esp]
|
---|
| 257 |
|
---|
| 258 | /* ã¿ã¹ã¯ä¾å¤ã®èµ·å */
|
---|
| 259 | __asm call call_texrtn
|
---|
| 260 |
|
---|
| 261 | /* å²è¾¼ã¿ãã¹ã¯æ»ã */
|
---|
| 262 | __asm mov ebx, DWORD PTR runtsk
|
---|
| 263 | __asm mov eax, [ebx]TCB.tskctxb.InterruptLevel
|
---|
| 264 | __asm push eax
|
---|
| 265 | __asm call chg_ims
|
---|
| 266 | __asm add esp, 4
|
---|
| 267 |
|
---|
| 268 | /* ã¬ã¸ã¹ã¿å¾©å¸° */
|
---|
| 269 | __asm finit
|
---|
| 270 | __asm frstor [esp]
|
---|
| 271 | __asm add esp, FPU_CONTEXTSIZE
|
---|
| 272 | __asm popa
|
---|
| 273 | __asm ret
|
---|
| 274 | }
|
---|
| 275 |
|
---|
| 276 | #endif
|
---|
| 277 |
|
---|