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

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

initial

File size: 7.3 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-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2000-2003 by Industrial Technology Institute,
9 * Miyagi Prefectural Government, JAPAN
10 *
11 * 上記著作権者
12は,以下の (1)〜(4) の条件か,Free Software Foundation
13 * によってå…
14¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
15 * 述されている条件を満たす場合に限り,本ソフトウェア(本ソフトウェア
16 * を改変したものを含む.以下同じ)を使用・複製・改変・再é…
17å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
18 * 利用と呼ぶ)することを無償で許諾する.
19 * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
20 * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
21 * スコード中に含まれていること.
22 * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
23 * 用できる形で再é…
24å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
25å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
26 * 者
27マニュアルなど)に,上記の著作権表示,この利用条件および下記
28 * の無保証規定を掲載すること.
29 * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
30 * 用できない形で再é…
31å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
32 * と.
33 * (a) 再é…
34å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
35マニュアルなど)に,上記の著
36 * 作権表示,この利用条件および下記の無保証規定を掲載すること.
37 * (b) 再é…
38å¸ƒã®å½¢æ…
39‹ã‚’,別に定める方法によって,TOPPERSプロジェクトに
40 * 報告すること.
41 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
42 * 害からも,上記著作権者
43およびTOPPERSプロジェクトをå…
44è²¬ã™ã‚‹ã“と.
45 *
46 * 本ソフトウェアは,無保証で提供されているものである.上記著作権者
47お
48 * よびTOPPERSプロジェクトは,本ソフトウェアに関して,その適用可能性も
49 * 含めて,いかなる保証も行わない.また,本ソフトウェアの利用により直
50 * 接的または間接的に生じたいかなる損害に関しても,その責任を負わない.
51 */
52
53/*
54 * プロセッサ依存モジュール(MIPS3用)
55 */
56
57#include "jsp_kernel.h"
58#include "check.h"
59#include "task.h"
60
61/*
62 * 割込みハンドラ/割込みマスクの擬似テーブル
63 */
64INT_TABLE int_table[ TMAX_ALL_INTNO ];
65
66/*
67 * 例外ハンドラの擬似テーブル
68 */
69FP exc_table[ TMAX_CORE_EXCNO ];
70
71/*
72 * プロセッサ依存の初期化
73 */
74void cpu_initialize() {
75
76 int i;
77
78 /* 割込みハンドラ/割込みマスクの擬似テーブル初期化 */
79 for( i = 0; i < TMAX_ALL_INTNO; i++ ) {
80 define_inh( i, (FP) &cpu_experr );
81 }
82
83 /* 例外ベクタの擬似テーブル初期化 */
84 for( i = 0; i < TMAX_CORE_EXCNO; i++ ) {
85 define_exc( i, (FP) &cpu_experr );
86 }
87
88}
89
90/*
91 * プロセッサ依存の終了処理
92 */
93void cpu_terminate() {
94}
95
96/*
97 * 微少時間待
98ち
99 */
100void sil_dly_nse(UINT dlytim) {
101
102 /* $2 : v0, $3 : v1 */
103 Asm(" move $2, %0" :: "r"(dlytim) );
104 Asm(" li $3, %0" :: "g"(SIL_DLY_TIM1) );
105
106 Asm(" sub $2, $2, $3"); /* v0 -= v1 (dlytim -= SIL_DLY_TIM1) */
107 Asm(" blez $2, sil_dly_nse_2"); /* v0 <= 0 ならリターン */
108
109 Asm(" li $3, %0" :: "g"(SIL_DLY_TIM2) );
110
111 Asm("sil_dly_nse_1:");
112 Asm(" sub $2, $2, $3"); /* v0 -= v1 (dlytim -= SIL_DLY_TIM2) */
113 Asm(" bgtz $2, sil_dly_nse_1"); /* v0 > 0 ならループ */
114
115 Asm("sil_dly_nse_2:");
116}
117
118#ifdef SUPPORT_CHG_IPM
119
120/*
121 * 割込みマスクの変更
122 *
123 * 割込みマスクは、タスクディスパッチによって、新しく実行状æ…
124‹ã«ãªã£ãŸã‚¿ã‚¹ã‚¯ã«
125 * 引き継がれる。そのため、タスクが実行中に、別のタスクによって割込みマスクが
126 * 変更される場合がある。JSPカーネルでは、割込みマスクの変更はタスク例外処理
127 * ルーチンによっても起こるが、これによって扱いが難しくなる状況は少ないと思わ
128 * れる。割込みマスクの値によってタスクディスパッチを禁止したい場合には、
129 * dis_dsp を併用すればよい。
130 * MIPS3ターゲットでは、MIPS3コアの割込みマスクだけでなく、割込みコントローラ
131 * の割込みコントローラも扱っているので注意。
132 */
133
134SYSCALL ER chg_ipm(IPM ipm) {
135
136 ER ercd;
137
138 LOG_CHG_IPM_ENTER(ipm);
139 CHECK_TSKCTX_UNL();
140 CHECK_IPM(ipm);
141
142 t_lock_cpu();
143 cpu_set_ipm( ipm.core ); /* MIPS3コアの割込みマスクの設定 */
144 icu_set_ipm( &(ipm.icu) ); /* 外部割込みコントローラの割込みマスク
145 の設定 */
146 ercd = E_OK;
147 t_unlock_cpu();
148
149 exit:
150 LOG_CHG_IPM_LEAVE(ercd);
151 return(ercd);
152}
153
154/*
155 * 割込みマスクの参ç…
156§
157 */
158SYSCALL ER get_ipm(IPM *p_ipm) {
159
160 ER ercd;
161
162 LOG_GET_IPM_ENTER(p_ipm);
163 CHECK_TSKCTX_UNL();
164
165 t_lock_cpu();
166 p_ipm->core = cpu_get_ipm(); /* MIPS3コアの割込みマスク参ç…
167§ */
168 icu_get_ipm(&(p_ipm->icu)); /* 外部割込みコントローラの割込みマスク
169 の参ç…
170§ */
171 ercd = E_OK;
172 t_unlock_cpu();
173
174 exit:
175 LOG_GET_IPM_LEAVE(ercd, *p_ipm);
176 return(ercd);
177}
178
179#endif /* SUPPORT_CHG_IPM */
180
181/*============================================================================*/
182/* å…
183±é€šãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆã«ã¯ãªã„、独自の部分 */
184
185/*
186 * ハンドラが登録されていない割込み・例外が発生すると呼び出される
187 */
188void cpu_experr( EXCSTACK *sp, UW SR, UW CR) {
189
190 syslog_0(LOG_EMERG, "Interrupt/Exception error occurs.");
191
192 syslog_1(LOG_EMERG, "PC(EPC;CP0_r14) = 0x%08x",
193 sp->CP0_EPC);
194 syslog_2(LOG_EMERG, "SR(Status;CP0_r12) = 0x%08x CR(Cause;CP0_r13) = 0x%08x",
195 SR, CR); /* SRでも、sp->CP0_Statusでも可 */
196 syslog_3(LOG_EMERG, "at(r1 ) = %08x v0(r2 ) = %08x v1(r3 ) = %08x",
197 sp->at, sp->v0, sp->v1);
198 syslog_4(LOG_EMERG, "a0(r4 ) = %08x a1(r5 ) = %08x a2(r6 ) = %08x a3(r7 ) = %08x",
199 sp->a0, sp->a1, sp->a2, sp->a3);
200 syslog_4(LOG_EMERG, "t0(r8 ) = %08x t1(r9 ) = %08x t2(r10) = %08x t3(r11) = %08x",
201 sp->t0, sp->t1, sp->t2, sp->t3);
202 syslog_4(LOG_EMERG, "t4(r12) = %08x t5(r13) = %08x t6(r14) = %08x t7(r15) = %08x",
203 sp->t4, sp->t5, sp->t6, sp->t7);
204 syslog_2(LOG_EMERG, "t8(r24) = %08x t9(r25) = %08x",
205 sp->t8, sp->t9);
206 syslog_2(LOG_EMERG, "HI = %08x LO = %08x",
207 sp->hi, sp->lo);
208 syslog_4(LOG_EMERG, "gp(r28) = %08x sp(r29) = %08x fp(r30) = %08x ra(r31) = %08x",
209 sp->gp, sp->sp, sp->fp, sp->ra);
210 while(1);
211}
212
213/*
214 * メモリブロック操作ライブラリ(リンクスクリプト内
215で使用)
216 * (ItIsからの流用)
217 *
218 * 関数の仕様は,ANSI C ライブラリの仕様と同じ.標準ライブラリのものを
219 * 使った方が効率が良い可能性がある.
220 */
221VP _dummy_memcpy(VP dest, VP src, UINT len) {
222
223 VB *d = dest;
224 VB *s = src;
225
226 while (len-- > 0) {
227 *d++ = *s++;
228 }
229
230 return(dest);
231}
Note: See TracBrowser for help on using the repository browser.