- Timestamp:
- May 22, 2019, 10:03:37 PM (5 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
azure_iot_hub/trunk/asp3_dcre/arch/rx630_gcc/prc_support.S
- Property svn:keywords deleted
-
Property svn:mime-type
changed from
text/plain
totext/plain;charset=UTF-8
r388 r389 12 12 ; Copyright (C) 2017 by Cores Co., Ltd. Japan 13 13 ; 14 ; ä¸è¨èä½æ¨©è 15 ã¯ï¼ä»¥ä¸ã®(1)ï½(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ 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 ããã³TOPPERSããã¸ã§ã¯ãã 48 ; å 49 責ãããã¨ï¼ 14 ; 上記著作権者は,以下の(1)~(4)の条件を満たす場合に限り,本ソフトウェ 15 ; ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改 16 ; 変・再配布(以下,利用と呼ぶ)することを無償で許諾する. 17 ; (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作 18 ; 権表示,この利用条件および下記の無保証規定が,そのままの形でソー 19 ; スコード中に含まれていること. 20 ; (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使 21 ; 用できる形で再配布する場合には,再配布に伴うドキュメント(利用 22 ; 者マニュアルなど)に,上記の著作権表示,この利用条件および下記 23 ; の無保証規定を掲載すること. 24 ; (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使 25 ; 用できない形で再配布する場合には,次のいずれかの条件を満たすこ 26 ; と. 27 ; (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著 28 ; 作権表示,この利用条件および下記の無保証規定を掲載すること. 29 ; (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに 30 ; 報告すること. 31 ; (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損 32 ; 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること. 33 ; また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理 34 ; 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを 35 ; 免責すること. 50 36 ; 51 ; æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è 52 ã 53 ; ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç 54 ; ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ 55 ; ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ã 56 ; ã®è²¬ä»»ãè² ããªãï¼ 37 ; 本ソフトウェアは,無保証で提供されているものである.上記著作権者お 38 ; よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的 39 ; に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ 40 ; アの利用により直接的または間接的に生じたいかなる損害に関しても,そ 41 ; の責任を負わない. 57 42 ; 58 43 ; @(#) $Id$ … … 60 45 61 46 ; 62 ; ããã»ããµä¾åã¢ã¸ã¥ã¼ã« ã¢ã»ã³ããªè¨èªé¨ï¼RX630ç¨ï¼47 ; プロセッサ依存モジュール アセンブリ言語部(RX630用) 63 48 ; 64 49 #define TOPPERS_MACRO_ONLY 65 #define UINT_C(val) (val) /* uint_t åã®å®æ°ãä½ããã¯ã*/66 #define ULONG_C(val) (val) /* ulong_t åã®å®æ°ãä½ããã¯ã*/67 #define CAST(type, val) (val) /* åãã£ã¹ããè¡ããã¯ã*/50 #define UINT_C(val) (val) /* uint_t型の定数を作るマクロ */ 51 #define ULONG_C(val) (val) /* ulong_t型の定数を作るマクロ */ 52 #define CAST(type, val) (val) /* 型キャストを行うマクロ */ 68 53 #include "kernel_impl.h" 69 54 70 55 ; 71 ; ãã£ã¹ãããã£ããã³å²è¾¼ã¿(CPUä¾å¤)åºå 72 ¥ãå£ã®ã«ã¼ã«: 73 ; åä½ã¢ã¼ãã以ä¸ã®ããã«å®ç¾©ãã. 74 ; ãã£ã¹ãããã£ã¢ã¼ã: 75 ; CPUããã¯ç¶æ 76 , å²è¾¼ã¿åªå 77 度ãã¹ã¯å 78 ¨è§£é¤ç¶æ 79 , 80 ; ã¿ã¹ã¯ã³ã³ããã¹ã(intnest = 0), ã¿ã¹ã¯ã¹ã¿ã㯠81 ; å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ã 82 ; å 83 ¨å²è¾¼ã¿ããã¯ç¶æ 84 (PSWã¬ã¸ã¹ã¿Iããã = 0), 85 ; å²è¾¼ã¿åªå 86 度ãã¹ã¯å 87 ¨è§£é¤ã§ãªãç¶æ 88 (IPL != 0) 89 ; å²è¾¼ã¿ã³ã³ããã¹ã(intnest != 0), å²è¾¼ã¿ã¹ã¿ã㯠90 ; 91 ; ã«ã¼ãã«ç®¡çå¤å²è¾¼ã¿ã®ãµãã¼ãæç¡ã¨, CPUããã¯ç¶æ 92 , å²è¾¼ã¿åªå 93 度 94 ; ãã¹ã¯å 95 ¨è§£é¤ç¶æ 96 ã®é¢ä¿ã¯ä»¥ä¸ã®éãã§ãã. 97 ; ã«ã¼ãã«ç®¡çå¤å²è¾¼ã¿æªãµãã¼ãæ: 98 ; CPUããã¯ç¶æ 99 (PSWã¬ã¸ã¹ã¿Iããã = 0) 100 ; å²è¾¼ã¿åªå 101 度ãã¹ã¯å 102 ¨è§£é¤ç¶æ 103 (IPL = 0) 104 ; ã«ã¼ãã«ç®¡çå¤å²è¾¼ã¿ãµãã¼ãæ: 105 ; CPUããã¯ç¶æ 106 107 ; (PSWã¬ã¸ã¹ã¿Iããã = 0, IPL = IPL_LOCK, lock_flag = true) 108 ; å²è¾¼ã¿åªå 109 度ãã¹ã¯å 110 ¨è§£é¤ç¶æ 111 (saved_ipl = 0) 112 ; 113 ; åæ§é ä½ãã¤ã³ã¿ã以ä¸ã®ããã«åã¬ã¸ã¹ã¿ã«ã¢ãµã¤ã³ãã. 114 ; r15 = p_runtsk ãã ããã£ã¹ãããã£ã®ååºå£ã§ã¯ç¡å¹ 115 ; r14 = *p_runtsk dispatcher ã®ä¸ã§ã¯ p_runtsk 確å®æã«ååå¾ãã 116 ; åå 117 ¥ãå£ããæåã«å¤æ°ã¢ã¯ã»ã¹ããã¨ãã«ä¸è¨ã¬ã¸ã¹ã¿ã«ä¿åãã. 118 ; 119 ; æ§é ä½ã¢ã©ã¤ã¡ã³ãã¸ã®å¯¾å¿ 120 ; æ§é ä½ã¢ã©ã¤ã¡ã³ãã4Byte(ã¢ã³ããã¯)ã®å ´å: 121 ; ä¸è¬çãªã¬ã¸ã¹ã¿ç¸å¯¾ã¢ãã¬ãã·ã³ã°ãå¯è½ 122 ; ä¾: mov.l #__kernel_p_runtsk, r15 56 ; ディスパッチャおよび割込み(CPU例外)出入り口のルール: 57 ; 動作モードを以下のように定義する. 58 ; ディスパッチャモード: 59 ; CPUロック状態, 割込み優先度マスク全解除状態, 60 ; タスクコンテキスト(intnest = 0), タスクスタック 61 ; 割込み(CPU例外)処理モード 62 ; 全割込みロック状態(PSWレジスタIビット = 0), 63 ; 割込み優先度マスク全解除でない状態(IPL != 0) 64 ; 割込みコンテキスト(intnest != 0), 割込みスタック 65 ; 66 ; カーネル管理外割込みのサポート有無と, CPUロック状態, 割込み優先度 67 ; マスク全解除状態の関係は以下の通りである. 68 ; カーネル管理外割込み未サポート時: 69 ; CPUロック状態(PSWレジスタIビット = 0) 70 ; 割込み優先度マスク全解除状態(IPL = 0) 71 ; カーネル管理外割込みサポート時: 72 ; CPUロック状態 73 ; (PSWレジスタIビット = 0, IPL = IPL_LOCK, lock_flag = true) 74 ; 割込み優先度マスク全解除状態(saved_ipl = 0) 75 ; 76 ; 各構造体ポインタを以下のように各レジスタにアサインする. 77 ; r15 = p_runtsk ただしディスパッチャの各出口では無効 78 ; r14 = *p_runtsk dispatcher の中では p_runtsk 確定時に再取得する 79 ; 各入り口から最初に変数アクセスするときに上記レジスタに保存する. 80 ; 81 ; 構造体アライメントへの対応 82 ; 構造体アライメントが4Byte(アンパック)の場合: 83 ; 一般的なレジスタ相対アドレッシングが可能 84 ; 例: mov.l #__kernel_p_runtsk, r15 123 85 ; mov.l r0, TCB_sp[r15] 124 ; æ§é ä½ã¢ã©ã¤ã¡ã³ãã4Byteã§ã¯ãªã(ããã¯)ã®å ´å: 125 ; mov.lã®ããã«ãã³ã°ãµã¤ãºæå®ã®å ´åãç¸å¯¾å¤ã¯4ã®åæ°ã®ã¿æå¹ 126 ; ãã®ãã, ä¸åº¦å¯¾è±¡ã¢ãã¬ã¹ãæ±ãã¦ããã¢ã¯ã»ã¹ããå¿ 127 è¦ããã 128 ; ä¾: mov.l #__kernel_p_runtsk, r15 86 ; 構造体アライメントが4Byteではない(パック)の場合: 87 ; mov.lのようにロングサイズ指定の場合、相対値は4の倍数のみ有効 88 ; このため, 一度対象アドレスを求めてからアクセスする必要がある 89 ; 例: mov.l #__kernel_p_runtsk, r15 129 90 ; add #TCB_sp, r15, r5 130 91 ; mov.l r0, [r5] 131 ; åãªãã»ããå¤ãå¤æã, æ¡ä»¶ã¢ã»ã³ãã«ã«ããã³ã¼ããåãæ¿ãã132 ; 133 134 ; 135 ; æ§é ä½ã¢ã¯ã»ã¹ã®ãªãã»ããå®ç¾©92 ; 各オフセット値を判断し, 条件アセンブルによりコードを切り替える 93 ; 94 95 ; 96 ; 構造体アクセスのオフセット定義 136 97 ; 137 98 #include "offset.h" 138 99 139 100 ; 140 ; å種EQUå®ç¾©(Hãã¡ã¤ã«ã®#defineå®ç¾©)101 ; 各種EQU定義(Hファイルの#define定義) 141 102 ; 142 103 #include "target_kernel_impl.h" … … 194 155 195 156 ; 196 ; TCB_sp ã¸ã®æ¸è¾¼ã¿ãã¯ã157 ; TCB_sp への書込みマクロ 197 158 ; 198 159 .macro st_TCB_sp src, tcb, tmp … … 206 167 207 168 ; 208 ; TCB_sp ããã®èªåºããã¯ã169 ; TCB_sp からの読出しマクロ 209 170 ; 210 171 .macro ld_TCB_sp dst, tcb, tmp … … 218 179 219 180 ; 220 ; TCB_pc ã¸ã®æ¸è¾¼ã¿ãã¯ã181 ; TCB_pc への書込みマクロ 221 182 ; 222 183 .macro st_TCB_pc src, tcb, tmp … … 230 191 231 192 ; 232 ; TCB_pc ããã®èªåºããã¯ã193 ; TCB_pc からの読出しマクロ 233 194 ; 234 195 .macro ld_TCB_pc dst, tcb, tmp … … 242 203 243 204 ; 244 ; TCB_texptn ããã®èªåºããã¯ã205 ; TCB_texptn からの読出しマクロ 245 206 ; 246 207 .macro ld_TCB_texptn dst, tcb, tmp … … 254 215 255 216 ; 256 ; TCB_p_tinib ããã®èªåºããã¯ã217 ; TCB_p_tinib からの読出しマクロ 257 218 ; 258 219 .macro ld_TCB_p_tinib dst, tcb, tmp … … 266 227 267 228 ; 268 ; TINIB_exinf ããã®èªåºããã¯ã229 ; TINIB_exinf からの読出しマクロ 269 230 ; 270 231 .macro ld_TINIB_exinf dst, tinib, tmp … … 278 239 279 240 ; 280 ; TINIB_task ããã®èªåºããã¯ã241 ; TINIB_task からの読出しマクロ 281 242 ; 282 243 .macro ld_TINIB_task dst, tinib, tmp … … 293 254 294 255 ; 295 ; APIããã®ã¿ã¹ã¯ãã£ã¹ãããã£å 296 ¥å£ 297 ; 298 ; å¼ã³åºãæ¡ä»¶: 299 ; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç 300 §) 301 ; 302 ; ããã§ã¯, ã³ã³ããã¹ãã®éé¿ã¨, å®è¡åéçªå°ã®è¨å®ããã. 256 ; APIからのタスクディスパッチャ入口 257 ; 258 ; 呼び出し条件: 259 ; ・ディスパッチャモード(ファイルヘッダ参照) 260 ; 261 ; ここでは, コンテキストの退避と, 実行再開番地の設定をする. 303 262 ; 304 263 __kernel_dispatch: 305 264 #ifdef TOPPERS_SUPPORT_OVRHDR /* (6-5-3-1) */ 306 mov.l #255, r1 ; r1 ã«ããã¼å²è¾¼ã¿çªå·265 mov.l #255, r1 ; r1にダミー割込み番号 307 266 bsr __kernel_ovrtimer_stop 308 267 #endif /* TOPPERS_SUPPORT_OVRHDR */ 309 pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å268 pushm r6-r13 ; 非スクラッチレジスタ保存 310 269 mov.l #__kernel_p_runtsk, r15 311 270 mov.l [r15], r14 312 st_TCB_sp r0, r14, r5 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãTCBã«ä¿å313 st_TCB_pc #dispatch_r, r14, r5 ; å®è¡åéçªå°ãTCBã«ä¿å271 st_TCB_sp r0, r14, r5 ; スタックポインタをTCBに保存 272 st_TCB_pc #dispatch_r, r14, r5 ; 実行再開番地をTCBに保存 314 273 bra dispatcher 315 274 316 275 ; 317 ; APIã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£ 318 ; 319 ; å¼ã³åºãæ¡ä»¶: 320 ; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç 321 §) 322 ; 323 ; ããã§ã¯, ã¿ã¹ã¯ä¾å¤ãã³ãã©å¼åºãã¨, ã³ã³ããã¹ãã®å¾©å¸°ããã. 276 ; APIへのタスクディスパッチャ出口 277 ; 278 ; 呼び出し条件: 279 ; ・ディスパッチャモード(ファイルヘッダ参照) 280 ; 281 ; ここでは, タスク例外ハンドラ呼出しと, コンテキストの復帰をする. 324 282 ; 325 283 dispatch_r: 326 284 dispatch_r_rts: 327 popm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿å¾©å¸°285 popm r6-r13 ; 非スクラッチレジスタ復帰 328 286 #ifdef TOPPERS_SUPPORT_OVRHDR /* (6-5-3-2) */ 329 287 bsr __kernel_ovrtimer_start 330 288 #endif /* TOPPERS_SUPPORT_OVRHDR */ 331 rts ; dispatch å¼ã³åºãå 332 ã¸æ»ã. 333 334 ; 335 ; ã¿ã¹ã¯èµ·åå¦ç(ã¿ã¹ã¯å 336 é ã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£) 337 ; 338 ; å¼ã³åºãæ¡ä»¶: 339 ; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç 340 §) 341 ; 342 ; ããã§ã¯, CPUããã¯è§£é¤ç¶æ 343 ã«ã, ã¿ã¹ã¯ãèµ·åãã. 289 rts ; dispatch 呼び出し元へ戻る. 290 291 ; 292 ; タスク起動処理(タスク先頭へのタスクディスパッチャ出口) 293 ; 294 ; 呼び出し条件: 295 ; ・ディスパッチャモード(ファイルヘッダ参照) 296 ; 297 ; ここでは, CPUロック解除状態にし, タスクを起動する. 344 298 ; 345 299 __kernel_start_r: … … 350 304 #endif /* TOPPERS_SUPPORT_OVRHDR */ 351 305 mov.l #_ext_tsk, r5 352 push.l r5 ; æ»ãçªå°ãã¹ã¿ãã¯ã«ç©ã306 push.l r5 ; 戻り番地をスタックに積む 353 307 ld_TCB_p_tinib r5, r14, r4 354 ld_TINIB_exinf r1, r5, r4 ; æ¡å¼µæ 355 å ±ã第ä¸å¼æ°ã«è¨å® 356 ld_TINIB_task r5, r5, r4 ; ã¿ã¹ã¯ã®èµ·åçªå°ãåå¾ 308 ld_TINIB_exinf r1, r5, r4 ; 拡張情報を第一引数に設定 309 ld_TINIB_task r5, r5, r4 ; タスクの起動番地を取得 357 310 .if TIPM_LOCK == -15 358 setpsw i ; å²è¾¼ã¿è¨±å¯(CPUããã¯è§£é¤ç¶æ 359 ) 311 setpsw i ; 割込み許可(CPUロック解除状態) 360 312 .else 361 mov.l #__kernel_lock_flag, r4 ; CPUããã¯è§£é¤ç¶æ 362 㸠363 mov.l #0, [r4] ; ããã«æ¥ãã¨ãã¯å¿ 364 ã saved_ipl ã® 365 mvtc #00010000H, psw ; å¤ã¯ 0 ã®ãã, ç´å¤ãè¨å®ãã. 366 ; å 367 ¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ 368 ( I = 1 ) 369 ; å²è¾¼ã¿åªå 370 度ãã¹ã¯å 371 ¨è§£é¤ç¶æ 372 ( IPL = 0 ) 313 mov.l #__kernel_lock_flag, r4 ; CPUロック解除状態へ 314 mov.l #0, [r4] ; ここに来るときは必ず saved_ipl の 315 mvtc #00010000H, psw ; 値は 0 のため, 直値を設定する. 316 ; 全割込みロック解除状態( I = 1 ) 317 ; 割込み優先度マスク全解除状態( IPL = 0 ) 373 318 .endif 374 319 jmp r5 375 320 376 321 ; 377 ; ã«ã¼ãã«èµ·åããã®ã¿ã¹ã¯ãã£ã¹ãããã£å 378 ¥å£ 379 ; 380 ; ãã®ã«ã¼ãã³ã¯ï¼ã«ã¼ãã«èµ·åæã«ï¼ãã¹ã¦ã®å²è¾¼ã¿ãç¦æ¢ããç¶æ 381 382 ; ï¼å²è¾¼ã¿ããã¯ç¶æ 383 ã¨åçï¼ã§å¼ã³åºãããï¼ã¾ãï¼å²è¾¼ã¿ã¢ã¼ãï¼é 384 ; ã¿ã¹ã¯ã³ã³ããã¹ãã¨åçï¼ã§å¼ã³åºããããã¨ãæ³å®ãã¦ããï¼ 385 ; 386 ; å¼ã³åºãæ¡ä»¶: 387 ; ã»å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ã(ãã¡ã¤ã«ãããåç 388 §) 389 ; 390 ; ããã§ã¯, ãã£ã¹ãããã£ã¢ã¼ãã«å¤æ´ãã. 322 ; カーネル起動からのタスクディスパッチャ入口 323 ; 324 ; このルーチンは,カーネル起動時に,すべての割込みを禁止した状態 325 ; (割込みロック状態と同等)で呼び出される.また,割込みモード(非 326 ; タスクコンテキストと同等)で呼び出されることを想定している. 327 ; 328 ; 呼び出し条件: 329 ; ・割込み(CPU例外)処理モード(ファイルヘッダ参照) 330 ; 331 ; ここでは, ディスパッチャモードに変更する. 391 332 ; 392 333 __kernel_start_dispatch: 393 334 mov.l #__kernel_intnest, r5 394 mov.w #0, [r5] ; ã¿ã¹ã¯ã³ã³ããã¹ãã«åæã335 mov.w #0, [r5] ; タスクコンテキストに切換え 395 336 #if TIPM_LOCK != -15 396 mvtc #(IPL_LOCK | 00010000H), psw ; å 397 ¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ 398 399 ; å²è¾¼ã¿åªå 400 度ãã¹ã¯å 401 ¨è§£é¤ã§ãªãç¶æ 402 403 #endif 404 405 ; 406 ; ã¿ã¹ã¯çµäº(ç¾å¨ã®ã³ã³ããã¹ããæ¨ã¦ã)ããã®ã¿ã¹ã¯ãã£ã¹ãããã£å 407 ¥å£ 408 ; 409 ; å¼ã³åºãæ¡ä»¶: 410 ; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç 411 §) 412 ; 413 ; ããã§ã¯, ä½ããããã¨ã¯ãªã. 414 ; ãªã, p_runtsk ã®ã¢ãã¬ã¹åå¾ã ãã¯è¡ãªã. 337 mvtc #(IPL_LOCK | 00010000H), psw ; 全割込みロック解除状態 338 ; 割込み優先度マスク全解除でない状態 339 #endif 340 341 ; 342 ; タスク終了(現在のコンテキストを捨てる)からのタスクディスパッチャ入口 343 ; 344 ; 呼び出し条件: 345 ; ・ディスパッチャモード(ファイルヘッダ参照) 346 ; 347 ; ここでは, 何もすることはない. 348 ; なお, p_runtsk のアドレス取得だけは行なう. 415 349 ; 416 350 __exit_and_dispatch: … … 420 354 .endif 421 355 ; 422 ; ãã£ã¹ãããã£æ¬ä½423 ; 424 ; å¼ã³åºãæ¡ä»¶:425 ; ã»ãã¹ã¦ã®ã¿ã¹ã¯ã®ã³ã³ããã¹ãã¯ä¿åããã¦ãã.426 ; 427 ; dispatcher å¼åºæã®ã¹ã¿ãã¯:428 ; ã»__kernel_dispatch ããããå ´å : ã¿ã¹ã¯ã¹ã¿ãã¯429 ; ã»exit_and_dispatch ããããå ´å:430 ; exit_task ããããå ´å : ã¿ã¹ã¯ã¹ã¿ãã¯431 ; ã«ã¼ãã«èµ·åæ(__kernel_start_dispatch) : å²è¾¼ã¿ã¹ã¿ãã¯432 ; ã»ret_int ããããå ´å : ã¿ã¹ã¯ã¹ã¿ãã¯433 ; ã»dispatcher_idle_loop ããããå ´å : å²è¾¼ã¿ã¹ã¿ãã¯356 ; ディスパッチャ本体 357 ; 358 ; 呼び出し条件: 359 ; ・すべてのタスクのコンテキストは保存されている. 360 ; 361 ; dispatcher 呼出時のスタック: 362 ; ・__kernel_dispatch からきた場合 : タスクスタック 363 ; ・exit_and_dispatch からきた場合: 364 ; exit_task からきた場合 : タスクスタック 365 ; カーネル起動時(__kernel_start_dispatch) : 割込みスタック 366 ; ・ret_int からきた場合 : タスクスタック 367 ; ・dispatcher_idle_loop からきた場合 : 割込みスタック 434 368 ; 435 369 dispatcher: 436 370 .if LOG_DSP_ENTER == 1 437 371 push.l r15 438 mov.l r14, r1 ; å¼æ°(ãã£ã¹ãããå 439 TCB)ãè¨å® 372 mov.l r14, r1 ; 引数(ディスパッチ元TCB)を設定 440 373 bsr __kernel_log_dsp_enter 441 374 pop r15 442 375 .endif 443 376 mov.l #__kernel_p_schedtsk, r5 444 mov.l [r5], [r15] ; p_schedtsk ã p_runtsk ã«377 mov.l [r5], [r15] ; p_schedtsk を p_runtsk に 445 378 mov.l [r15], r14 446 379 cmp #0, r14 447 bz dispatcher_pre_idle ; schedtsk ããªããã°ã¢ã¤ãã«ã«ã¼ãã¸448 ld_TCB_sp r0, r14, r5 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ã復帰380 bz dispatcher_pre_idle ; schedtsk がなければアイドルループへ 381 ld_TCB_sp r0, r14, r5 ; タスクスタックポインタを復帰 449 382 .if LOG_DSP_LEAVE == 1 450 383 push.l r14 451 mov.l r14, r1 ; å¼æ°(ãã£ã¹ãããå 452 TCB)ãè¨å® 384 mov.l r14, r1 ; 引数(ディスパッチ先TCB)を設定 453 385 bsr __kernel_log_dsp_leave 454 386 pop r14 455 387 .endif 456 388 ld_TCB_pc r5, r14, r4 457 jmp r5 ; å®è¡åéçªå°ã¸ã¸ã£ã³ã 458 459 ; 460 ; schdedtskãNULLã®å ´åã¯ã¢ã¤ãã«ã«ã¼ãã«å 461 ¥ã 462 ; ã¢ã¤ãã«ã«ã¼ãã¯å²è¾¼ã¿å¦çã¢ã¼ãã§åä½ããã 463 ; 464 ; ããã§å²è¾¼ã¿ã¢ã¼ãã«åãæããã®ã¯ï¼ããã§çºçããå²è¾¼ã¿å¦çã« 465 ; ã©ã®ã¹ã¿ãã¯ã使ããã¨ããåé¡ã®è§£æ±ºã¨ï¼å²è¾¼ã¿ãã³ãã©å 466 ã§ã®ã¿ 467 ; ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ãã2ã¤ã®æå³ãããï¼ 389 jmp r5 ; 実行再開番地へジャンプ 390 391 ; 392 ; schdedtskがNULLの場合はアイドルループに入る 393 ; アイドルループは割込み処理モードで動作させる 394 ; 395 ; ここで割込みモードに切り換えるのは,ここで発生する割込み処理に 396 ; どのスタックを使うかという問題の解決と,割込みハンドラ内でのタ 397 ; スクディスパッチの防止という2つの意味がある. 468 398 ; 469 399 dispatcher_pre_idle: 470 400 mov.l #__kernel_istkpt,r5 471 mov.l [r5], r0 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ã401 mov.l [r5], r0 ; 割込み用のスタックへ切替え 472 402 mov.l #__kernel_intnest, r5 473 mov.w #1, [r5] ; éã¿ã¹ã¯ã³ã³ããã¹ãã«åæã403 mov.w #1, [r5] ; 非タスクコンテキストに切換え 474 404 #if TIPM_LOCK != -15 475 mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ 476 㸠405 mov.l #__kernel_lock_flag, r5 ; CPUロック解除状態へ 477 406 mov.l #0, [r5] 478 mvtc #0, psw ; åªå 479 度0ã®å²è¾¼ã¿å¦çä¸ãå½è£ 480 407 mvtc #0, psw ; 優先度0の割込み処理中を偽装 481 408 #endif 482 409 483 410 dispatcher_idle_loop: 484 setpsw i ; å 485 ¨å²è¾¼ã¿è¨±å¯ 411 setpsw i ; 全割込み許可 486 412 wait 487 clrpsw i ; å 488 ¨å²è¾¼ã¿ç¦æ¢ 413 clrpsw i ; 全割込み禁止 489 414 490 415 mov.l #__kernel_p_schedtsk, r4 … … 492 417 mov.l #__kernel_p_runtsk, r5 493 418 mov.l [r5], r5 ; p_runtsk -> r5 494 cmp r4, r5 ; p_schedtsk 㨠p_runtsk ãåãã§ãã£ã¹ãããè¦æ±ç¡ããªã495 beq dispatcher_idle_loop ; ã¢ã¤ãã«ã«ã¼ããç¹°ãè¿ã496 mov.l #0, [r5] ; reqflg ãtrueãªãfalseã«ãã419 cmp r4, r5 ; p_schedtsk と p_runtsk が同じでディスパッチ要求無しなら 420 beq dispatcher_idle_loop ; アイドルループを繰り返す 421 mov.l #0, [r5] ; reqflgがtrueならfalseにする 497 422 mov.l #__kernel_intnest, r5 498 mov.w #0, [r5] ; ã¿ã¹ã¯ã³ã³ããã¹ãã«åæã423 mov.w #0, [r5] ; タスクコンテキストに切換え 499 424 #if TIPM_LOCK != -15 500 mov.l #__kernel_lock_flag, r5 ; CPUããã¯ç¶æ 501 㸠425 mov.l #__kernel_lock_flag, r5 ; CPUロック状態へ 502 426 mov.l #1, [r5] 503 427 mov.l #__kernel_saved_ipl, r5 504 428 mov.l #0, [r5] 505 mvtc #(IPL_LOCK | PSW_I_MASK), psw ; å 506 ¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ 507 508 ; å²è¾¼ã¿åªå 509 度ãã¹ã¯å 510 ¨è§£é¤ã§ãªãç¶æ 511 512 #endif 513 bra dispatcher ; dispatcher ã¸æ»ã 514 515 516 ; 517 ; ã«ã¼ãã«ã®çµäºå¦çã®å¼åºã 518 ; 519 ; ã¢ã¼ãã¨ã¹ã¿ãã¯ãéã¿ã¹ã¯ã³ã³ããã¹ãç¨ã«åãæ¿ãï¼ 429 mvtc #(IPL_LOCK | PSW_I_MASK), psw ; 全割込みロック解除状態 430 ; 割込み優先度マスク全解除でない状態 431 #endif 432 bra dispatcher ; dispatcher へ戻る 433 434 435 ; 436 ; カーネルの終了処理の呼出し 437 ; 438 ; モードとスタックを非タスクコンテキスト用に切り替え. 520 439 ; 521 440 .global __kernel_call_exit_kernel 522 441 __kernel_call_exit_kernel: 523 442 #if TIPM_LOCK != -15 524 clrpsw i ; å 525 ¨å²è¾¼ã¿ç¦æ¢ 526 mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ 527 㸠443 clrpsw i ; 全割込み禁止 444 mov.l #__kernel_lock_flag, r5 ; CPUロック解除状態へ 528 445 mov.l #0, [r5] 529 446 #endif 530 447 mov.l #__kernel_istkpt, r5 531 mov.l [r5], r0 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ã448 mov.l [r5], r0 ; 割込み用のスタックへ切替え 532 449 mov.l #__kernel_intnest, r5 533 mov.w #1, [r5] ; éã¿ã¹ã¯ã³ã³ããã¹ãã«åæã450 mov.w #1, [r5] ; 非タスクコンテキストに切換え 534 451 bsr __kernel_exit_kernel 535 452 bra __kernel_call_exit_kernel … … 537 454 538 455 ; 539 ; å²è¾¼ã¿(CPUä¾å¤)ããã®ã¿ã¹ã¯ãã£ã¹ãããã£å 540 ¥å£ 541 ; 542 ; å¼åºãæ¡ä»¶: 543 ; ã»å 544 ¨å²è¾¼ã¿ããã¯ç¶æ 545 (PSWã¬ã¸ã¹ã¿Iããã = 0) 546 ; ã»å²è¾¼ã¿åªå 547 度ãã¹ã¯å 548 ¨è§£é¤ã§ãªãç¶æ 549 (IPL != 0) 550 ; ã»ã¿ã¹ã¯ã³ã³ããã¹ã(intnest=0) 551 ; ã»ä½¿ç¨ã¹ã¿ãã¯ã¯ã¿ã¹ã¯ã¹ã¿ã㯠552 ; ã»reqflg = true 553 ; 554 ; ããã§ã¯, ãã£ã¹ãããã£ã¢ã¼ãã«å¤æ´ã, reqflgãOFFã«ãã¦ãã, 555 ; é 556 延ãã£ã¹ãããã®æç¡ãå¤æãã. 557 ; 558 559 ; 560 ; ret_intå 561 é ã§ã¹ã¿ãã¯ã«ç©ã¾ãã¦ããPSWã¬ã¸ã¹ã¿ã¸ã®ãªãã»ãã 456 ; 割込み(CPU例外)からのタスクディスパッチャ入口 457 ; 458 ; 呼出し条件: 459 ; ・全割込みロック状態(PSWレジスタIビット = 0) 460 ; ・割込み優先度マスク全解除でない状態(IPL != 0) 461 ; ・タスクコンテキスト(intnest=0) 462 ; ・使用スタックはタスクスタック 463 ; ・reqflg = true 464 ; 465 ; ここでは, ディスパッチャモードに変更し, reqflgをOFFにしてから, 466 ; 遅延ディスパッチの有無を判断する. 467 ; 468 469 ; 470 ; ret_int先頭でスタックに積まれているPSWレジスタへのオフセット 562 471 ; ACC + FPSW + R14--R15 + R1--R5 + PC 563 472 ; … … 566 475 ret_int: 567 476 .if TIPM_LOCK == -15 568 mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®IPLå¤åå¾477 mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; 割込み/CPU例外発生前のIPL値取得 569 478 and #PSW_IPL_MASK, r5 570 mvtc r5, psw ; å 571 ¨å²è¾¼ã¿ããã¯(CPUããã¯)ç¶æ 572 573 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®å²è¾¼ã¿åªå 574 度 479 mvtc r5, psw ; 全割込みロック(CPUロック)状態 480 ; 割込み/CPU例外発生前の割込み優先度 575 481 .else 576 mov.l #__kernel_lock_flag, r5 ; CPUããã¯ç¶æ 577 㸠482 mov.l #__kernel_lock_flag, r5 ; CPUロック状態へ 578 483 mov.l #1, [r5] 579 mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; å²è¾¼ã¿/CPUä¾å¤çºçåã®IPLå¤åå¾484 mov.l RET_INT_GET_PSW_OFFSET[r0], r5 ; 割込み/CPU例外発生前のIPL値取得 580 485 and #PSW_IPL_MASK, r5 581 486 mov.l #__kernel_saved_ipl, r4 582 487 mov.l r5, [r4] 583 mvtc #(IPL_LOCK | PSW_I_MASK), psw ; å 584 ¨å²è¾¼ã¿ããã¯è§£é¤ç¶æ 585 586 ; å²è¾¼ã¿åªå 587 度ãã¹ã¯å 588 ¨è§£é¤ã§ãªãç¶æ 589 488 mvtc #(IPL_LOCK | PSW_I_MASK), psw ; 全割込みロック解除状態 489 ; 割込み優先度マスク全解除でない状態 590 490 .endif 591 491 mov.l #__kernel_p_runtsk, r15 … … 593 493 mov.l #__kernel_p_schedtsk, r5 594 494 mov.l [r5], r5 595 cmp r5, r14 ; p_schedtsk 㨠p_runtsk ãåããªã596 beq ret_int_r_call_tex ; ret_int_r_call_tex ã¸597 pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å598 st_TCB_sp r0, r14, r5 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãTCBã«ä¿å599 st_TCB_pc #ret_int_r, r14, r5 ; å®è¡åéçªå°ãTCBã«ä¿å495 cmp r5, r14 ; p_schedtsk と p_runtsk が同じなら 496 beq ret_int_r_call_tex ; ret_int_r_call_tex へ 497 pushm r6-r13 ; 非スクラッチレジスタ保存 498 st_TCB_sp r0, r14, r5 ; スタックポインタをTCBに保存 499 st_TCB_pc #ret_int_r, r14, r5 ; 実行再開番地をTCBに保存 600 500 bra dispatcher 601 501 602 502 ; 603 ; å²è¾¼ã¿(CPUä¾å¤)ã¸ã®ã¿ã¹ã¯ãã£ã¹ãããã£åºå£ 604 ; 605 ; å¼ã³åºãæ¡ä»¶: 606 ; ã»ãã£ã¹ãããã£ã¢ã¼ã(ãã¡ã¤ã«ãããåç 607 §) 608 ; 609 ; ããã§ã¯, ã¿ã¹ã¯ä¾å¤ãã³ãã©å¼åºãã¨, å²è¾¼ã¿(CPUä¾å¤)å¦çã¢ã¼ãã¸ã® 610 ; å¤æ´ã¨, ã³ã³ããã¹ãã®å¾©å¸°ãè¡ã, å²è¾¼ã¿(CUPä¾å¤)çºçå 611 ã¸æ»ã. 612 ; 613 __kernel_break_wait: ;ã¿ã¹ã¯ã¢ãã¿ç¨ã©ãã« 503 ; 割込み(CPU例外)へのタスクディスパッチャ出口 504 ; 505 ; 呼び出し条件: 506 ; ・ディスパッチャモード(ファイルヘッダ参照) 507 ; 508 ; ここでは, タスク例外ハンドラ呼出しと, 割込み(CPU例外)処理モードへの 509 ; 変更と, コンテキストの復帰を行い, 割込み(CUP例外)発生元へ戻る. 510 ; 511 __kernel_break_wait: ;タスクモニタ用ラベル 614 512 ret_int_r: 615 popm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿å¾©å¸°513 popm r6-r13 ; 非スクラッチレジスタ復帰 616 514 ret_int_r_call_tex: 617 515 #ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 & 6.7.1 */ … … 622 520 ret_int_r_rte: 623 521 #if TIPM_LOCK != -15 624 clrpsw i ; å 625 ¨å²è¾¼ã¿ç¦æ¢ 626 mov.l #__kernel_lock_flag, r5 ; CPUããã¯è§£é¤ç¶æ 627 㸠522 clrpsw i ; 全割込み禁止 523 mov.l #__kernel_lock_flag, r5 ; CPUロック解除状態へ 628 524 mov.l #0, [r5] 629 525 #endif 630 popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°631 mvtaclo r5 ; ACC æä¸ä½16bitã¯0ã§å¾©å¸°526 popm r4-r5 ; アキュムレータ復帰 527 mvtaclo r5 ; ACC最下位16bitは0で復帰 632 528 mvtachi r4 633 popc fpsw ; FPU ã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°634 popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°529 popc fpsw ; FPUステータスレジスタ復帰 530 popm r14-r15 ; レジスタ復帰 635 531 popm r1-r5 636 rte ; å²è¾¼ã¿åã®å¦çã«æ»ã 637 638 639 ; 640 ; å²è¾¼ã¿ã®åºå 641 ¥å£å¦ç(ã¢ã»ã³ããªè¨èªè¨è¿°é¨å) 642 ; 643 ; å¼åºãæ¡ä»¶: 644 ; ã»å²è¾¼ã¿çºçæã®H/Wå¦çã«ãã, PSWã¬ã¸ã¹ã¿ã®Iããã=0, IPLã¯åä»ã 645 ; ãå²è¾¼ã¿ã®IPL. 646 ; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã° 647 ; ã¿ã¹ã¯ã¹ã¿ã㯠648 ; ã»å²è¾¼ã¿çºçæã®H/Wå¦çã«ãã,ã¹ã¿ãã¯ã«å²è¾¼ã¿ããã®å¾©å¸°PCã¨PSWã 649 ; ä¿åããã¦ãã. 650 ; ã»ãã¯ã¿ãã¼ãã«ã«ç»é²ãããåå¥ã®å 651 ¥ãå£å¦çã«ãã, ã¹ã¿ãã¯ã« 652 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿(R1-R5)ãä¿åããã¦ãã. 653 ; 654 ; å¼æ°: 655 ; ã»r1:å²è¾¼ã¿è¦å çªå· 656 ; ã»r2:å²è¾¼ã¿ãã³ãã©ã®ã¢ãã¬ã¹ 657 ; 658 ; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ãããã以ä¸ã«ç¤ºã. 659 ; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã 660 ; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã. 532 rte ; 割込み前の処理に戻る 533 534 535 ; 536 ; 割込みの出入口処理(アセンブリ言語記述部分) 537 ; 538 ; 呼出し条件: 539 ; ・割込み発生時のH/W処理により, PSWレジスタのIビット=0, IPLは受付け 540 ; た割込みのIPL. 541 ; ・スタックは多重割り込みなら割込みスタック, そうでなければ 542 ; タスクスタック 543 ; ・割込み発生時のH/W処理により,スタックに割込みからの復帰PCとPSWが 544 ; 保存されている. 545 ; ・ベクタテーブルに登録された個別の入り口処理により, スタックに 546 ; スクラッチレジスタ(R1-R5)が保存されている. 547 ; 548 ; 引数: 549 ; ・r1:割込み要因番号 550 ; ・r2:割込みハンドラのアドレス 551 ; 552 ; レジスタがスタック上にどのように保存されているかを以下に示す. 553 ; この図では上が低位, 下が高位のアドレスで, スタックは下から 554 ; 上方向に向かって積み上げられるものとする. 661 555 ; 662 556 ; ------------------------- … … 686 580 ; -------------------------(SP + 44) 687 581 ; 688 ; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã. 689 ; 690 ; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ã㤠reqflg ã 691 ; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²(é 692 延ãã£ã¹ããã)ããï¼ 693 ; 694 ; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã. 695 ; intnest != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã. 696 ; 697 ; reqflg ã¯CPUããã¯ç¶æ 698 ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼ 699 ; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å 700 㧠701 ; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã. 582 ; ここでは, 割込み処理モードに変更してハンドラを実行する. 583 ; 584 ; ハンドラからリターンした後は, 多重割込みでなく, かつ reqflg が 585 ; TRUE になった時に,ret_int へ分岐(遅延ディスパッチ)する. 586 ; 587 ; 多重割込みかどうかは割込みネストカウンタの値で判定する. 588 ; intnest != 0 ならば多重割込みであると判定する. 589 ; 590 ; reqflg はCPUロック状態でチェックする. そうでないと, 591 ; reqflg チェック後に起動された割込みハンドラ内で 592 ; ディスパッチが要求された場合に,ディスパッチされない. 702 593 ; 703 594 _kernel_interrupt: 704 pushm r14-r15 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãéé¿705 pushc fpsw ; FPU ã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿éé¿595 pushm r14-r15 ; スクラッチレジスタを退避 596 pushc fpsw ; FPUステータスレジスタ退避 706 597 mvfacmi r5 707 shll #16, r5 ; ACC æä¸ä½16bitã¯0ã¨ãã598 shll #16, r5 ; ACC最下位16bitは0とする 708 599 mvfachi r4 709 pushm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿éé¿600 pushm r4-r5 ; アキュムレータ退避 710 601 mov.l #__kernel_intnest, r5 711 602 mov.w [r5], r4 712 add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã603 add #1, r4 ; ネスト回数をインクリメント 713 604 mov.w r4, [r5] 714 cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã715 bnz interrupt_from_int ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿716 ; å段ã®å²è¾¼ã¿605 cmp #1, r4 ; 多重割り込みかどうか 606 bnz interrupt_from_int ; 加算前が0でなければ多重割込み 607 ; 初段の割込み 717 608 #ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 */ 718 609 pushm r1-r5 719 bsr __kernel_ovrtimer_stop ; r1 ã«å²è¾¼ã¿çªå·610 bsr __kernel_ovrtimer_stop ; r1に割込み番号 720 611 popm r1-r5 721 612 #endif /* TOPPERS_SUPPORT_OVRHDR */ 722 mov.l r0, r3 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãåãåºã723 mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã613 mov.l r0, r3 ; スタックポインタを取り出し 614 mov.l #__kernel_istkpt, r5 ; 割込み用のスタックへ切替える 724 615 mov.l [r5], r0 725 push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ 726 interrupt_from_int: ; å¤éå²è¾¼ã¿ 727 setpsw i ; å²è¾¼ã¿è¨±å¯(CPUããã¯è§£é¤ç¶æ 728 ) 616 push.l r3 ; タスクスタックを保持 617 interrupt_from_int: ; 多重割込み 618 setpsw i ; 割込み許可(CPUロック解除状態) 729 619 730 620 .if LOG_INH_LEAVE == 1 731 push.l r1 ; ãã°ãã¬ã¼ã¹ã®å¼æ°ãä¿æ621 push.l r1 ; ログトレースの引数を保持 732 622 .endif 733 623 734 624 .if LOG_INH_ENTER == 1 735 625 push.l r2 736 bsr __kernel_log_inh_enter ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã 737 ; å¼æ°ã®å²è¾¼ã¿è¦å çªå·ã¯æ¢ã«r1ã«å 738 ¥ã£ã¦ãã 626 bsr __kernel_log_inh_enter ; ログトレース関数の呼出し 627 ; 引数の割込み要因番号は既にr1に入っている 739 628 pop r2 740 629 .endif 741 630 742 jsr r2 ; C ã«ã¼ãã³å¼ã³åºã631 jsr r2 ; Cルーチン呼び出し 743 632 744 633 .if LOG_INH_LEAVE == 1 745 pop r1 ; å¼æ°ã«å²è¾¼ã¿è¦å çªå·ãè¨å®746 bsr __kernel_log_inh_leave ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã634 pop r1 ; 引数に割込み要因番号を設定 635 bsr __kernel_log_inh_leave ; ログトレース関数の呼出し 747 636 .endif 748 637 749 clrpsw i ; å²è¾¼ã¿ç¦æ¢(CPUããã¯ç¶æ 750 ) 638 clrpsw i ; 割込み禁止(CPUロック状態) 751 639 mov.l #__kernel_intnest, r5 752 640 mov.w [r5], r4 753 sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã641 sub #1, r4 ; ネスト回数をデクリメント 754 642 mov.w r4, [r5] 755 cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã756 bnz interrupt_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³757 ; å段ã®å²è¾¼ã¿758 pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã643 cmp #0, r4 ; 多重割り込みかどうか 644 bnz interrupt_return ; 多重割り込みならリターン 645 ; 初段の割込み 646 pop r0 ; タスクのスタックに戻す 759 647 mov.l #__kernel_p_schedtsk, r4 760 648 mov.l [r4], r4 ; p_schedtsk -> r4 761 649 mov.l #__kernel_p_runtsk, r5 762 650 mov.l [r5], r5 ; p_runtsk -> r5 763 cmp r4, r5 ; p_schedtsk 㨠p_runtsk ãç°ãªããã£ã¹ãããè¦æ±æããªã764 bne ret_int ; ret_int ã¸ã¸ã£ã³ã651 cmp r4, r5 ; p_schedtsk と p_runtsk が異なりディスパッチ要求有りなら 652 bne ret_int ; ret_int へジャンプ 765 653 #ifdef TOPPERS_SUPPORT_OVRHDR /* 6.6.1 */ 766 654 mov.l #__kernel_p_runtsk, r5 … … 771 659 #endif /* TOPPERS_SUPPORT_OVRHDR */ 772 660 interrupt_return: 773 popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸°774 mvtaclo r5 ; ACC æä¸ä½16bitã¯0ã§å¾©å¸°661 popm r4-r5 ; アキュムレータ復帰 662 mvtaclo r5 ; ACC最下位16bitは0で復帰 775 663 mvtachi r4 776 popc fpsw ; FPU ã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°777 popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°664 popc fpsw ; FPUステータスレジスタ復帰 665 popm r14-r15 ; レジスタ復帰 778 666 popm r1-r5 779 rte ; å²è¾¼ã¿åã®å¦çã«æ»ã 780 781 782 ; 783 ; CPUä¾å¤ã®åºå 784 ¥å£å¦ç(ã¢ã»ã³ããªè¨èªè¨è¿°é¨å) 785 ; 786 ; å¼åºãæ¡ä»¶: 787 ; ã»CPUä¾å¤çºçæã®H/Wå¦çã«ãã, PSWã¬ã¸ã¹ã¿ã®Iããã=0, IPL=0. 788 ; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã° 789 ; ã¿ã¹ã¯ã¹ã¿ã㯠790 ; ã»CPUä¾å¤çºçæã®H/Wå¦çã«ãã,ã¹ã¿ãã¯ã«CPUä¾å¤ããã®å¾©å¸°PC㨠791 ; PSWãä¿åããã¦ãã. 792 ; ã»ãã¯ã¿ãã¼ãã«ã«ç»é²ãããåå¥ã®å 793 ¥ãå£å¦çã«ãã, ã¹ã¿ãã¯ã« 794 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿(R1-R5)ãä¿åããã¦ãã. 795 ; 796 ; å¼æ°: 797 ; ã»r1:CPUä¾å¤è¦å çªå· 798 ; ã»r2:CPUä¾å¤ãã³ãã©ã®ã¢ãã¬ã¹ 799 ; 800 ; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ãããã以ä¸ã«ç¤ºã. 801 ; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã 802 ; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã. 803 ; ãªã, CPUä¾å¤è¦å çªå·ã¨R6-R13ã¯CPUä¾å¤ãã³ãã©å 804 ã§æ 805 å ±ãåå¾ 806 ; ããç®çã§éé¿ãã¦ãã, åºå£å¦çã§ã¯ä¿åå 807 容ãç ´æ£ããã°ãã. 667 rte ; 割込み前の処理に戻る 668 669 670 ; 671 ; CPU例外の出入口処理(アセンブリ言語記述部分) 672 ; 673 ; 呼出し条件: 674 ; ・CPU例外発生時のH/W処理により, PSWレジスタのIビット=0, IPL=0. 675 ; ・スタックは多重割り込みなら割込みスタック, そうでなければ 676 ; タスクスタック 677 ; ・CPU例外発生時のH/W処理により,スタックにCPU例外からの復帰PCと 678 ; PSWが保存されている. 679 ; ・ベクタテーブルに登録された個別の入り口処理により, スタックに 680 ; スクラッチレジスタ(R1-R5)が保存されている. 681 ; 682 ; 引数: 683 ; ・r1:CPU例外要因番号 684 ; ・r2:CPU例外ハンドラのアドレス 685 ; 686 ; レジスタがスタック上にどのように保存されているかを以下に示す. 687 ; この図では上が低位, 下が高位のアドレスで, スタックは下から 688 ; 上方向に向かって積み上げられるものとする. 689 ; なお, CPU例外要因番号とR6-R13はCPU例外ハンドラ内で情報を取得 690 ; する目的で退避しており, 出口処理では保存内容を破棄すればよい. 808 691 ; 809 692 ; ------------------------- 810 ; | CPU ä¾å¤è¦å çªå·| <----- p_excinf693 ; | CPU例外要因番号 | <----- p_excinf 811 694 ; ------------------------- (intptr_t)(p_excinf + 0) 812 695 ; | R6(4byte) | … … 851 734 ; ------------------------- (intptr_t)(p_excinf + 80) 852 735 ; 853 ; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã. 854 ; CPUä¾å¤ãã³ãã©ã«æ¸¡ãVPåã®å¤æ° p_excinf ã¨ãã¦ISPã®å¤æ¸¡ãï¼ 855 ; 856 ; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ã㤠reqflg ã 857 ; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²(é 858 延ãã£ã¹ããã)ããï¼ 859 ; 860 ; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã. 861 ; intnest != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã. 862 ; 863 ; reqflg ã¯CPUããã¯ç¶æ 864 ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼ 865 ; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å 866 㧠867 ; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã. 868 ; 869 ; 870 ; CPUä¾å¤å 871 ¥å£å¦ç 872 ; 873 ; ããã§ã¯, å²è¾¼ã¿å¦çã¢ã¼ãã«å¤æ´ãã¦ãã³ãã©ãå®è¡ãã. 874 ; 875 876 ; 877 ; CPUä¾å¤ãã³ãã©å¼åºãå¾ã«ä¸è¦ã¨ãªãã¹ã¿ãã¯æ 878 å ±ã®ãµã¤ãº 736 ; ここでは, 割込み処理モードに変更してハンドラを実行する. 737 ; CPU例外ハンドラに渡すVP型の変数 p_excinf としてISPの値渡す. 738 ; 739 ; ハンドラからリターンした後は, 多重割込みでなく, かつ reqflg が 740 ; TRUE になった時に,ret_int へ分岐(遅延ディスパッチ)する. 741 ; 742 ; 多重割込みかどうかは割込みネストカウンタの値で判定する. 743 ; intnest != 0 ならば多重割込みであると判定する. 744 ; 745 ; reqflg はCPUロック状態でチェックする. そうでないと, 746 ; reqflg チェック後に起動された割込みハンドラ内で 747 ; ディスパッチが要求された場合に,ディスパッチされない. 748 ; 749 ; 750 ; CPU例外入口処理 751 ; 752 ; ここでは, 割込み処理モードに変更してハンドラを実行する. 753 ; 754 755 ; 756 ; CPU例外ハンドラ呼出し後に不要となるスタック情報のサイズ 879 757 ; EXCNO + R6--R13 880 758 ; … … 882 760 883 761 _kernel_exception: 884 pushm r14-r15 ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãéé¿762 pushm r14-r15 ; スクラッチレジスタを退避 885 763 pushc fpsw 886 764 mvfacmi r5 887 shll #16, r5 ; ACC æä¸ä½16bitã¯0ã¨ãã765 shll #16, r5 ; ACC最下位16bitは0とする 888 766 mvfachi r4 889 pushm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿éé¿890 pushm r6-r13 ; éã¹ã¯ã©ããã¬ã¸ã¹ã¿ä¿å891 push.l r1 ; CPU ä¾å¤è¦å çªå·ãä¿æ892 mov.l r0, r3 ; ã¹ã¿ãã¯ãã¤ã³ã¿ãåãåºã767 pushm r4-r5 ; アキュムレータ退避 768 pushm r6-r13 ; 非スクラッチレジスタ保存 769 push.l r1 ; CPU例外要因番号を保持 770 mov.l r0, r3 ; スタックポインタを取り出し 893 771 mov.l EXC_GET_PSW_OFFSET[r3], r5 894 772 and #PSW_I_MASK, r5 895 bz exception_nonkernel ; å 896 ¨å²è¾¼ã¿ç¦æ¢(CPUããã¯)ç¶æ 897 ãªã管çå¤ 773 bz exception_nonkernel ; 全割込み禁止(CPUロック)状態なら管理外 898 774 #if TIPM_LOCK != -15 899 775 mov.l EXC_GET_PSW_OFFSET[r3], r5 900 776 and #PSW_IPL_MASK, r5 901 777 cmp #IPL_LOCK, r5 902 bgt exception_nonkernel ; IPL ãCPUããã¯ã¬ãã«ä»¥ä¸ãªã管çå¤778 bgt exception_nonkernel ; IPLがCPUロックレベル以上なら管理外 903 779 #endif 904 780 mov.l #__kernel_intnest, r5 905 781 mov.w [r5], r4 906 add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã782 add #1, r4 ; ネスト回数をインクリメント 907 783 mov.w r4, [r5] 908 cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã909 bnz exception_from_int ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿910 ; å段ã®å²è¾¼ã¿784 cmp #1, r4 ; 多重割り込みかどうか 785 bnz exception_from_int ; 加算前が0でなければ多重割込み 786 ; 初段の割込み 911 787 #ifdef TOPPERS_SUPPORT_OVRHDR /* 6.7.1 */ 912 788 pushm r1-r5 913 mov.l #255, r1 ; r1 ã«ããã¼å²è¾¼ã¿çªå·789 mov.l #255, r1 ; r1にダミー割込み番号 914 790 bsr __kernel_ovrtimer_stop 915 791 popm r1-r5 916 792 #endif /* TOPPERS_SUPPORT_OVRHDR */ 917 mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã793 mov.l #__kernel_istkpt, r5 ; 割込み用のスタックへ切替える 918 794 mov.l [r5], r0 919 push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ920 exception_from_int: ; å¤éå²è¾¼ã¿795 push.l r3 ; タスクスタックを保持 796 exception_from_int: ; 多重割込み 921 797 mov.l EXC_GET_PSW_OFFSET[r3], r5 922 mvtc r5, psw ; CPUä¾å¤çºçåã®ç¶æ 923 ã«æ»ã 798 mvtc r5, psw ; CPU例外発生前の状態に戻す 924 799 #if LOG_EXC_LEAVE == 1 925 push.l r1 ; ãã°ãã¬ã¼ã¹ã®å¼æ°ãä¿æ800 push.l r1 ; ログトレースの引数を保持 926 801 #endif 927 802 928 803 #if LOG_EXC_ENTER == 1 929 804 pushm r2-r3 930 bsr __kernel_log_exc_enter ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã 931 ; å¼æ°ã®å²è¾¼ã¿è¦å çªå·ã¯æ¢ã«r1ã«å 932 ¥ã£ã¦ãã 805 bsr __kernel_log_exc_enter ; ログトレース関数の呼出し 806 ; 引数の割込み要因番号は既にr1に入っている 933 807 popm r2-r3 934 808 #endif 935 809 936 mov.l r3, r1 ; å¼æ°ã®p_excinfãè¨å®937 jsr r2 ; C ã«ã¼ãã³å¼ã³åºã810 mov.l r3, r1 ; 引数のp_excinfを設定 811 jsr r2 ; Cルーチン呼び出し 938 812 939 813 .if LOG_EXC_LEAVE == 1 940 pop r1 ; å¼æ°ã«å²è¾¼ã¿è¦å çªå·ãè¨å®941 bsr __kernel_log_exc_leave ; ãã°ãã¬ã¼ã¹é¢æ°ã®å¼åºã814 pop r1 ; 引数に割込み要因番号を設定 815 bsr __kernel_log_exc_leave ; ログトレース関数の呼出し 942 816 .endif 943 817 944 clrpsw i ; ããããã¯å¿ 945 ãå²è¾¼ã¿ç¦æ¢ 818 clrpsw i ; ここからは必ず割込み禁止 946 819 mov.l #__kernel_intnest, r5 947 820 mov.w [r5], r4 948 sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã821 sub #1, r4 ; ネスト回数をデクリメント 949 822 mov.w r4, [r5] 950 cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã951 bnz exception_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³952 ; å段ã®å²è¾¼ã¿953 pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã823 cmp #0, r4 ; 多重割り込みかどうか 824 bnz exception_return ; 多重割り込みならリターン 825 ; 初段の割込み 826 pop r0 ; タスクのスタックに戻す 954 827 mov.l #__kernel_p_schedtsk, r4 955 828 mov.l [r4], r4 ; p_schedtsk -> r4 956 829 mov.l #__kernel_p_runtsk, r5 957 830 mov.l [r5], r5 ; p_runtsk -> r5 958 cmp r4, r5 ; p_schedtsk 㨠p_runtsk ãåãã§ãã£ã¹ãããè¦æ±ç¡ãã831 cmp r4, r5 ; p_schedtsk と p_runtsk が同じでディスパッチ要求無しか 959 832 #ifndef TOPPERS_SUPPORT_OVRHDR /* 6.7.1 */ 960 beq exception_return ; ãªããã°ãªã¿ã¼ã³ 961 add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ 962 å ±ã®ç ´æ£ 963 bra ret_int ; ããã° ret_int ã¸ã¸ã£ã³ã 833 beq exception_return ; なければリターン 834 add #EXCINF_REG_SIZE, r0 ; CPU例外情報の破棄 835 bra ret_int ; あれば ret_int へジャンプ 964 836 #else /* TOPPERS_SUPPORT_OVRHDR */ 965 beq exception_return_ovr ; ãªããã°ãªã¿ã¼ã³ 966 add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ 967 å ±ã®ç ´æ£ 968 bra ret_int ; ããã° ret_int ã¸ã¸ã£ã³ã 837 beq exception_return_ovr ; なければリターン 838 add #EXCINF_REG_SIZE, r0 ; CPU例外情報の破棄 839 bra ret_int ; あれば ret_int へジャンプ 969 840 exception_return_ovr: 970 841 mov.l #__kernel_p_runtsk, r5 … … 979 850 mov.l #__kernel_intnest, r5 980 851 mov.w [r5], r4 981 add #1, r4 ; ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã852 add #1, r4 ; ネスト回数をインクリメント 982 853 mov.w r4, [r5] 983 cmp #1, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã984 bnz exception_from_nonkernelint ; å ç®åã0ã§ãªããã°å¤éå²è¾¼ã¿985 ; å段ã®å²è¾¼ã¿986 mov.l #__kernel_istkpt, r5 ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ãã854 cmp #1, r4 ; 多重割り込みかどうか 855 bnz exception_from_nonkernelint ; 加算前が0でなければ多重割込み 856 ; 初段の割込み 857 mov.l #__kernel_istkpt, r5 ; 割込み用のスタックへ切替える 987 858 mov.l [r5], r0 988 push.l r3 ; ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿æ989 exception_from_nonkernelint: ; å¤éå²è¾¼ã¿859 push.l r3 ; タスクスタックを保持 860 exception_from_nonkernelint: ; 多重割込み 990 861 mov.l EXC_GET_PSW_OFFSET[r3], r5 991 mvtc r5, psw ; CPUä¾å¤çºçåã®ç¶æ 992 ã«æ»ã 993 994 mov.l r3, r1 ; å¼æ°ã®p_excinfãè¨å® 995 jsr r2 ; Cã«ã¼ãã³å¼ã³åºã 996 997 clrpsw i ; ããããã¯å¿ 998 ãå²è¾¼ã¿ç¦æ¢ 862 mvtc r5, psw ; CPU例外発生前の状態に戻す 863 864 mov.l r3, r1 ; 引数のp_excinfを設定 865 jsr r2 ; Cルーチン呼び出し 866 867 clrpsw i ; ここからは必ず割込み禁止 999 868 mov.l #__kernel_intnest, r5 1000 869 mov.w [r5], r4 1001 sub #1, r4 ; ãã¹ãåæ°ããã¯ãªã¡ã³ã870 sub #1, r4 ; ネスト回数をデクリメント 1002 871 mov.w r4, [r5] 1003 cmp #0, r4 ; å¤éå²ãè¾¼ã¿ãã©ãã1004 bnz exception_return ; å¤éå²ãè¾¼ã¿ãªããªã¿ã¼ã³1005 ; å段ã®å²è¾¼ã¿1006 pop r0 ; ã¿ã¹ã¯ã®ã¹ã¿ãã¯ã«æ»ã872 cmp #0, r4 ; 多重割り込みかどうか 873 bnz exception_return ; 多重割り込みならリターン 874 ; 初段の割込み 875 pop r0 ; タスクのスタックに戻す 1007 876 1008 877 exception_return: 1009 add #EXCINF_REG_SIZE, r0 ; CPUä¾å¤æ 1010 å ±ã®ç ´æ£ 1011 popm r4-r5 ; ã¢ãã¥ã ã¬ã¼ã¿å¾©å¸° 1012 mvtaclo r5 ; ACCæä¸ä½16bitã¯0ã§å¾©å¸° 878 add #EXCINF_REG_SIZE, r0 ; CPU例外情報の破棄 879 popm r4-r5 ; アキュムレータ復帰 880 mvtaclo r5 ; ACC最下位16bitは0で復帰 1013 881 mvtachi r4 1014 popc fpsw ; FPU ã¹ãã¼ã¿ã¹ã¬ã¸ã¹ã¿å¾©å¸°1015 popm r14-r15 ; ã¬ã¸ã¹ã¿å¾©å¸°882 popc fpsw ; FPUステータスレジスタ復帰 883 popm r14-r15 ; レジスタ復帰 1016 884 popm r1-r5 1017 rte ; å²è¾¼ã¿åã®å¦çã«æ»ã 1018 1019 1020 ; 1021 ; å¾®å°æéå¾ 1022 ã¡ 885 rte ; 割込み前の処理に戻る 886 887 888 ; 889 ; 微少時間待ち 1023 890 ; 1024 891 _sil_dly_nse:
Note:
See TracChangeset
for help on using the changeset viewer.