source: anotherchoice/tags/jsp-1.4.4-full-UTF8/config/sh2/cpu_config.c@ 26

Last change on this file since 26 was 26, checked in by ykominami, 10 years ago

initial

File size: 9.0 KB
Line 
1/*
2 * TOPPERS/JSP Kernel
3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Just Standard Profile Kernel
5 *
6 * Copyright (C) 2000-2004 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2001-2004 by Industrial Technology Institute,
9 * Miyagi Prefectural Government, JAPAN
10 * Copyright (C) 2002-2004 by Hokkaido Industrial Research Institute, JAPAN
11 *
12 * 上記著作権者
13は,以下の (1)〜(4) の条件か,Free Software Foundation
14 * によってå…
15¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
16 * 述されている条件を満たす場合に限り,本ソフトウェア(本ソフトウェア
17 * を改変したものを含む.以下同じ)を使用・複製・改変・再é…
18å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
19 * 利用と呼ぶ)することを無償で許諾する.
20 * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
21 * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
22 * スコード中に含まれていること.
23 * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
24 * 用できる形で再é…
25å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
26å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
27 * 者
28マニュアルなど)に,上記の著作権表示,この利用条件および下記
29 * の無保証規定を掲載すること.
30 * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
31 * 用できない形で再é…
32å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
33 * と.
34 * (a) 再é…
35å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
36マニュアルなど)に,上記の著
37 * 作権表示,この利用条件および下記の無保証規定を掲載すること.
38 * (b) 再é…
39å¸ƒã®å½¢æ…
40‹ã‚’,別に定める方法によって,TOPPERSプロジェクトに
41 * 報告すること.
42 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
43 * 害からも,上記著作権者
44およびTOPPERSプロジェクトをå…
45è²¬ã™ã‚‹ã“と.
46 *
47 * 本ソフトウェアは,無保証で提供されているものである.上記著作権者
48お
49 * よびTOPPERSプロジェクトは,本ソフトウェアに関して,その適用可能性も
50 * 含めて,いかなる保証も行わない.また,本ソフトウェアの利用により直
51 * 接的または間接的に生じたいかなる損害に関しても,その責任を負わない.
52 *
53 * @(#) $Id: cpu_config.c,v 1.5 2005/07/06 00:45:07 honda Exp $
54 */
55
56/*
57 * プロセッサ依存モジュール(SH2用)
58 *     カーネル内
59部で使用する定義
60 *      C言語関数の実体
61 */
62
63#include "jsp_kernel.h"
64#include "check.h"
65#include "task.h"
66#include <sh2.h>
67#include <sil.h>
68
69/*
70 * タスクコンテキストでの割込みマスク
71 */
72#ifdef SUPPORT_CHG_IPM
73UW task_intmask;
74#endif /* SUPPORT_CHG_IPM */
75
76/*
77 * 非タスクコンテキストでの割込みマスク
78 */
79UW int_intmask;
80
81/*
82 * 割込み/CPU例外ネストカウンタ
83 */
84UW intnest;
85
86/*
87 * オリジナルのベクタベースレジスタの保存領域
88 */
89#ifdef KERNEL_HAS_A_VECTOR_TABLE
90static VP org_vbr;
91#endif /* KERNEL_HAS_A_VECTOR_TABLE */
92
93#ifdef SUPPORT_CPU_EXC_ENTRY_CHECK
94
95/*
96 * CPU例外の要因数
97 */
98#ifndef NUM_EXC
99#define NUM_EXC (6 + 2)
100#endif /* NUM_EXC */
101
102/*
103 * 登録されたCPU例外の要因数
104 */
105static UW num_exc;
106
107/*
108 * CPU例外のå…
109¥å£å‡¦ç†ã®å…
110ˆé ­ã‚¢ãƒ‰ãƒ¬ã‚¹
111 */
112static FP exc_entries[NUM_EXC];
113
114#endif /* SUPPORT_CPU_EXC_ENTRY_CHECK */
115
116/*
117 * プロセッサ依存の初期化
118 */
119void
120cpu_initialize()
121{
122 /*
123 * タスクコンテキストでの割込みマスクの初期化
124 */
125#ifdef SUPPORT_CHG_IPM
126 task_intmask = 0x0000u;
127#endif /* SUPPORT_CHG_IPM */
128
129 /*
130 * 割込み/CPU例外ネストカウンタの初期化
131 */
132 intnest = 1u;
133
134#ifndef GDB_STUB
135
136 /*
137 * 割り込みコントローラの初期化
138 */
139 sh2_init_intcontorller ();
140
141#endif /* GDB_STUB */
142
143#ifdef KERNEL_HAS_A_VECTOR_TABLE
144 /*
145 * ベクタテーブルは初期値付き変数(é…
146åˆ—)にしたので、
147 * スタートアップルーチンでdataセクションをコピーする際に
148 * 初期化される。
149 * (ここで初期化する必
150要はない。)
151 */
152
153 /*
154 * ベクタベースレジスタの初期化
155 */
156 org_vbr = current_vbr();
157 set_vbr((VP)vector_table);
158#endif /* KERNEL_HAS_A_VECTOR_TABLE */
159
160#ifdef SUPPORT_CPU_EXC_ENTRY_CHECK
161 num_exc = 0;
162#endif /* SUPPORT_CPU_EXC_ENTRY_CHECK */
163
164}
165
166/*
167 * プロセッサ依存の終了処理
168 */
169void
170cpu_terminate()
171{
172#ifdef KERNEL_HAS_A_VECTOR_TABLE
173 set_vbr(org_vbr);
174#endif /* KERNEL_HAS_A_VECTOR_TABLE */
175}
176
177/*
178 * CPU例外ハンドラの設定
179 *
180 * ベクトル番号 excno のCPU例外ハンドラの起動番地を exchdr に設定する.
181 */
182void
183define_exc(EXCNO excno, FP exchdr)
184{
185 /* SH1は割込みもCPU例外も同じ形式 */
186 define_inh((INHNO)excno, exchdr);
187
188#ifdef SUPPORT_CPU_EXC_ENTRY_CHECK
189// CHECK_PAR(num_exc < NUM_EXC);
190 exc_entries[num_exc++] = exchdr;
191#endif /* SUPPORT_CPU_EXC_ENTRY_CHECK */
192}
193
194#ifdef SUPPORT_CPU_EXC_ENTRY_CHECK
195/*
196 * CPU例外のå…
197¥å£å‡¦ç†ã§å‰²è¾¼ã¿ç¦æ­¢ã™ã‚‹ã¾ã§ã®å‘½ä»¤æ•°
198 */
199#define NUM_INST_DIS_INT 5
200
201
202/*
203 * 割込みからの戻りå…
204ˆã®ãƒã‚§ãƒƒã‚¯
205 *
206 *  引数
207 *   VP pc:スタック上に積まれた戻り番地
208 *  戻り値
209 *   TRUE:戻りå…
210ˆãŒCPU例外のå…
211¥å£å‡¦ç†ï¼ˆå‰²è¾¼ã¿ç¦æ­¢ã™ã‚‹å‰ï¼‰
212 *   FALSE:戻りå…
213ˆãŒä¸Šè¨˜ä»¥å¤–
214 *  備考
215 *   割込みの出口処理で割込み禁止で呼ばれる。
216 */
217
218/* cpu_support.Sのret_intだけから呼ばれるので */
219/* ヘッダーファイルには含めない。 */
220BOOL check_cpu_exc_entry(VP pc) throw();
221
222BOOL check_cpu_exc_entry(VP pc)
223{
224 UW i;
225 UH *entry; /* 2バイト長命令へのポインタ */
226
227 for(i = 0; i < num_exc; i++) {
228 entry = (UH *)exc_entries[i];
229 if (((UW)entry <= (UW)pc) &&
230 ((UW)pc <= (UW)(entry + NUM_INST_DIS_INT)) ) {
231 return TRUE;
232 }
233 }
234 return FALSE;
235}
236
237
238#endif /* SUPPORT_CPU_EXC_ENTRY_CHECK */
239
240
241
242#ifdef SUPPORT_CHG_IPM
243
244/*
245 * 割込みマスクの変更
246 *
247 * chg_ipm を使って IPM を0xf(NMI 以外のすべての割込みを禁止)に変更
248 * することはできない.NMI 以外のすべての割込みを禁止したい場合には,
249 * loc_cpu によりCPUロック状æ…
250‹ã«ã™ã‚Œã°ã‚ˆã„.
251 * IPM が 0 以外の時にも,タスクディスパッチは保留されない.IPM は,
252 * タスクディスパッチによって,新しく実行状æ…
253‹ã«ãªã£ãŸã‚¿ã‚¹ã‚¯ã¸å¼•ãç¶™ãŒ
254 * れる.そのため,タスクが実行中に,別のタスクによって IPM が変更さ
255 * れる場合がある.JSPカーネルでは,IPM の変更はタスク例外処理ルーチ
256 * ンによっても起こるが,これによって扱いが難しくなる状況は少ないと
257 * 思われる.IPM の値によってタスクディスパッチを禁止したい場合には,
258 * dis_dsp を併用すればよい.
259 */
260SYSCALL ER
261chg_ipm(IPM ipm)
262{
263 ER ercd;
264
265 LOG_CHG_IPM_ENTER(ipm);
266 CHECK_TSKCTX_UNL();
267 CHECK_PAR(0 <= ipm && ipm <= (MAX_IPM - 1) );
268
269 t_lock_cpu();
270 task_intmask = (ipm << 4);
271 ercd = E_OK;
272 t_unlock_cpu();
273
274 exit:
275 LOG_CHG_IPM_LEAVE(ercd);
276 return(ercd);
277}
278
279/*
280 * 割込みマスクの参ç…
281§
282 */
283SYSCALL ER
284get_ipm(IPM *p_ipm)
285{
286 ER ercd;
287
288 LOG_GET_IPM_ENTER(p_ipm);
289 CHECK_TSKCTX_UNL();
290
291 t_lock_cpu();
292 *p_ipm = (task_intmask >> 4);
293 ercd = E_OK;
294 t_unlock_cpu();
295
296 exit:
297 LOG_GET_IPM_LEAVE(ercd, *p_ipm);
298 return(ercd);
299}
300
301#endif /* SUPPORT_CHG_IPM */
302
303/*
304 * 登録されていない例外が発生すると呼び出される
305 */
306void cpu_experr(EXCSTACK *sp)
307{
308 syslog(LOG_EMERG, "Exception error occurs.");
309
310 syslog(LOG_EMERG, "PC = 0x%08x SR = 0x%08x PR = 0x%08x",
311 sp->pc, sp->sr, sp->pr);
312
313 syslog(LOG_EMERG, "r0 = 0x%08x r1 = 0x%08x r2 = 0x%08x",
314 sp->r0, sp->r1, sp->r2);
315 syslog(LOG_EMERG, "r3 = 0x%08x r4 = 0x%08x r5 = 0x%08x",
316 sp->r3, sp->r4, sp->r5);
317 syslog(LOG_EMERG, "r6 = 0x%08x r7 = 0x%08x r8 = 0x%08x",
318 sp->r6, sp->r7, sp->r8);
319 syslog(LOG_EMERG, "r9 = 0x%08x r10 = 0x%08x r11 = 0x%08x",
320 sp->r9, sp->r10, sp->r11);
321 syslog(LOG_EMERG, "r12 = 0x%08x r13 = 0x%08x r14 = 0x%08x",
322 sp->r12, sp->r13, sp->r14);
323 /* 例外発生直前のスタックポインタの値 */
324 syslog(LOG_EMERG, "r15 = 0x%08x", (sp->r15)+19*4);
325
326 while(1);
327}
328
329
330/*
331 * メモリブロック操作ライブラリ
332 * (ItIsからの流用)
333 *
334 * 関数の仕様は,ANSI C ライブラリの仕様と同じ.標準ライブラリのものを
335 * 使った方が効率が良い可能性がある.
336 *
337 */
338VP
339_dummy_memcpy(VP dest, VP src, UINT len)
340{
341 VB *d = (VB *)dest;
342 VB *s = (VB *)src;
343
344 while (len-- > 0) {
345 *d++ = *s++;
346 }
347 return(dest);
348}
349
Note: See TracBrowser for help on using the repository browser.