[363] | 1 | /*
|
---|
| 2 | *
|
---|
| 3 | * TOPPERS/JSP Kernel
|
---|
| 4 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
| 5 | * Just Standard Profile Kernel
|
---|
| 6 | *
|
---|
| 7 | * Copyright (C) 2004 by Embedded and Real-Time Systems Laboratory
|
---|
| 8 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 9 | *
|
---|
| 10 | * ä¸è¨èä½æ¨©è
|
---|
| 11 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãï¼Free Software Foundation
|
---|
| 12 | * ã«ãã£ã¦å
|
---|
| 13 | ¬è¡¨ããã¦ãã GNU General Public License ã® Version 2 ã«è¨
|
---|
| 14 | * è¿°ããã¦ããæ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§ã¢
|
---|
| 15 | * ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
---|
| 16 | å¸ï¼ä»¥ä¸ï¼
|
---|
| 17 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 18 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
| 19 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
| 20 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 21 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 22 | * ç¨ã§ããå½¢ã§åé
|
---|
| 23 | å¸ããå ´åã«ã¯ï¼åé
|
---|
| 24 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
| 25 | * è
|
---|
| 26 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
| 27 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 28 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 29 | * ç¨ã§ããªãå½¢ã§åé
|
---|
| 30 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
| 31 | * ã¨ï¼
|
---|
| 32 | * (a) åé
|
---|
| 33 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 34 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
| 35 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 36 | * (b) åé
|
---|
| 37 | å¸ã®å½¢æ
|
---|
| 38 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
| 39 | * å ±åãããã¨ï¼
|
---|
| 40 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
| 41 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 42 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 43 | 責ãããã¨ï¼
|
---|
| 44 | *
|
---|
| 45 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 46 | ã
|
---|
| 47 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ã
|
---|
| 48 | * å«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´
|
---|
| 49 | * æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
---|
| 50 | *
|
---|
| 51 | * @(#) $Id: cpu_support.S,v 1.4 2005/07/06 01:48:21 honda Exp $
|
---|
| 52 | */
|
---|
| 53 |
|
---|
| 54 | #define _MACRO_ONLY
|
---|
| 55 |
|
---|
| 56 | /*
|
---|
| 57 | * ã¢ããªã±ã¼ã·ã§ã³ã¨å
|
---|
| 58 | ±éã®ã¤ã³ã¯ã«ã¼ããã¡ã¤ã«
|
---|
| 59 | */
|
---|
| 60 | #include <kernel.h>
|
---|
| 61 | /*
|
---|
| 62 | * ã¿ã¼ã²ããä¾åæ
|
---|
| 63 | å ±ã®å®ç¾©
|
---|
| 64 | */
|
---|
| 65 | #include <t_config.h>
|
---|
| 66 |
|
---|
| 67 | #include "jsp_kernel.h"
|
---|
| 68 | #include "offset.h"
|
---|
| 69 | #include <nios2.h>
|
---|
| 70 |
|
---|
| 71 | .set noat
|
---|
| 72 | .section .exceptions, "xa"
|
---|
| 73 | .align 2
|
---|
| 74 | .global _irq_entry
|
---|
| 75 | .type _irq_entry, @function
|
---|
| 76 | _irq_entry:
|
---|
| 77 | /*
|
---|
| 78 | * ä¾å¤è¦å ã®å¤å®
|
---|
| 79 | */
|
---|
| 80 | rdctl et, estatus
|
---|
| 81 | andi et, et, 1
|
---|
| 82 | beq et, zero, _check_trap
|
---|
| 83 | rdctl et, ipending
|
---|
| 84 | beq et, zero, _check_trap
|
---|
| 85 |
|
---|
| 86 |
|
---|
| 87 | /*
|
---|
| 88 | * ä¾å¤è¦å ã¯å²è¾¼ã¿
|
---|
| 89 | */
|
---|
| 90 | addi ea, ea, -4 /* æ»ãçªå°ããã¯ãªã¡ã³ã */
|
---|
| 91 |
|
---|
| 92 | addi sp, sp, -76 /* ã¬ã¸ã¹ã¿ã®ä¿å */
|
---|
| 93 | rdctl et, estatus
|
---|
| 94 | stw et, 0(sp)
|
---|
| 95 | stw at, 4(sp)
|
---|
| 96 | stw r2, 8(sp)
|
---|
| 97 | stw r3, 12(sp)
|
---|
| 98 | stw r4, 16(sp)
|
---|
| 99 | stw r5, 20(sp)
|
---|
| 100 | stw r6, 24(sp)
|
---|
| 101 | stw r7, 28(sp)
|
---|
| 102 | stw r8, 32(sp)
|
---|
| 103 | stw r9, 36(sp)
|
---|
| 104 | stw r10, 40(sp)
|
---|
| 105 | stw r11, 44(sp)
|
---|
| 106 | stw r12, 48(sp)
|
---|
| 107 | stw r13, 52(sp)
|
---|
| 108 | stw r14, 56(sp)
|
---|
| 109 | stw r15, 60(sp)
|
---|
| 110 | stw fp, 64(sp)
|
---|
| 111 | stw ra, 68(sp)
|
---|
| 112 | stw ea, 72(sp)
|
---|
| 113 |
|
---|
| 114 | /*
|
---|
| 115 | * å¤éå²è¾¼ã¿ãå¤å®
|
---|
| 116 | */
|
---|
| 117 | ldw r3, %gprel(interrupt_count)(gp) /* ãã¹ãåæ°ã®ãã§ã㯠*/
|
---|
| 118 | bltu zero, r3, nest_int
|
---|
| 119 |
|
---|
| 120 | movhi r2, %hiadj(STACKTOP-4)
|
---|
| 121 | addi r2, r2, %lo(STACKTOP-4)
|
---|
| 122 | stw sp, 0(r2) /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
|
---|
| 123 | mov sp, r2 /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
|
---|
| 124 | ¥ãæ¿ã */
|
---|
| 125 | nest_int:
|
---|
| 126 | /*
|
---|
| 127 | * å²è¾¼ã¿è¦å ã®å¤å®ã¨å¼ã³åºã
|
---|
| 128 | */
|
---|
| 129 | call int_handler_call
|
---|
| 130 |
|
---|
| 131 | ret_from_int:
|
---|
| 132 | ldw r3, %gprel(interrupt_count)(gp)
|
---|
| 133 | bltu zero, r3, res_reg_and_ret /* ãã¹ãåæ°ã1以ä¸ãªãæ»ã */
|
---|
| 134 |
|
---|
| 135 | ldw r2, 0(sp) /* ã¹ã¿ãã¯ãã¤ã³ã¿ãæ»ã */
|
---|
| 136 | mov sp, r2 /* ã¹ã¿ãã¯ãã¤ã³ã¿ãæ»ã */
|
---|
| 137 |
|
---|
| 138 | ldw r3, %gprel(reqflg)(gp) /* reqflgã®ãã§ã㯠*/
|
---|
| 139 | beq r3, zero, res_reg_and_ret
|
---|
| 140 | br ret_int
|
---|
| 141 |
|
---|
| 142 | res_reg_and_ret:
|
---|
| 143 | ldw et, 0(sp) /* ã¬ã¸ã¹ã¿ã®å¾©å¸° */
|
---|
| 144 | wrctl estatus, et
|
---|
| 145 | ldw at, 4(sp)
|
---|
| 146 | ldw r2, 8(sp)
|
---|
| 147 | ldw r3, 12(sp)
|
---|
| 148 | ldw r4, 16(sp)
|
---|
| 149 | ldw r5, 20(sp)
|
---|
| 150 | ldw r6, 24(sp)
|
---|
| 151 | ldw r7, 28(sp)
|
---|
| 152 | ldw r8, 32(sp)
|
---|
| 153 | ldw r9, 36(sp)
|
---|
| 154 | ldw r10, 40(sp)
|
---|
| 155 | ldw r11, 44(sp)
|
---|
| 156 | ldw r12, 48(sp)
|
---|
| 157 | ldw r13, 52(sp)
|
---|
| 158 | ldw r14, 56(sp)
|
---|
| 159 | ldw r15, 60(sp)
|
---|
| 160 | ldw fp, 64(sp)
|
---|
| 161 | ldw ra, 68(sp)
|
---|
| 162 | ldw ea, 72(sp)
|
---|
| 163 | addi sp, sp, 76
|
---|
| 164 | eret
|
---|
| 165 |
|
---|
| 166 |
|
---|
| 167 | _check_trap:
|
---|
| 168 | /*
|
---|
| 169 | * Trapãå¤å®
|
---|
| 170 | */
|
---|
| 171 | ldw et, -4(ea) /* ä¾å¤ãåºããå½ä»¤ãåå¾ */
|
---|
| 172 | xorhi et, et, 0x003b /* ä¸ä½16bit */
|
---|
| 173 | xori et, et, 0x683a /* ä¸ä½16bit */
|
---|
| 174 | beq et, zero, trap_handler
|
---|
| 175 |
|
---|
| 176 | _check_exc:
|
---|
| 177 | addi sp, sp, -76
|
---|
| 178 | rdctl et, estatus
|
---|
| 179 | stw et, 0(sp)
|
---|
| 180 | stw at, 4(sp)
|
---|
| 181 | stw r2, 8(sp)
|
---|
| 182 | stw r3, 12(sp)
|
---|
| 183 | stw r4, 16(sp)
|
---|
| 184 | stw r5, 20(sp)
|
---|
| 185 | stw r6, 24(sp)
|
---|
| 186 | stw r7, 28(sp)
|
---|
| 187 | stw r8, 32(sp)
|
---|
| 188 | stw r9, 36(sp)
|
---|
| 189 | stw r10, 40(sp)
|
---|
| 190 | stw r11, 44(sp)
|
---|
| 191 | stw r12, 48(sp)
|
---|
| 192 | stw r13, 52(sp)
|
---|
| 193 | stw r14, 56(sp)
|
---|
| 194 | stw r15, 60(sp)
|
---|
| 195 | stw fp, 64(sp)
|
---|
| 196 | stw ra, 68(sp)
|
---|
| 197 | stw ea, 72(sp)
|
---|
| 198 | mov r4, sp /* ãã³ãã©ã®å¼æ° */
|
---|
| 199 |
|
---|
| 200 | /*
|
---|
| 201 | * å¤éå²è¾¼ã¿ãå¤å®
|
---|
| 202 | */
|
---|
| 203 | ldw r3, %gprel(interrupt_count)(gp) /* ãã¹ãåæ°ã®ãã§ã㯠*/
|
---|
| 204 | bltu zero, r3, nest_int_exc
|
---|
| 205 |
|
---|
| 206 | movhi r2, %hiadj(STACKTOP-4)
|
---|
| 207 | addi r2, r2, %lo(STACKTOP-4)
|
---|
| 208 | stw sp, 0(r2) /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®ä¿å */
|
---|
| 209 | mov sp, r2 /* ã¹ã¿ãã¯ãã¤ã³ã¿ã®å
|
---|
| 210 | ¥ãæ¿ã */
|
---|
| 211 | nest_int_exc:
|
---|
| 212 |
|
---|
| 213 | call exc_handler_call /* CPUä¾å¤ãã³ãã©å¼ã³åºãã«ã¼ãã³ã®å®è¡ */
|
---|
| 214 |
|
---|
| 215 | br ret_from_int /* ãªã¿ã¼ã³å¦ç */
|
---|
| 216 |
|
---|
| 217 |
|
---|
| 218 | trap_handler:
|
---|
| 219 | /*
|
---|
| 220 | * Trapãã³ãã©ã¼
|
---|
| 221 | */
|
---|
| 222 | eret
|
---|
| 223 |
|
---|
| 224 |
|
---|
| 225 |
|
---|
| 226 | .set noat
|
---|
| 227 | .align 2
|
---|
| 228 | .global ret_int
|
---|
| 229 | .global ret_exc
|
---|
| 230 | ret_int:
|
---|
| 231 | ret_exc:
|
---|
| 232 | stw zero, %gprel(reqflg)(gp) /* reqflg ã FALSEã« */
|
---|
| 233 | ldw r5, %gprel(runtsk)(gp) /* r5 <- runtsk */
|
---|
| 234 | ldw r6, %gprel(enadsp)(gp) /* r6 <- enadsp */
|
---|
| 235 | beq r6, zero, ret_int_1 /* enadsp ã FALSE ãªã ret_int_1 㸠*/
|
---|
| 236 | ldw r4, %gprel(schedtsk)(gp) /* r4 <- schedtsk */
|
---|
| 237 | beq r4, r5, ret_int_1 /* runtsk 㨠schedtskãåããªãret_int_1㸠*/
|
---|
| 238 | addi sp, sp, -32 /* æ®ãã®ã¬ã¸ã¹ã¿ãä¿å */
|
---|
| 239 | stw r16, 0(sp)
|
---|
| 240 | stw r17, 4(sp)
|
---|
| 241 | stw r18, 8(sp)
|
---|
| 242 | stw r19, 12(sp)
|
---|
| 243 | stw r20, 16(sp)
|
---|
| 244 | stw r21, 20(sp)
|
---|
| 245 | stw r22, 24(sp)
|
---|
| 246 | stw r23, 28(sp)
|
---|
| 247 | stw sp, TCB_sp(r5) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãTCBã«ä¿å */
|
---|
| 248 | movhi r2, %hiadj(ret_int_r) /* å®è¡éå§çªå°ãä¿å */
|
---|
| 249 | addi r2, r2, %lo(ret_int_r)
|
---|
| 250 | stw r2, TCB_pc(r5) /* å®è¡åéçªå°ãTCBã«ä¿å */
|
---|
| 251 | br dispatcher
|
---|
| 252 |
|
---|
| 253 | ret_int_r:
|
---|
| 254 | ldw r16, 0(sp) /* ã¬ã¸ã¹ã¿ã復帰 */
|
---|
| 255 | ldw r17, 4(sp)
|
---|
| 256 | ldw r18, 8(sp)
|
---|
| 257 | ldw r19, 12(sp)
|
---|
| 258 | ldw r20, 16(sp)
|
---|
| 259 | ldw r21, 20(sp)
|
---|
| 260 | ldw r22, 24(sp)
|
---|
| 261 | ldw r23, 28(sp)
|
---|
| 262 | addi sp, sp, 32
|
---|
| 263 | ret_int_1:
|
---|
| 264 | /*
|
---|
| 265 | * ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®èµ·å
|
---|
| 266 | * ret_int_r 㯠dispatcher ããå¼ã³åºãããããï¼
|
---|
| 267 | * tcbã®ã¢ãã¬ã¹ã¯ r4 ã«å
|
---|
| 268 | ¥ã£ã¦ãã
|
---|
| 269 | */
|
---|
| 270 | ldw r5, TCB_enatex(r4) /* r5 <- enatex */
|
---|
| 271 | #if TCB_enatex_mask > 0xffff
|
---|
| 272 | andhi r6, r5, %hi(TCB_enatex_mask)
|
---|
| 273 | #else
|
---|
| 274 | andi r6, r5, %lo(TCB_enatex_mask)
|
---|
| 275 | #endif /* TCB_enatex_mask > 0xffff */
|
---|
| 276 | andhi r6, r5, 4
|
---|
| 277 | beq r6, zero, ret_int_2 /* enatex ã FALSE ãªããªã¿ã¼ã³ */
|
---|
| 278 | ldw r7, TCB_texptn(r4) /* r7 <- texptn, texptnã0ã§ãªããã° */
|
---|
| 279 | beq zero, r7, ret_int_2
|
---|
| 280 | call call_texrtn /* ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®å¼ã³åºã */
|
---|
| 281 |
|
---|
| 282 | ret_int_2:
|
---|
| 283 | ldw et, 0(sp) /* ã¬ã¸ã¹ã¿ã復帰 */
|
---|
| 284 | wrctl estatus, et
|
---|
| 285 | ldw at, 4(sp)
|
---|
| 286 | ldw r2, 8(sp)
|
---|
| 287 | ldw r3, 12(sp)
|
---|
| 288 | ldw r4, 16(sp)
|
---|
| 289 | ldw r5, 20(sp)
|
---|
| 290 | ldw r6, 24(sp)
|
---|
| 291 | ldw r7, 28(sp)
|
---|
| 292 | ldw r8, 32(sp)
|
---|
| 293 | ldw r9, 36(sp)
|
---|
| 294 | ldw r10, 40(sp)
|
---|
| 295 | ldw r11, 44(sp)
|
---|
| 296 | ldw r12, 48(sp)
|
---|
| 297 | ldw r13, 52(sp)
|
---|
| 298 | ldw r14, 56(sp)
|
---|
| 299 | ldw r15, 60(sp)
|
---|
| 300 | ldw fp, 64(sp)
|
---|
| 301 | ldw ra, 68(sp)
|
---|
| 302 | ldw ea, 72(sp)
|
---|
| 303 | addi sp, sp, 76
|
---|
| 304 | eret
|
---|
| 305 |
|
---|
| 306 |
|
---|
| 307 |
|
---|
| 308 |
|
---|
| 309 | .global dispatch
|
---|
| 310 | .align 2
|
---|
| 311 | dispatch:
|
---|
| 312 | addi sp, sp, -40 /* ã¬ã¸ã¹ã¿ãä¿å */
|
---|
| 313 | stw r16, 0(sp)
|
---|
| 314 | stw r17, 4(sp)
|
---|
| 315 | stw r18, 8(sp)
|
---|
| 316 | stw r19, 12(sp)
|
---|
| 317 | stw r20, 16(sp)
|
---|
| 318 | stw r21, 20(sp)
|
---|
| 319 | stw r22, 24(sp)
|
---|
| 320 | stw r23, 28(sp)
|
---|
| 321 | stw fp, 32(sp)
|
---|
| 322 | stw ra, 36(sp)
|
---|
| 323 | ldw r4, %gprel(runtsk)(gp) /* r4 <- runtsk */
|
---|
| 324 | stw sp, TCB_sp(r4) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãTCBã«ä¿å */
|
---|
| 325 | movhi r5, %hiadj(dispatch_r) /* å®è¡éå§çªå°ãä¿å */
|
---|
| 326 | addi r5, r5, %lo(dispatch_r)
|
---|
| 327 | stw r5, TCB_pc(r4) /* å®è¡åéçªå°ãTCBã«ä¿å */
|
---|
| 328 | br dispatcher
|
---|
| 329 |
|
---|
| 330 | dispatch_r:
|
---|
| 331 | ldw r16, 0(sp) /* ã¬ã¸ã¹ã¿ã復帰 */
|
---|
| 332 | ldw r17, 4(sp)
|
---|
| 333 | ldw r18, 8(sp)
|
---|
| 334 | ldw r19, 12(sp)
|
---|
| 335 | ldw r20, 16(sp)
|
---|
| 336 | ldw r21, 20(sp)
|
---|
| 337 | ldw r22, 24(sp)
|
---|
| 338 | ldw r23, 28(sp)
|
---|
| 339 | ldw fp, 32(sp)
|
---|
| 340 | /*
|
---|
| 341 | * ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®èµ·å
|
---|
| 342 | * dispatch_r 㯠dispatcher ããå¼ã³åºãããããï¼
|
---|
| 343 | * tcb ã®ã¢ãã¬ã¹ã¯ r4 ã«å
|
---|
| 344 | ¥ã£ã¦ãã
|
---|
| 345 | */
|
---|
| 346 | ldw r5, TCB_enatex(r4) /* r5 <- enatex */
|
---|
| 347 | #if TCB_enatex_mask > 0xffff
|
---|
| 348 | andhi r6, r5, %hi(TCB_enatex_mask)
|
---|
| 349 | #else
|
---|
| 350 | andi r6, r5, %lo(TCB_enatex_mask)
|
---|
| 351 | #endif /* TCB_enatex_mask > 0xffff */
|
---|
| 352 | beq r6, zero, dispatch_r_1 /* enatex ã FALSE ãªããªã¿ã¼ã³ */
|
---|
| 353 | ldw r7, TCB_texptn(r4) /* r7 <- texptn, texptnã0ã§ãªããã° */
|
---|
| 354 | beq r7, zero, dispatch_r_1
|
---|
| 355 | call call_texrtn /* ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®å¼ã³åºã */
|
---|
| 356 |
|
---|
| 357 | dispatch_r_1:
|
---|
| 358 | ldw ra, 36(sp) /* æ®ãã®ã¬ã¸ã¹ã¿ã復帰 */
|
---|
| 359 | addi sp, sp, 40
|
---|
| 360 | ret
|
---|
| 361 |
|
---|
| 362 |
|
---|
| 363 |
|
---|
| 364 | .global exit_and_dispatch
|
---|
| 365 | exit_and_dispatch:
|
---|
| 366 | stw zero, %gprel(interrupt_count)(gp) /* interrupt_count ãã¯ãªã¢ */
|
---|
| 367 | dispatcher:
|
---|
| 368 | /*
|
---|
| 369 | * ããã¯å²è¾¼ã¿ç¦æ¢ã§æ¥ããã¨
|
---|
| 370 | */
|
---|
| 371 | ldw r4, %gprel(schedtsk)(gp) /* r4 <- schedtsk */
|
---|
| 372 | stw r4, %gprel(runtsk)(gp) /* schedtsk ã runtskã« */
|
---|
| 373 | beq r4, zero, dispatcher_1 /* schedtskãããã */
|
---|
| 374 | ldw sp, TCB_sp(r4) /* TCBããã¿ã¹ã¯ã¹ã¿ãã¯ã復帰 */
|
---|
| 375 | ldw r5, TCB_pc(r4) /* TCBããå®è¡åéçªå°ã復帰 */
|
---|
| 376 | jmp r5
|
---|
| 377 | dispatcher_1:
|
---|
| 378 | /*
|
---|
| 379 | * ããã§å²è¾¼ã¿ã¢ã¼ãã«åãæ¿ããã®ã¯ï¼ããã§çºçããå²è¾¼ã¿å¦ç
|
---|
| 380 | * ã«ã©ã®ã¹ã¿ãã¯ã使ããã¨ããåé¡ã®è§£æ±ºã¨ï¼å²è¾¼ã¿ãã³ãã©å
|
---|
| 381 | ã§
|
---|
| 382 | * ã®ã¿ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ãã2ã¤ã®æå³ãããï¼
|
---|
| 383 | */
|
---|
| 384 | movhi sp, %hiadj(STACKTOP) /* å²è¾¼ã¿ã¹ã¿ãã¯ã«å¤æ´ */
|
---|
| 385 | addi sp, sp, %lo(STACKTOP)
|
---|
| 386 | movi r5, 1 /* interrupt_count ã1ã« */
|
---|
| 387 | stw r5, %gprel(interrupt_count)(gp)
|
---|
| 388 | dispatcher_2:
|
---|
| 389 | wrctl status, r5 /* å²è¾¼ã¿ã®è¨±å¯ */
|
---|
| 390 | nop
|
---|
| 391 | nop
|
---|
| 392 | nop
|
---|
| 393 | nop
|
---|
| 394 | wrctl status, zero /* å²è¾¼ã¿ã®ç¦æ¢ */
|
---|
| 395 | ldw r6, %gprel(reqflg)(gp) /* r6 <- reqflg */
|
---|
| 396 | beq r6, zero, dispatcher_2 /* reqflg ã FALSE ãªã */
|
---|
| 397 | stw zero, %gprel(interrupt_count)(gp) /* interrupt_count ãã¯ãªã¢ */
|
---|
| 398 | stw zero, %gprel(reqflg)(gp) /* reqflg ã FALSE ã« */
|
---|
| 399 | br dispatcher
|
---|
| 400 |
|
---|
| 401 |
|
---|
| 402 | .text
|
---|
| 403 | .global activate_r
|
---|
| 404 | .align 2
|
---|
| 405 | activate_r:
|
---|
| 406 | movi r2, 1
|
---|
| 407 | wrctl status, r2 /* å²è¾¼ã¿è¨±å¯ */
|
---|
| 408 | ldw r4, 4(sp) /* å¼æ°(exinf) */
|
---|
| 409 | ldw r2, 0(sp) /* ã¿ã¹ã¯ã®å®è¡çªå° */
|
---|
| 410 | addi sp, sp, 8
|
---|
| 411 | movhi ra, %hiadj(ext_tsk)
|
---|
| 412 | addi ra, ra, %lo(ext_tsk)
|
---|
| 413 | jmp r2 /* ã¿ã¹ã¯ã®å®è¡éå§ */
|
---|
| 414 |
|
---|
| 415 |
|
---|