[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-2004 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 8 | * Copyright (C) 2001-2010 by Industrial Technology Institute,
|
---|
| 9 | * Miyagi Prefectural Government, JAPAN
|
---|
| 10 | * Copyright (C) 2001-2004 by Dep. of Computer Science and Engineering
|
---|
| 11 | * Tomakomai National College of Technology, JAPAN
|
---|
| 12 | *
|
---|
| 13 | * ä¸è¨èä½æ¨©è
|
---|
| 14 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãï¼Free Software Foundation
|
---|
| 15 | * ã«ãã£ã¦å
|
---|
| 16 | ¬è¡¨ããã¦ãã GNU General Public License ã® Version 2 ã«è¨
|
---|
| 17 | * è¿°ããã¦ããæ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§ã¢
|
---|
| 18 | * ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
---|
| 19 | å¸ï¼ä»¥ä¸ï¼
|
---|
| 20 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 21 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
| 22 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
| 23 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 24 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 25 | * ç¨ã§ããå½¢ã§åé
|
---|
| 26 | å¸ããå ´åã«ã¯ï¼åé
|
---|
| 27 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
| 28 | * è
|
---|
| 29 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
| 30 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 31 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 32 | * ç¨ã§ããªãå½¢ã§åé
|
---|
| 33 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
| 34 | * ã¨ï¼
|
---|
| 35 | * (a) åé
|
---|
| 36 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 37 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
| 38 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 39 | * (b) åé
|
---|
| 40 | å¸ã®å½¢æ
|
---|
| 41 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
| 42 | * å ±åãããã¨ï¼
|
---|
| 43 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
| 44 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 45 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 46 | 責ãããã¨ï¼
|
---|
| 47 | *
|
---|
| 48 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 49 | ã
|
---|
| 50 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ã
|
---|
| 51 | * å«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´
|
---|
| 52 | * æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
---|
| 53 | *
|
---|
| 54 | * @(#) $Id: cpu_support.S,v 1.17 2007/03/23 07:22:15 honda Exp $
|
---|
| 55 | */
|
---|
| 56 |
|
---|
| 57 | /*
|
---|
| 58 | * ããã»ããµä¾åã¢ã¸ã¥ã¼ã« ã¢ã»ã³ããªè¨èªé¨ï¼H8ç¨ï¼
|
---|
| 59 | */
|
---|
| 60 |
|
---|
| 61 | #define _MACRO_ONLY
|
---|
| 62 | #include "jsp_kernel.h"
|
---|
| 63 | #include "offset.h"
|
---|
| 64 |
|
---|
| 65 | /*
|
---|
| 66 | * NMIãé¤ããã¹ã¦ã®å²è¾¼ã¿ãç¦æ¢
|
---|
| 67 | */
|
---|
| 68 | #define DISINT orc.b #H8INT_DIS_ALL, ccr
|
---|
| 69 |
|
---|
| 70 | /*
|
---|
| 71 | * ãã¹ã¦ã®å²è¾¼ã¿ã許å¯
|
---|
| 72 | */
|
---|
| 73 | #define ENAINT andc.b #H8INT_ENA_ALL, ccr
|
---|
| 74 |
|
---|
| 75 |
|
---|
| 76 | .h8300h
|
---|
| 77 |
|
---|
| 78 | .text
|
---|
| 79 | .align 2
|
---|
| 80 |
|
---|
| 81 | /*
|
---|
| 82 | * ã¿ã¹ã¯ãã£ã¹ãããã£
|
---|
| 83 | *
|
---|
| 84 | * ã_dispatch ã¯ãå²è¾¼ã¿å¤ãã¹ãã«ã¦ã³ã¿ = 0,å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 85 |
|
---|
| 86 | * ã§å¼ã³åºããªããã°ãªããªãï¼exit_and_dispatch ãï¼å²è¾¼ã¿ãã¹ã
|
---|
| 87 | * ã«ã¦ã³ã¿ = 0ã»å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 88 | ã§å¼ã³åºãã®ãååã§ãããï¼ã«ã¼ãã«
|
---|
| 89 | * èµ·åæã«å¯¾å¿ããããï¼å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ = 1ã§å¼ã³åºããå ´åã«
|
---|
| 90 | * ã対å¿ãã¦ããï¼
|
---|
| 91 | */
|
---|
| 92 |
|
---|
| 93 | .global _dispatch
|
---|
| 94 | _dispatch:
|
---|
| 95 | push.l er4 /* er4ã6ãä¿å */
|
---|
| 96 | push.l er5
|
---|
| 97 | push.l er6
|
---|
| 98 | mov.l @_runtsk, er0 /* er0 <- runtsk */
|
---|
| 99 | mov.l sp, @(TCB_sp, er0) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ãä¿å */
|
---|
| 100 | mov.l #dispatch_r, er1 /* å®è¡åéçªå° */
|
---|
| 101 | mov.l er1, @(TCB_pc, er0)
|
---|
| 102 | bra dispatcher
|
---|
| 103 |
|
---|
| 104 | dispatch_r:
|
---|
| 105 | pop.l er6 /* er4ã6ã復å
|
---|
| 106 | */
|
---|
| 107 | pop.l er5
|
---|
| 108 | pop.l er4
|
---|
| 109 | mov.l @_runtsk, er0
|
---|
| 110 | mov.b @(TCB_enatex, er0), r1l /* runtsk->enatex ã®ãã§ã㯠*/
|
---|
| 111 | btst #TCB_enatex_bit, r1l
|
---|
| 112 | beq dispatch_r_1
|
---|
| 113 | mov.l @(TCB_texptn, er0), er1 /* runtsk->texptn ã®ãã§ã㯠*/
|
---|
| 114 | beq dispatch_r_1
|
---|
| 115 | jmp @_call_texrtn
|
---|
| 116 |
|
---|
| 117 | dispatch_r_1:
|
---|
| 118 | rts /* dispatch()ã®å¼ã³åºãå
|
---|
| 119 | ã¸ãªã¿ã¼ã³ */
|
---|
| 120 |
|
---|
| 121 | .global _exit_and_dispatch
|
---|
| 122 | _exit_and_dispatch:
|
---|
| 123 | /* å²ãè¾¼ã¿ç¦æ¢ã§å¼ã°ãã */
|
---|
| 124 | mov.b #0, r0l /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ãã¯ãªã¢ */
|
---|
| 125 | mov.b r0l, @_intnest
|
---|
| 126 |
|
---|
| 127 | /*
|
---|
| 128 | *ããã£ã¹ãããã£æ¬ä½
|
---|
| 129 | */
|
---|
| 130 | dispatcher:
|
---|
| 131 | /*
|
---|
| 132 | * ããã«ã¯å²ãè¾¼ã¿ç¦æ¢ã§æ¥ããã¨
|
---|
| 133 | */
|
---|
| 134 |
|
---|
| 135 | /*
|
---|
| 136 | * ããã§runtskã«schedtskã代å
|
---|
| 137 | ¥ããã®ã¯ï¼ã¤ã®æå³ãããã
|
---|
| 138 | * ã(1) schedtsk != NULLã®å ´å
|
---|
| 139 | * ããããé常ã®ã¿ã¹ã¯åãæ¿ããè¡ãã
|
---|
| 140 | * ã(2) schedtsk == NULLã®å ´å
|
---|
| 141 | * ããããruntskã«NULLã代å
|
---|
| 142 | ¥ãã¦ããã
|
---|
| 143 | * ããããï¼dispatcher_1以éã®å²è¾¼ã¿å¾
|
---|
| 144 | ã¡ã§å²è¾¼ã¿ãå
|
---|
| 145 | ¥ãããã®ä¸ã§
|
---|
| 146 | * ãããããiget_tid()ãã³ã¼ã«ãããã¨ãã«æ£ããTSK_NONEãè¿ããã
|
---|
| 147 | * ãããããã«ã¯ãå®è¡ç¶æ
|
---|
| 148 | ã®ã¿ã¹ã¯ããªãæã«ãruntskãNULLã«ãã¦
|
---|
| 149 | * ãããããããå¿
|
---|
| 150 | è¦ããããï¼
|
---|
| 151 | */
|
---|
| 152 | mov.l @_schedtsk, er0 /* er0 <- schedtsk */
|
---|
| 153 | mov.l er0, @_runtsk /* schedtskãruntskã« */
|
---|
| 154 | /* å®è¡ãã¹ãã¿ã¹ã¯ããªããã°ãå²è¾¼ã¿å¾
|
---|
| 155 | ã¡ã¸åå² */
|
---|
| 156 | beq dispatcher_1
|
---|
| 157 | mov.l @(TCB_sp, er0), sp
|
---|
| 158 | mov.l @(TCB_pc, er0), er0 /* å®è¡åéçªå°ã復帰 */
|
---|
| 159 | jmp @er0
|
---|
| 160 |
|
---|
| 161 |
|
---|
| 162 | /*
|
---|
| 163 | * å®è¡ãã¹ãã¿ã¹ã¯ããªãå ´åã®å²è¾¼ã¿å¾
|
---|
| 164 | ã¡
|
---|
| 165 | *
|
---|
| 166 | * ããã§å²è¾¼ã¿ã¢ã¼ãã«åãæããã®ã¯ï¼ããã§çºçããå²è¾¼ã¿å¦ç
|
---|
| 167 | * ã«ã©ã®ã¹ã¿ãã¯ã使ããã¨ããåé¡ã®è§£æ±ºã¨ï¼å²è¾¼ã¿ãã³ãã©å
|
---|
| 168 | ã§
|
---|
| 169 | * ã®ã¿ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ããäºã¤ã®æå³ãããï¼
|
---|
| 170 | */
|
---|
| 171 | dispatcher_1:
|
---|
| 172 | /* ã¹ã¿ãã¯ãå²ãè¾¼ã¿ã¹ã¿ãã¯ã«åæ¿ã */
|
---|
| 173 | mov.l #STACKTOP, sp
|
---|
| 174 | /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ãï¼ã«ãã */
|
---|
| 175 | mov.b #1, r0l
|
---|
| 176 | mov.b r0l, @_intnest
|
---|
| 177 |
|
---|
| 178 | /*
|
---|
| 179 | * r1lï¼å²è¾¼ã¿è¨±å¯æã«ccrã«è¨å®ããå¤
|
---|
| 180 | *ãããå²è¾¼ã¿ãã³ãã©å
|
---|
| 181 | ã§ã¯chg_ipmã使ç¨ã§ããªãã®ã§ã
|
---|
| 182 | *ãããtask_intmaskã¯1åèªã¿è¾¼ãã§ããã°ãOK
|
---|
| 183 | */
|
---|
| 184 | #ifdef SUPPORT_CHG_IPM
|
---|
| 185 | mov.b @_task_intmask, r1l
|
---|
| 186 | #else /* SUPPORT_CHG_IPM */
|
---|
| 187 | mov.b #H8INT_ENA_ALL, r1l
|
---|
| 188 | #endif /* SUPPORT_CHG_IPM */
|
---|
| 189 |
|
---|
| 190 | /* CPUããã¯ãã©ã°ãã¯ãªã¢ */
|
---|
| 191 | sub.l er0, er0
|
---|
| 192 | mov.l er0, @_iscpulocked
|
---|
| 193 |
|
---|
| 194 |
|
---|
| 195 | dispatcher_2_enable_interrupt:
|
---|
| 196 | /*
|
---|
| 197 | *ãldcå½ä»¤ç´å¾ã¯å²è¾¼ã¿ç¦æ¢ã§ãããå²è¾¼ã¿è¦æ±ããã£ã¦ã
|
---|
| 198 | *ã次ã®å½ä»¤ãå®è¡ãããã
|
---|
| 199 | *ãï¼å²è¾¼ã¿ããæ»ã£ã¦ãã¦sleepããã±ã¼ã¹ã¯ãªãï¼
|
---|
| 200 | */
|
---|
| 201 | ldc.b r1l, ccr /* å²ãè¾¼ã¿è¨±å¯ */
|
---|
| 202 | #ifndef NO_SLEEP
|
---|
| 203 | sleep /* å²è¾¼ã¿å¾
|
---|
| 204 | ã¡ */
|
---|
| 205 | #else /* NO_SLEEP */
|
---|
| 206 | nop
|
---|
| 207 | #endif /* NO_SLEEP */
|
---|
| 208 | DISINT /* å²ãè¾¼ã¿ç¦æ¢ */
|
---|
| 209 |
|
---|
| 210 | mov.l @_reqflg, er0 /* reqflgã®ãã§ã㯠*/
|
---|
| 211 | /* reqflgã¯BOOLå -> intå(32bits) */
|
---|
| 212 | /* reqflg==NULLãªãã°ããã1度å²è¾¼ã¿å¾
|
---|
| 213 | ã¡ */
|
---|
| 214 | beq dispatcher_2_enable_interrupt
|
---|
| 215 | sub.l er0, er0
|
---|
| 216 | mov.l er0, @_reqflg /* reqflgã®ã¯ãªã¢ */
|
---|
| 217 | /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ãã¯ãªã¢ */
|
---|
| 218 | mov.b r0l, @_intnest
|
---|
| 219 | bra dispatcher
|
---|
| 220 |
|
---|
| 221 | /*
|
---|
| 222 | *
|
---|
| 223 | * å²è¾¼ã¿ãã³ãã©å
|
---|
| 224 | ¥å£å¦ç
|
---|
| 225 | *ããå²è¾¼ã¿è¦å ã«ä¾ãããå
|
---|
| 226 | ±éãªé¨å
|
---|
| 227 | *ããï¼cpu_config.hã®INTHDR_ENTRYããã®ç¶ãï¼
|
---|
| 228 | *
|
---|
| 229 | *ãããã以ä¸ã®ç¶æ
|
---|
| 230 | ã§ããã«ãã£ã¦ãã
|
---|
| 231 | *ãããããã»å²è¾¼ã¿ç¦æ¢
|
---|
| 232 | *ãããããã»er0ãer3éé¿æ¸ã¿
|
---|
| 233 | *ãããããã»er2ï¼Cè¨èªã«ã¼ãã³ã®å
|
---|
| 234 | é ã¢ãã¬ã¹
|
---|
| 235 | *ãããããã»r3lï¼å²è¾¼ã¿è¨±å¯æã«å²è¾¼ã¿ãã¹ã¯ã«è¨å®ããå¤
|
---|
| 236 | */
|
---|
| 237 | .global _common_interrupt_process
|
---|
| 238 | _common_interrupt_process:
|
---|
| 239 | push.l er4 /* æé©å対çã§er4ãéé¿ */
|
---|
| 240 | mov.b @_intnest, r0l /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®ãã§ã㯠*/
|
---|
| 241 | bne _interrupt_from_int /* intnetã0ã§ãªããã°ã*/
|
---|
| 242 | /* å¤éå²è¾¼ã¿ã®å¦ç㸠*/
|
---|
| 243 |
|
---|
| 244 | /*
|
---|
| 245 | *ãå段ã®å²è¾¼ã¿ã®å ´å
|
---|
| 246 | */
|
---|
| 247 | mov.b #1, r1l /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿âï¼ */
|
---|
| 248 | mov.b r1l, @_intnest
|
---|
| 249 | mov.l sp, er0
|
---|
| 250 | mov.l #STACKTOP, sp /* ã¹ã¿ãã¯åæ¿ */
|
---|
| 251 | push.l er0 /* ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ã®éé¿ */
|
---|
| 252 | ldc.b r3l, ccr /* å²è¾¼ã¿è¨±å¯ */
|
---|
| 253 | jsr @er2 /* Cè¨èªã«ã¼ãã³å¼ã³åºã */
|
---|
| 254 | DISINT /* å²è¾¼ã¿ç¦æ¢ */
|
---|
| 255 | mov.b #0, r0l /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®ã¯ãªã¢ */
|
---|
| 256 | mov.b r0l, @_intnest
|
---|
| 257 | mov.l @sp, sp /* ã¹ã¿ãã¯åæ¿ */
|
---|
| 258 | mov.l @_reqflg, er0 /* reqflgã®ãã§ã㯠*/
|
---|
| 259 | beq _ret_to_task_int /* reqflgãFALSEãªã */
|
---|
| 260 | /* ret_to_task_intã«é£ã¶ */
|
---|
| 261 | sub.l er0, er0
|
---|
| 262 | mov.l er0, @_reqflg /* reqflgãã¯ãªã¢ */
|
---|
| 263 | bra ret_int /* åºå£å¦çã¸ã¸ã£ã³ã */
|
---|
| 264 |
|
---|
| 265 | /*
|
---|
| 266 | *ãå¤éå²è¾¼ã¿ã®å ´å
|
---|
| 267 | *ããå²è¾¼ã¿ç¦æ¢ã§ããã«ãã£ã¦ãã
|
---|
| 268 | *
|
---|
| 269 | *ããå²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®ã¤ã³ã¯ãªã¡ã³ãã¯ä»¥ä¸ã®çç±ã§
|
---|
| 270 | *ããçç¥ãã¦ãã
|
---|
| 271 | *ãããã»å²è¾¼ã¿ã2ã¬ãã«ãããªã
|
---|
| 272 | *ãããã»CPUä¾å¤ããµãã¼ãããªã
|
---|
| 273 | *ãããããexc_sense_context()ã®ãã¨ãèæ
|
---|
| 274 | ®ããªãã¦ãè¯ã
|
---|
| 275 | */
|
---|
| 276 | _interrupt_from_int:
|
---|
| 277 | /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®ã¤ã³ã¯ãªã¡ã³ãã¯çç¥ */
|
---|
| 278 | ldc.b r3l, ccr /* å²è¾¼ã¿è¨±å¯ */
|
---|
| 279 | jsr @er2 /* Cè¨èªã«ã¼ãã³å¼ã³åºã */
|
---|
| 280 | DISINT /* å²è¾¼ã¿ç¦æ¢ */
|
---|
| 281 | /* å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®ãã£ã¯ãªã¡ã³ãã¯çç¥ */
|
---|
| 282 |
|
---|
| 283 | /*
|
---|
| 284 | *ãæ¬æ¥ã¯ããã§æ»ãå
|
---|
| 285 | ããå²è¾¼ã¿å¾
|
---|
| 286 | ã¡ã®sleepå½ä»¤ãã©ããã®ãã§ã
|
---|
| 287 | *ãã¯ãå¿
|
---|
| 288 | è¦ã§ãããï¼ãããå²è¾¼ã¿ãã³ãã©å
|
---|
| 289 | ã§reqflg=TRUEã«ãã¦
|
---|
| 290 | *ãããã£ã¹ãããã£ãå¼ã°ããªãï¼ã¿ã¹ã¯ãå®è¡ãããªãï¼
|
---|
| 291 | *ãH8ã®å ´åãsleepå½ä»¤ã®ç´åã«ããå²è¾¼ã¿è¨±å¯ã®ldcå½ä»¤ã®å®è¡ç´
|
---|
| 292 | *ãå¾ã¯å²è¾¼ã¿ç¦æ¢ã§ãããå²è¾¼ã¿è¦æ±ããã£ãã¨ãã¦ãå²è¾¼ã¿ã¯å
|
---|
| 293 | *ããä»ããªãã§ãsleepå½ä»¤ãå®è¡ãããããã®ãããå²è¾¼ã¿ãã
|
---|
| 294 | *ãæ»ã£ãç´å¾ã«sleepå½ä»¤ãå®è¡ãããã±ã¼ã¹ã¯èæ
|
---|
| 295 | ®ããªãã¦è¯ãã
|
---|
| 296 | */
|
---|
| 297 |
|
---|
| 298 | /*
|
---|
| 299 | *ããã£ã¹ãããã£ãå¼ã°ãã«ãå²è¾¼ã¿å
|
---|
| 300 | ã«æ»ãå ´å
|
---|
| 301 | */
|
---|
| 302 | _ret_to_task_int:
|
---|
| 303 | /* ã¬ã¸ã¹ã¿ã復å
|
---|
| 304 | */
|
---|
| 305 | pop.l er4 /* er4ã¯æé©å対ç */
|
---|
| 306 | pop.l er3
|
---|
| 307 | pop.l er2
|
---|
| 308 | pop.l er1
|
---|
| 309 | pop.l er0
|
---|
| 310 | rte /* å²è¾¼ã¿å
|
---|
| 311 | ã¸ãªã¿ã¼ã³ */
|
---|
| 312 |
|
---|
| 313 | /*
|
---|
| 314 | * åºå£å¦çã«ããã¦ã¹ã¿ãã¯ãã¤ã³ã¿ãæãã¦ããçªå°ããCCRã¬ã¸ã¹ã¿ã
|
---|
| 315 | * ç©ã¾ãã¦ããçªå°ã¾ã§ã®ãªãã»ããã®å®ç¾©
|
---|
| 316 | *
|
---|
| 317 | *ã +0:er4
|
---|
| 318 | *ã +4:er3
|
---|
| 319 | *ã +8:er2
|
---|
| 320 | *ã+12:er1
|
---|
| 321 | *ã+16:er0
|
---|
| 322 | * +20:ccr âãããspç¸å¯¾ã¢ã¯ã»ã¹ãã
|
---|
| 323 | */
|
---|
| 324 | #define OFFSET_CCR 20
|
---|
| 325 |
|
---|
| 326 | /*
|
---|
| 327 | * å²è¾¼ã¿ãã³ãã©åºå£å¦ç
|
---|
| 328 | *
|
---|
| 329 | * æ»ãå
|
---|
| 330 | ãã¿ã¹ã¯ã§reqflgãã»ããããã¦ããå ´åã®ã¿ããã«ããã
|
---|
| 331 | * å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ = 0,å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 332 | ,ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã
|
---|
| 333 | * ä¿åããç¶æ
|
---|
| 334 | ã§å¼ã³åºããã¨ã
|
---|
| 335 | *
|
---|
| 336 | */
|
---|
| 337 |
|
---|
| 338 | ret_int:
|
---|
| 339 | mov.l @_enadsp, er0 /* enadspã®ãã§ã㯠*/
|
---|
| 340 | beq ret_int_1 /* ãã£ã¹ãããç¦æ¢ãªãret_int_1㸠*/
|
---|
| 341 |
|
---|
| 342 | mov.l @_runtsk, er0 /* er0 <- runtsk */
|
---|
| 343 | mov.l @_schedtsk, er1 /* er1 <- schedtsk */
|
---|
| 344 | cmp.l er0, er1 /* runtsk 㨠schedtsk ãæ¯è¼ */
|
---|
| 345 | beq ret_int_1 /* åããªãret_int_1㸠*/
|
---|
| 346 |
|
---|
| 347 | push.l er5 /* ã¬ã¸ã¹ã¿éé¿ */
|
---|
| 348 | push.l er6
|
---|
| 349 |
|
---|
| 350 | mov.l sp, @(TCB_sp, er0) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ãä¿å */
|
---|
| 351 | mov.l #ret_int_r, er1 /* å®è¡åéçªå° */
|
---|
| 352 | mov.l er1, @(TCB_pc, er0)
|
---|
| 353 | bra dispatcher:16
|
---|
| 354 | /* 8ãããPCç¸å¯¾åå²ã§ã¯å±ããªãããã16ãããæå® */
|
---|
| 355 |
|
---|
| 356 | /*
|
---|
| 357 | * å²è¾¼ã¿ã®åºå£ã§ãã£ã¹ãããã£ããããã«æ»ã£ã¦ãã
|
---|
| 358 | */
|
---|
| 359 | ret_int_r:
|
---|
| 360 | pop.l er6 /* ã¬ã¸ã¹ã¿å¾©å
|
---|
| 361 | */
|
---|
| 362 | pop.l er5
|
---|
| 363 |
|
---|
| 364 | /*
|
---|
| 365 | *ãã¿ã¹ã¯ã¹ã¤ããããªãå ´åã¯ããããåæµãã
|
---|
| 366 | */
|
---|
| 367 | ret_int_1:
|
---|
| 368 | /* ã¿ã¹ã¯ä¾å¤è¨±å¯ç¶æ
|
---|
| 369 | ã®ãã§ã㯠*/
|
---|
| 370 | mov.l @_runtsk, er0
|
---|
| 371 | mov.b @(TCB_enatex, er0), r1l
|
---|
| 372 | btst #TCB_enatex_bit, r1l /* TCB.enatex=0 -> CCR.Z=1 */
|
---|
| 373 | beq ret_int_2 /* ã¿ã¹ã¯ä¾å¤ç¦æ¢ç¶æ
|
---|
| 374 | ãªãã¸ã£ã³ã */
|
---|
| 375 |
|
---|
| 376 | /* ã¿ã¹ã¯ä¾å¤å¦çè¦æ±ã®ãã§ã㯠*/
|
---|
| 377 | mov.l @(TCB_texptn, er0), er1
|
---|
| 378 | beq ret_int_2 /* ã¿ã¹ã¯ä¾å¤å¦çè¦æ±ããªããã°ã¸ã£ã³ã */
|
---|
| 379 | jsr @_call_texrtn /* ã¿ã¹ã¯ä¾å¤å¦çã«ã¼ãã³èµ·å */
|
---|
| 380 |
|
---|
| 381 | ret_int_2:
|
---|
| 382 | /* CPUããã¯ãã©ã°ãã¯ãªã¢ */
|
---|
| 383 | sub.l er0, er0
|
---|
| 384 | mov.l er0, @_iscpulocked
|
---|
| 385 |
|
---|
| 386 | #ifdef SUPPORT_CHG_IPM
|
---|
| 387 | /*
|
---|
| 388 | * ã¹ã¿ãã¯ã«ç©ãã§ããccrï¼æ»ãå
|
---|
| 389 | ã®å²è¾¼ã¿ãã¹ã¯ï¼ã
|
---|
| 390 | *ãtask_intmaskã«ãããï¼ä¸è¨åç
|
---|
| 391 | §ï¼
|
---|
| 392 | */
|
---|
| 393 | mov.b @(OFFSET_CCR, sp), r0l
|
---|
| 394 | mov.b @_task_intmask, r1l
|
---|
| 395 | and.b #H8INT_ENA_ALL, r0l
|
---|
| 396 | or.b r1l, r0l
|
---|
| 397 | mov.b r0l, @(OFFSET_CCR, sp)
|
---|
| 398 | #endif /* SUPPORT_CHG_IPM */
|
---|
| 399 | /* ã¬ã¸ã¹ã¿ã復å
|
---|
| 400 | */
|
---|
| 401 | pop.l er4 /* ã +0:er4 */
|
---|
| 402 | pop.l er3 /* ã +4:er3 */
|
---|
| 403 | pop.l er2 /* ã +8:er2 */
|
---|
| 404 | pop.l er1 /* ã+12:er1 */
|
---|
| 405 | pop.l er0 /* ã+16:er0 */
|
---|
| 406 | /* +20:ccr âãããæ¸ãæãã */
|
---|
| 407 | rte
|
---|
| 408 |
|
---|
| 409 |
|
---|
| 410 | /*
|
---|
| 411 | * ã¿ã¹ã¯èµ·åå¦ç
|
---|
| 412 | */
|
---|
| 413 |
|
---|
| 414 | .globl _activate_r
|
---|
| 415 | _activate_r:
|
---|
| 416 | /* CPUããã¯ãã©ã°ãã¯ãªã¢ */
|
---|
| 417 | sub.l er0, er0
|
---|
| 418 | mov.l er0, @_iscpulocked
|
---|
| 419 |
|
---|
| 420 | /* å²è¾¼ã¿è¨±å¯ */
|
---|
| 421 | #ifdef SUPPORT_CHG_IPM
|
---|
| 422 | mov.b @_task_intmask, r0l
|
---|
| 423 | ldc.b r0l, ccr
|
---|
| 424 | #else /* SUPPORT_CHG_IPM */
|
---|
| 425 | ENAINT
|
---|
| 426 | #endif /* SUPPORT_CHG_IPM */
|
---|
| 427 |
|
---|
| 428 | mov.l #_ext_tsk, er2
|
---|
| 429 | push.l er2
|
---|
| 430 | mov.l @_runtsk, er2
|
---|
| 431 | mov.l @(TCB_tinib, er2), er2
|
---|
| 432 | mov.l @(TINIB_task, er2), er1 /* ã¿ã¹ã¯èµ·åçªå° */
|
---|
| 433 | /* æ¡å¼µæ
|
---|
| 434 | å ±ï¼ã¿ã¹ã¯ã¸ã®å¼æ°ï¼ */
|
---|
| 435 | mov.l @(TINIB_exinf, er2), er0
|
---|
| 436 | jmp @er1
|
---|
| 437 |
|
---|
| 438 |
|
---|
| 439 | /*
|
---|
| 440 | * å¾®å°æéå¾
|
---|
| 441 | ã¡
|
---|
| 442 | * ããããã¿ã¤ã宣è¨ã¯sil.hå
|
---|
| 443 | ã«ãã
|
---|
| 444 | * ã void sil_dly_nse(UINT dlytim);
|
---|
| 445 | */
|
---|
| 446 | .globl _sil_dly_nse
|
---|
| 447 | _sil_dly_nse:
|
---|
| 448 | /* er0 = dlytim */
|
---|
| 449 | sub.l #SIL_DLY_TIM1, er0
|
---|
| 450 | ble sil_dly_nse_2
|
---|
| 451 | /* dlytim < SIL_DLY_TIM1 ãªãã«ã¼ãçµäº */
|
---|
| 452 | sil_dly_nse_1:
|
---|
| 453 | sub.l #SIL_DLY_TIM2, er0
|
---|
| 454 | bgt sil_dly_nse_1
|
---|
| 455 | /* dlytim > SIL_DLY_TIM2 ãªãã«ã¼ãç¶è¡ */
|
---|
| 456 | sil_dly_nse_2:
|
---|
| 457 | rts
|
---|
| 458 |
|
---|
| 459 |
|
---|
| 460 | /**************************************************************
|
---|
| 461 | * 以ä¸ãå
|
---|
| 462 | ±éé¨ã¨ã®ã¤ã³ã¿ã¼ãã§ã¼ã¹ã«ã¯å«ã¾ããªãç¬èªã®é¨å
|
---|
| 463 | **************************************************************/
|
---|
| 464 |
|
---|
| 465 | /*
|
---|
| 466 | * no_reg_exception()
|
---|
| 467 | * CPUä¾å¤ã¨ãã¦ç»é²ããã¦ããªãä¾å¤ãçºçããã¨å¼ã³åºãããã
|
---|
| 468 | * ä¾å¤ãçºçããæç¹ã®PC,ER0ã7ãåºåãã¦ã«ã¼ãã«
|
---|
| 469 | * ãåæ¢ããã
|
---|
| 470 | *
|
---|
| 471 | * ãã¹ã¿ãã¯æ§é
|
---|
| 472 | *ãã +0:er0
|
---|
| 473 | *ãã +4:er1
|
---|
| 474 | *ãã +8:er2
|
---|
| 475 | *ãã+12:er3
|
---|
| 476 | *ãã+16:er4
|
---|
| 477 | *ãã+20:er5
|
---|
| 478 | *ãã+24:er6
|
---|
| 479 | *ãã+28:crr
|
---|
| 480 | *ãã+29:pc
|
---|
| 481 | *ãã+32ã:å²è¾¼ã¿åã«ä½¿ç¨ããã¦ããã¹ã¿ãã¯é å
|
---|
| 482 | */
|
---|
| 483 | .globl _no_reg_exception
|
---|
| 484 | _no_reg_exception:
|
---|
| 485 |
|
---|
| 486 | push.l er6 /* ER0ã6ãä¿å */
|
---|
| 487 | push.l er5
|
---|
| 488 | push.l er4
|
---|
| 489 | push.l er3
|
---|
| 490 | push.l er2
|
---|
| 491 | push.l er1
|
---|
| 492 | push.l er0
|
---|
| 493 |
|
---|
| 494 | mov.l sp, er0 /* å¼æ°è¨å® */
|
---|
| 495 | /* SP 㯠+32 ã§ãçºçæç¹ã®å¤ */
|
---|
| 496 | jsr @_cpu_experr /* cpu_experr()ã®å¼ã³åºã */
|
---|
| 497 |
|
---|