[363] | 1 | ;
|
---|
| 2 | ; TOPPERS/JSP Kernel
|
---|
| 3 | ; Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
| 4 | ; Just Standard Profile Kernel
|
---|
| 5 | ;
|
---|
| 6 | ; Copyright (C) 2006-2010 by Witz Corporation, JAPAN
|
---|
| 7 | ;
|
---|
| 8 | ; The above copyright holders grant permission gratis to use,
|
---|
| 9 | ; duplicate, modify, or redistribute (hereafter called use) this
|
---|
| 10 | ; software (including the one made by modifying this software),
|
---|
| 11 | ; provided that the following four conditions (1) through (4) are
|
---|
| 12 | ; satisfied.
|
---|
| 13 | ;
|
---|
| 14 | ; (1) When this software is used in the form of source code, the above
|
---|
| 15 | ; copyright notice, this use conditions, and the disclaimer shown
|
---|
| 16 | ; below must be retained in the source code without modification.
|
---|
| 17 | ;
|
---|
| 18 | ; (2) When this software is redistributed in the forms usable for the
|
---|
| 19 | ; development of other software, such as in library form, the above
|
---|
| 20 | ; copyright notice, this use conditions, and the disclaimer shown
|
---|
| 21 | ; below must be shown without modification in the document provided
|
---|
| 22 | ; with the redistributed software, such as the user manual.
|
---|
| 23 | ;
|
---|
| 24 | ; (3) When this software is redistributed in the forms unusable for the
|
---|
| 25 | ; development of other software, such as the case when the software
|
---|
| 26 | ; is embedded in a piece of equipment, either of the following two
|
---|
| 27 | ; conditions must be satisfied:
|
---|
| 28 | ;
|
---|
| 29 | ; (a) The above copyright notice, this use conditions, and the
|
---|
| 30 | ; disclaimer shown below must be shown without modification in
|
---|
| 31 | ; the document provided with the redistributed software, such as
|
---|
| 32 | ; the user manual.
|
---|
| 33 | ;
|
---|
| 34 | ; (b) How the software is to be redistributed must be reported to the
|
---|
| 35 | ; TOPPERS Project according to the procedure described
|
---|
| 36 | ; separately.
|
---|
| 37 | ;
|
---|
| 38 | ; (4) The above copyright holders and the TOPPERS Project are exempt
|
---|
| 39 | ; from responsibility for any type of damage directly or indirectly
|
---|
| 40 | ; caused from the use of this software and are indemnified by any
|
---|
| 41 | ; users or end users of this software from any and all causes of
|
---|
| 42 | ; action whatsoever.
|
---|
| 43 | ;
|
---|
| 44 | ; THIS SOFTWARE IS PROVIDED "AS IS." THE ABOVE COPYRIGHT HOLDERS AND
|
---|
| 45 | ; THE TOPPERS PROJECT DISCLAIM ANY EXPRESS OR IMPLIED WARRANTIES,
|
---|
| 46 | ; INCLUDING, BUT NOT LIMITED TO, ITS APPLICABILITY TO A PARTICULAR
|
---|
| 47 | ; PURPOSE. IN NO EVENT SHALL THE ABOVE COPYRIGHT HOLDERS AND THE
|
---|
| 48 | ; TOPPERS PROJECT BE LIABLE FOR ANY TYPE OF DAMAGE DIRECTLY OR
|
---|
| 49 | ; INDIRECTLY CAUSED FROM THE USE OF THIS SOFTWARE.
|
---|
| 50 | ;
|
---|
| 51 | ; ä¸è¨èä½æ¨©è
|
---|
| 52 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
|
---|
| 53 | ; ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»
|
---|
| 54 | ; åé
|
---|
| 55 | å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 56 | ; (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½æ¨©
|
---|
| 57 | ; 表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼ã¹
|
---|
| 58 | ; ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 59 | ; (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿ç¨
|
---|
| 60 | ; ã§ããå½¢ã§åé
|
---|
| 61 | å¸ããå ´åã«ã¯ï¼åé
|
---|
| 62 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 63 | ã
|
---|
| 64 | ; ãã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿
|
---|
| 65 | ; 証è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 66 | ; (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿ç¨
|
---|
| 67 | ; ã§ããªãå½¢ã§åé
|
---|
| 68 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºãããã¨ï¼
|
---|
| 69 | ; (a) åé
|
---|
| 70 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 71 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½
|
---|
| 72 | ; 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 73 | ; (b) åé
|
---|
| 74 | å¸ã®å½¢æ
|
---|
| 75 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«å ±
|
---|
| 76 | ; åãããã¨ï¼
|
---|
| 77 | ; (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害
|
---|
| 78 | ; ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 79 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 80 | 責ãããã¨ï¼ã¾ãï¼
|
---|
| 81 | ; æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãçç±ã«åºã¥
|
---|
| 82 | ; ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 83 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 84 | 責ãããã¨ï¼
|
---|
| 85 | ;
|
---|
| 86 | ; æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 87 | ãã
|
---|
| 88 | ; ã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®çã«å¯¾ã
|
---|
| 89 | ; ãé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨
|
---|
| 90 | ; ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè²
|
---|
| 91 | ; ããªãï¼
|
---|
| 92 | ;
|
---|
| 93 | ; @(#) $Id: cpu_support.app,v 1.1 2006/04/10 08:19:25 honda Exp $
|
---|
| 94 | ;
|
---|
| 95 |
|
---|
| 96 | $MAXIMUM
|
---|
| 97 | module cpu_support_app
|
---|
| 98 |
|
---|
| 99 | ;
|
---|
| 100 | ; ããã»ããµä¾åã¢ã¸ã¥ã¼ã« ã¢ã»ã³ããªè¨èªé¨ï¼TLCS-900L1ç¨ï¼
|
---|
| 101 | ;
|
---|
| 102 |
|
---|
| 103 | #define SUPPORT_CHG_IPM
|
---|
| 104 | #include "jsp_rename.h"
|
---|
| 105 | #include "cpu_rename.h"
|
---|
| 106 | #include "sys_rename.h"
|
---|
| 107 | #include "offset.inc"
|
---|
| 108 |
|
---|
| 109 | ; å¤é¨åç
|
---|
| 110 | §ã·ã³ãã«å®ç¾©
|
---|
| 111 | extern large __StackTop
|
---|
| 112 | extern large _reqflg
|
---|
| 113 | extern large _enadsp
|
---|
| 114 | extern large _intcnt
|
---|
| 115 | extern large _runtsk
|
---|
| 116 | extern large _schedtsk
|
---|
| 117 | extern large _call_texrtn
|
---|
| 118 | extern large _task_intmask
|
---|
| 119 |
|
---|
| 120 |
|
---|
| 121 | f_code section code large align=1,1
|
---|
| 122 |
|
---|
| 123 | ;
|
---|
| 124 | ; ã¿ã¹ã¯ãã£ã¹ãããã£
|
---|
| 125 | ;
|
---|
| 126 | ; dispatch ã¯ï¼ã¿ã¹ã¯ã³ã³ããã¹ãç¶æ
|
---|
| 127 | ã»å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 128 | ã§å¼ã³åºããªã
|
---|
| 129 | ; ãã°ãªããªãï¼exit_and_dispatch ãï¼ã¿ã¹ã¯ã³ã³ããã¹ãç¶æ
|
---|
| 130 | ã»å²è¾¼
|
---|
| 131 | ; ã¿ç¦æ¢ç¶æ
|
---|
| 132 | ã§å¼ã³åºãã®ãååã§ãããï¼ã«ã¼ãã«èµ·åæã«å¯¾å¿ããããï¼
|
---|
| 133 | ; å²è¾¼ã¿ã³ã³ããã¹ãç¶æ
|
---|
| 134 | ã§å¼ã³åºããå ´åã«ã対å¿ãã¦ããï¼
|
---|
| 135 | ; å¼ã³åºãæ¡ä»¶: SRã®IFF=7 (å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 136 | ),
|
---|
| 137 | ; intcnt = 0(ã¿ã¹ã¯ã³ã³ããã¹ã), ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 138 | ;
|
---|
| 139 | public _dispatch
|
---|
| 140 |
|
---|
| 141 | _dispatch:
|
---|
| 142 | push xiz ; é¢æ°å¼åºã§ä¿è·ãå¿
|
---|
| 143 | è¦ãªã¬ã¸ã¹ã¿ã®ä¿å
|
---|
| 144 | ld xwa, (_runtsk) ; åä½ä¸ã¿ã¹ã¯ã®TCBãåå¾
|
---|
| 145 | ld (xwa+TCB_sp), xsp ;
|
---|
| 146 | lda xhl, dispatch_r ;
|
---|
| 147 | ld (xwa+TCB_pc), xhl ;
|
---|
| 148 | jr dispatcher ;
|
---|
| 149 |
|
---|
| 150 | ;
|
---|
| 151 | ; å¼ã³åºãæ¡ä»¶: SRã®IFF=7 (å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 152 | ),
|
---|
| 153 | ; intcnt = 0(ã¿ã¹ã¯ã³ã³ããã¹ã), ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 154 | ;
|
---|
| 155 | ; xwa ã«ã¯runtsk ã®ã¢ãã¬ã¹ãæ ¼ç´ããã¦ãã
|
---|
| 156 | ;
|
---|
| 157 | dispatch_r:
|
---|
| 158 | pop xiz ;
|
---|
| 159 | ld bc, (xwa+TCB_enatex) ;
|
---|
| 160 | bit TCB_enatex_bit, bc ;
|
---|
| 161 | jr z, dispatch_r_1 ; enatex ã FALSE ãªããªã¿ã¼ã³
|
---|
| 162 | cpw (xwa+TCB_texptn), 0 ; ã¿ã¹ã¯ä¾å¤è¦å ãããå ´å
|
---|
| 163 | jp nz, _call_texrtn ;
|
---|
| 164 | ; call_texrtnããç´æ¥dispatch å¼ã³åºãå
|
---|
| 165 | ã¸æ»ã.
|
---|
| 166 | dispatch_r_1: ; ã¿ã¹ã¯ä¾å¤ãå®è¡ããªãå ´å
|
---|
| 167 | ret ; dispatch å¼ã³åºãå
|
---|
| 168 | ã¸æ»ã.
|
---|
| 169 |
|
---|
| 170 | ;
|
---|
| 171 | ; ã¿ã¹ã¯èµ·åæå¦ç
|
---|
| 172 | ;
|
---|
| 173 | ; ããã§ã¯, CPUããã¯è§£é¤ç¶æ
|
---|
| 174 | ã«ã, ã¿ã¹ã¯ãèµ·åãã.
|
---|
| 175 | ;
|
---|
| 176 | ; å¼ã³åºãæ¡ä»¶: SRã®IFF=7 (å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 177 | ),
|
---|
| 178 | ; intcnt = 0(ã¿ã¹ã¯ã³ã³ããã¹ã), ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 179 | ;
|
---|
| 180 | public _activate_r
|
---|
| 181 |
|
---|
| 182 | _activate_r:
|
---|
| 183 | pop xhl ; ã¿ã¹ã¯ã®èµ·åçªå°ãwhl ã«è¨å®
|
---|
| 184 | #ifdef SUPPORT_CHG_IPM /* t_unlock_cpu ç¸å½ã®å¦ç */
|
---|
| 185 | push sr ; å²è¾¼ã¿ãã¹ã¯ã« task_intmask ãè¨å®
|
---|
| 186 | ld wa, (_task_intmask) ;
|
---|
| 187 | andw (xsp), ~0x7000 ;
|
---|
| 188 | or (xsp), wa ;
|
---|
| 189 | pop sr ;
|
---|
| 190 | #else /* SUPPORT_CHG_IPM */
|
---|
| 191 | ei 0 ; å²è¾¼ã¿è¨±å¯
|
---|
| 192 | #endif /* SUPPORT_CHG_IPM */
|
---|
| 193 | jp xhl
|
---|
| 194 |
|
---|
| 195 | ;
|
---|
| 196 | ; dispatcherå¼ã³åºãæ¡ä»¶:
|
---|
| 197 | ; ã»ãã¹ã¦ã®ã¿ã¹ã¯ã®ã³ã³ããã¹ãã¯ä¿åããã¦ãã.
|
---|
| 198 | ; ã»SRã®IFF=7 (å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 199 | )
|
---|
| 200 | ; ã»ã³ã³ããã¹ãã¯ã¿ã¹ã¯ã³ã³ããã¹ã(intcnt=0)
|
---|
| 201 | ; dispatcher å¼åºæã®ã¹ã¿ãã¯:
|
---|
| 202 | ; dispatch ããããå ´å: ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 203 | ; exit_and_dispatch ããããå ´å:
|
---|
| 204 | ; exit_task ããããå ´åã¯ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 205 | ; ã«ã¼ãã«èµ·åæã¯å²è¾¼ã¿ã¹ã¿ãã¯
|
---|
| 206 | ; ret_int ããããå ´å: ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 207 | ; dispatcher_2 ã§ã®å²è¾¼ã¿å¾
|
---|
| 208 | ã¡ããããå ´å: å²è¾¼ã¿ã¹ã¿ãã¯
|
---|
| 209 | ;
|
---|
| 210 | public _exit_and_dispatch
|
---|
| 211 |
|
---|
| 212 | _exit_and_dispatch:
|
---|
| 213 | ldw (_intcnt), 0 ; ãã¹ãã«ã¦ã³ã¿ã¯ãªã¢(ã¿ã¹ã¯ã³ã³ããã¹ã)
|
---|
| 214 | dispatcher:
|
---|
| 215 | ld xwa, (_schedtsk) ; schedtsk ã runtsk ã«è¨å®
|
---|
| 216 | ld (_runtsk), xwa ;
|
---|
| 217 | or xwa, xwa ; å®è¡ããã¿ã¹ã¯ãç¡ããã°ã¢ã¤ãã«ã«ã¼ãã¸
|
---|
| 218 | jr z, pre_idle_loop ;
|
---|
| 219 | ld xsp, (xwa+TCB_sp) ; ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ã復帰
|
---|
| 220 | ld xhl, (xwa+TCB_pc) ;
|
---|
| 221 | jp xhl ; å®è¡åéçªå°ã¸ã¸ã£ã³ã
|
---|
| 222 | ;
|
---|
| 223 | ; å®è¡ãã¹ãã¿ã¹ã¯ãç¾ããã¾ã§å¾
|
---|
| 224 | ã¤å¦ç
|
---|
| 225 | ;
|
---|
| 226 | pre_idle_loop:
|
---|
| 227 | ld xsp, __StackTop ; å²è¾¼ã¿ç¨ã®ã¹ã¿ãã¯ã¸åæ¿ã
|
---|
| 228 | incw 1, (_intcnt) ; éã¿ã¹ã¯ã³ã³ããã¹ã
|
---|
| 229 | ;
|
---|
| 230 | ; ããã§éã¿ã¹ã¯ã³ã³ããã¹ã,å²è¾¼ã¿ã¹ã¿ãã¯ã«åãæããã®ã¯,
|
---|
| 231 | ; ããã§çºçããå²è¾¼ã¿å¦çã«ã©ã®ã¹ã¿ãã¯ã使ããã¨ããåé¡ã®è§£æ±ºã¨,
|
---|
| 232 | ; å²è¾¼ã¿ãã³ãã©å
|
---|
| 233 | ã§ã®ãã£ã¹ãããé²æ¢ã¨ãã2ã¤ã®æå³ãããï¼
|
---|
| 234 | ;
|
---|
| 235 | idle_loop:
|
---|
| 236 | #ifdef SUPPORT_CHG_IPM /* t_unlock_cpu ç¸å½ã®å¦ç */
|
---|
| 237 | push sr ; å²è¾¼ã¿ãã¹ã¯ã« task_intmask ãè¨å®
|
---|
| 238 | ld wa, (_task_intmask) ;
|
---|
| 239 | andw (xsp), ~0x7000 ;
|
---|
| 240 | or (xsp), wa ;
|
---|
| 241 | pop sr ;
|
---|
| 242 | #else /* SUPPORT_CHG_IPM */
|
---|
| 243 | ei 0 ; å²è¾¼ã¿è¨±å¯
|
---|
| 244 | #endif /* SUPPORT_CHG_IPM */
|
---|
| 245 |
|
---|
| 246 | halt ; IDLE2ç¶æ
|
---|
| 247 | ã¸é·ç§»
|
---|
| 248 | nop ; ä¸è¨haltãã³ã¡ã³ã(nopã®ã¿)ã«ããã¨
|
---|
| 249 | nop ; ä½æ¶è²»åä½ãè¡ããªãã¢ã¤ãã«ã«ã¼ãã¨ãªã.
|
---|
| 250 | nop ;
|
---|
| 251 | nop ;
|
---|
| 252 | ei 7 ; å²è¾¼ã¿ç¦æ¢
|
---|
| 253 | cpw (_reqflg), 0 ; reqflg ã FALSE ã§ããã°
|
---|
| 254 | jr z, idle_loop ; idle_loop ã¸
|
---|
| 255 | ldw (_reqflg), 0 ; reqflg <--- FALSE
|
---|
| 256 | decw 1, (_intcnt) ; ã¿ã¹ã¯ã³ã³ããã¹ãã«æ»ã
|
---|
| 257 | jr dispatcher ; dispatcher ã¸æ»ã
|
---|
| 258 |
|
---|
| 259 | ;
|
---|
| 260 | ; é
|
---|
| 261 | 延ãã£ã¹ãããå¦ç
|
---|
| 262 | ;
|
---|
| 263 | ; å¼ã³åºãæ¡ä»¶: SRã®IFF=7 (å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 264 | ),
|
---|
| 265 | ; intcnt = 0(ã¿ã¹ã¯ã³ã³ããã¹ã), ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 266 | ; reqflg = TRUE
|
---|
| 267 | ; INTNESTã¬ã¸ã¹ã¿ = 1
|
---|
| 268 | ;
|
---|
| 269 | ret_int:
|
---|
| 270 | ldw (_reqflg), 0 ; reqflg <--- FALSE
|
---|
| 271 | ld de, 0 ;
|
---|
| 272 | ldc intnest, de ; ãã£ã¹ããããããintnest ã¯0
|
---|
| 273 | push xiz ; é¢æ°å¼åºã§ä¿è·ãå¿
|
---|
| 274 | è¦ãªã¬ã¸ã¹ã¿ã®ä¿å
|
---|
| 275 | ld xwa, (_runtsk) ; runtsk ãåå¾
|
---|
| 276 | cpw (_enadsp), 0 ; enadsp ã FALSE ãªã
|
---|
| 277 | jr z, ret_int_r ; ret_int_r ã¸
|
---|
| 278 | cp xwa, (_schedtsk) ; runtsk ã¨schedtsk ãåããªã
|
---|
| 279 | jr z, ret_int_r ; ret_int_r ã¸
|
---|
| 280 | or xwa, xwa ; runtsk = NULL ãªã
|
---|
| 281 | jr z, dispatcher ; ä¿åããdispather ã¸
|
---|
| 282 | ld (xwa+TCB_sp), xsp ;
|
---|
| 283 | lda xhl, ret_int_r ;
|
---|
| 284 | ld (xwa+TCB_pc), xhl ;
|
---|
| 285 | jr dispatcher ;
|
---|
| 286 |
|
---|
| 287 | ;
|
---|
| 288 | ; å¼ã³åºãæ¡ä»¶: SRã®IFF=7 (å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 289 | ),
|
---|
| 290 | ; intcnt = 0(ã¿ã¹ã¯ã³ã³ããã¹ã), ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 291 | ; INTNESTã¬ã¸ã¹ã¿ = 0
|
---|
| 292 | ;
|
---|
| 293 | ; xwa ã«ã¯runtsk ã®ã¢ãã¬ã¹ãæ ¼ç´ããã¦ãã
|
---|
| 294 | ;
|
---|
| 295 | ret_int_r:
|
---|
| 296 | pop xiz
|
---|
| 297 | #ifdef SUPPORT_CHG_IPM /* ã¹ã¿ãã¯ã«ããSR ã®IFF ãæä½ */
|
---|
| 298 | ld de, (_task_intmask) ;
|
---|
| 299 | andw (xsp+24), ~0x7000 ;
|
---|
| 300 | or (xsp+24), de ;
|
---|
| 301 | #endif /* SUPPORT_CHG_IPM */
|
---|
| 302 | ld bc, (xwa+TCB_enatex) ;
|
---|
| 303 | bit TCB_enatex_bit, bc ;
|
---|
| 304 | jr z, nest_ctrl_r ; enatex ã FALSE ãªããªã¿ã¼ã³
|
---|
| 305 | cpw (xwa+TCB_texptn), 0 ; ã¿ã¹ã¯ä¾å¤è¦å ãããå ´å
|
---|
| 306 | call nz, _call_texrtn ;
|
---|
| 307 | nest_ctrl_r:
|
---|
| 308 | ld de, 1 ;
|
---|
| 309 | ldc intnest, de ; retiç¨ã«æ¬ä¼¼çã«intnest ã¯1
|
---|
| 310 | jr interrupt_r
|
---|
| 311 |
|
---|
| 312 | ;
|
---|
| 313 | ; å²è¾¼ã¿/CPUä¾å¤ã®å
|
---|
| 314 | ±éå¦ç
|
---|
| 315 | ;
|
---|
| 316 | ; å¼åºãæ¡ä»¶:
|
---|
| 317 | ; ã»SRã®IFF=7.
|
---|
| 318 | ; ã»ã¹ã¿ãã¯ã¯å¤éå²ãè¾¼ã¿ãªãå²è¾¼ã¿ã¹ã¿ãã¯, ããã§ãªããã°
|
---|
| 319 | ; ã¿ã¹ã¯ã¹ã¿ãã¯
|
---|
| 320 | ; ã»XHL ã«ã¯å²è¾¼ã¿/CPUä¾å¤ãã³ãã©ã®ã¢ãã¬ã¹ãæ ¼ç´ããã¦ãã.
|
---|
| 321 | ; ã»AW ã«ã¯æ¬å²è¾¼ã¿ã®åªå
|
---|
| 322 | 度ãè¨å®ããã SR ãæ ¼ç´ããã¦ãã.
|
---|
| 323 | ;
|
---|
| 324 | ; ã¬ã¸ã¹ã¿ãã¹ã¿ãã¯ä¸ã«ã©ã®ããã«ä¿åããã¦ãããã以ä¸ã«ç¤ºã.
|
---|
| 325 | ; ãã®å³ã§ã¯ä¸ãä½ä½, ä¸ãé«ä½ã®ã¢ãã¬ã¹ã§, ã¹ã¿ãã¯ã¯ä¸ãã
|
---|
| 326 | ; ä¸æ¹åã«åãã£ã¦ç©ã¿ä¸ãããããã®ã¨ãã.
|
---|
| 327 | ;
|
---|
| 328 | ; --------------------------------------
|
---|
| 329 | ; | CPUä¾å¤ãã³ãã©ã®å¼æ° |
|
---|
| 330 | ; | CPUä¾å¤æ
|
---|
| 331 | å ±(4byte) |
|
---|
| 332 | ; | |
|
---|
| 333 | ; | |
|
---|
| 334 | ; --------------------------------------
|
---|
| 335 | ; | XSP(4byte) | ã¿ã¹ã¯ã¹ã¿ãã¯ãã¤ã³ã¿ï¼
|
---|
| 336 | ; | â»å段ã®ã¿ | å段ã®å²è¾¼ã¿ã®ã¿ä¿æãããï¼
|
---|
| 337 | ; | |
|
---|
| 338 | ; | |
|
---|
| 339 | ; --------------------------------------
|
---|
| 340 | ; | XIY(4byte) |
|
---|
| 341 | ; | |
|
---|
| 342 | ; | |
|
---|
| 343 | ; | |
|
---|
| 344 | ; --------------------------------------
|
---|
| 345 | ; | XIX(4byte) |
|
---|
| 346 | ; | |
|
---|
| 347 | ; | |
|
---|
| 348 | ; | |
|
---|
| 349 | ; --------------------------------------
|
---|
| 350 | ; | XDE(4byte) |
|
---|
| 351 | ; | |
|
---|
| 352 | ; | |
|
---|
| 353 | ; | |
|
---|
| 354 | ; --------------------------------------
|
---|
| 355 | ; | XBC(4byte) |
|
---|
| 356 | ; | |
|
---|
| 357 | ; | |
|
---|
| 358 | ; | |
|
---|
| 359 | ; -------------------------------------- <-- å²è¾¼ã¿å
|
---|
| 360 | ¥ãå£å¦çã§å¦çãããï¼
|
---|
| 361 | ; | XHL(4byte) |
|
---|
| 362 | ; | |
|
---|
| 363 | ; | |
|
---|
| 364 | ; | |
|
---|
| 365 | ; --------------------------------------
|
---|
| 366 | ; | XAW(4byte) |
|
---|
| 367 | ; | |
|
---|
| 368 | ; | |
|
---|
| 369 | ; | |
|
---|
| 370 | ; -------------------------------------- <-- å²è¾¼ã¿çºçæã«ãã¼ãã¦ã§ã¢
|
---|
| 371 | ; | SR(2byte) | ã«ã¦å¦çãããï¼ p_excinfã¯
|
---|
| 372 | ; | | ãããæãããã«æ¼ç®ããï¼
|
---|
| 373 | ; --------------------------------------
|
---|
| 374 | ; | PC(4byte) |
|
---|
| 375 | ; | |
|
---|
| 376 | ; | |
|
---|
| 377 | ; | |
|
---|
| 378 | ; --------------------------------------
|
---|
| 379 | ;
|
---|
| 380 | ; ãã³ãã©ãããªã¿ã¼ã³ããå¾ã¯, å¤éå²è¾¼ã¿ã§ãªã, ã㤠reqflg ã
|
---|
| 381 | ; TRUE ã«ãªã£ãæã«ï¼ret_int ã¸åå²ããï¼
|
---|
| 382 | ;
|
---|
| 383 | ; å¤éå²è¾¼ã¿ãã©ããã¯å²è¾¼ã¿ãã¹ãã«ã¦ã³ã¿ã®å¤ã§å¤å®ãã.
|
---|
| 384 | ; intcnt != 0 ãªãã°å¤éå²è¾¼ã¿ã§ããã¨å¤å®ãã.
|
---|
| 385 | ; ãªãï¼ãã¼ãã¦ã§ã¢ä»æ§ä¸ï¼å²è¾¼ã¿çºçããå²è¾¼ã¿ç¦æ¢ãè¡ãã¾ã§ã®éã«
|
---|
| 386 | ; å¤éå²è¾¼ã¿ãçºçããã¨ï¼å¤éå²è¾¼ã¿ã§ãããã¨ãã½ããã¦ã§ã¢ã§æ¤ç¥ã§
|
---|
| 387 | ; ããªãããï¼æåã«çºçããå²è¾¼ã¿å¦çãå®è¡ããªãã¾ã¾ã¿ã¹ã¯ãã£ã¹
|
---|
| 388 | ; ãããããå¯è½æ§ãããï¼ãã®å¤éå²è¾¼ã¿ãæ¤ç¥ããããã«ãã¼ãã¦ã§ã¢
|
---|
| 389 | ; INTNEST ã¬ã¸ã¹ã¿ãå©ç¨ããï¼
|
---|
| 390 | ;
|
---|
| 391 | ; reqflg ã¯CPUããã¯ç¶æ
|
---|
| 392 | ã§ãã§ãã¯ãã. ããã§ãªãã¨ï¼
|
---|
| 393 | ; reqflg ãã§ãã¯å¾ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å
|
---|
| 394 | ã§
|
---|
| 395 | ; ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£ã¹ããããããªã.
|
---|
| 396 | ;
|
---|
| 397 | public _interrupt
|
---|
| 398 |
|
---|
| 399 | _interrupt:
|
---|
| 400 | push xbc ; ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã®æ®ããä¿å
|
---|
| 401 | push xde ;
|
---|
| 402 | push xix ;
|
---|
| 403 | push xiy ;
|
---|
| 404 |
|
---|
| 405 | ld xbc, xsp ; CPUä¾å¤æ
|
---|
| 406 | å ±å¼æ°ã«ä½¿ç¨ããããããã§åå¾
|
---|
| 407 | cpw (_intcnt), 0 ;
|
---|
| 408 | jr nz, from_int ;
|
---|
| 409 | ld xsp, __StackTop ; å段ã®å²è¾¼ã¿ã®å ´åã¹ã¿ãã¯ãåãæ¿ã
|
---|
| 410 | push xbc ; ã¿ã¹ã¯SPã®ä¿æ
|
---|
| 411 | from_int: ;
|
---|
| 412 | incw 1, (_intcnt) ; å²è¾¼ã¿ãã¹ãã«ã¦ã³ããã¤ã³ã¯ãªã¡ã³ã
|
---|
| 413 |
|
---|
| 414 | add xbc, 24 ; CPUä¾å¤æ
|
---|
| 415 | å ±å¼æ°çæ
|
---|
| 416 | push xbc ; å²è¾¼ã¿å¦çã§ã¯æªä½¿ç¨
|
---|
| 417 | push wa ;
|
---|
| 418 | pop sr ; æ¬å²è¾¼ã¿ããåªå
|
---|
| 419 | 度ã®é«ãå²è¾¼ã¿è¨±å¯
|
---|
| 420 | call xhl ; å²è¾¼ã¿ãã³ãã©/CPUä¾å¤å¦çãå¼ã³åºã
|
---|
| 421 | ei 7 ; å²è¾¼ã¿ç¦æ¢
|
---|
| 422 | pop xbc ; ã¹ã¿ãã¯æ°åãã(CPUä¾å¤æ
|
---|
| 423 | å ±å¼æ°)
|
---|
| 424 |
|
---|
| 425 | decw 1, (_intcnt) ; å²è¾¼ã¿ãã¹ãã«ã¦ã³ãããã¯ãªã¡ã³ã
|
---|
| 426 | jr nz, from_int_r ;
|
---|
| 427 | pop xbc ; å段ã®å²è¾¼ã¿ã®å ´åã¿ã¹ã¯SPã®å¾©å¸°
|
---|
| 428 | ld xsp, xbc ;
|
---|
| 429 | ldc de, intnest ; å²è¾¼ã¿çºçããå²è¾¼ã¿ç¦æ¢ã¾ã§ã®éã«å¤éå²è¾¼ã¿ã
|
---|
| 430 | djnz de, from_int_r ; çºçãã¦ããå ´åã¯ãã£ã¹ãããããªã
|
---|
| 431 | cpw (_reqflg), 0 ; reqflg ã TRUE ã§ããã°
|
---|
| 432 | jp nz, ret_int ; ret_int ã¸
|
---|
| 433 | from_int_r: ;
|
---|
| 434 | interrupt_r: ;
|
---|
| 435 | pop xiy ;ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã復帰
|
---|
| 436 | pop xix ;
|
---|
| 437 | pop xde ;
|
---|
| 438 | pop xbc ;
|
---|
| 439 | pop xhl ;
|
---|
| 440 | pop xwa ;
|
---|
| 441 | reti ;
|
---|
| 442 |
|
---|
| 443 | ;
|
---|
| 444 | ; æªä½¿ç¨å²è¾¼ã¿ã®å¦ç
|
---|
| 445 | ;
|
---|
| 446 | public unused_interrupt
|
---|
| 447 |
|
---|
| 448 | unused_interrupt:
|
---|
| 449 | reti
|
---|
| 450 |
|
---|
| 451 |
|
---|
| 452 | end
|
---|
| 453 |
|
---|
| 454 |
|
---|