| 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 | *
|
|---|
| 9 | * ä¸è¨èä½æ¨©è
|
|---|
| 10 | ã¯ï¼ä»¥ä¸ã® (1)ã(4) ã®æ¡ä»¶ãï¼Free Software Foundation
|
|---|
| 11 | * ã«ãã£ã¦å
|
|---|
| 12 | ¬è¡¨ããã¦ãã GNU General Public License ã® Version 2 ã«è¨
|
|---|
| 13 | * è¿°ããã¦ããæ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§ã¢
|
|---|
| 14 | * ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
|---|
| 15 | å¸ï¼ä»¥ä¸ï¼
|
|---|
| 16 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
|---|
| 17 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
|---|
| 18 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
|---|
| 19 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
|---|
| 20 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
|---|
| 21 | * ç¨ã§ããå½¢ã§åé
|
|---|
| 22 | å¸ããå ´åã«ã¯ï¼åé
|
|---|
| 23 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
|---|
| 24 | * è
|
|---|
| 25 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
|---|
| 26 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
|---|
| 27 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
|---|
| 28 | * ç¨ã§ããªãå½¢ã§åé
|
|---|
| 29 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
|---|
| 30 | * ã¨ï¼
|
|---|
| 31 | * (a) åé
|
|---|
| 32 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
|---|
| 33 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
|---|
| 34 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
|---|
| 35 | * (b) åé
|
|---|
| 36 | å¸ã®å½¢æ
|
|---|
| 37 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
|---|
| 38 | * å ±åãããã¨ï¼
|
|---|
| 39 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
|---|
| 40 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
|---|
| 41 | ããã³TOPPERSããã¸ã§ã¯ããå
|
|---|
| 42 | 責ãããã¨ï¼
|
|---|
| 43 | *
|
|---|
| 44 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
|---|
| 45 | ã
|
|---|
| 46 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ã
|
|---|
| 47 | * å«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´
|
|---|
| 48 | * æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
|---|
| 49 | *
|
|---|
| 50 | * @(#) $Id: sys_support.S,v 1.14 2007/07/27 11:28:44 honda Exp $
|
|---|
| 51 | */
|
|---|
| 52 |
|
|---|
| 53 | #define _MACRO_ONLY
|
|---|
| 54 | #include "jsp_kernel.h"
|
|---|
| 55 |
|
|---|
| 56 | .text
|
|---|
| 57 | .align 4
|
|---|
| 58 | .global Interrupt_exception_handler
|
|---|
| 59 | .global _save_all
|
|---|
| 60 | .global _restore_all_and_bret
|
|---|
| 61 | .global _restore_all_and_eret
|
|---|
| 62 | .global _process_exception
|
|---|
| 63 |
|
|---|
| 64 | _process_exception:
|
|---|
| 65 | addi sp, sp, -4
|
|---|
| 66 | sw (sp+4), ra
|
|---|
| 67 | /*
|
|---|
| 68 | rcsr r2, ie
|
|---|
| 69 | ori r3, r0, 1
|
|---|
| 70 | and r2, r2, r3
|
|---|
| 71 | be r2, r0, _normal_process
|
|---|
| 72 | bug:
|
|---|
| 73 | bi bug
|
|---|
| 74 | */
|
|---|
| 75 | _normal_process:
|
|---|
| 76 | mvhi r2, hi(exception_count)
|
|---|
| 77 | ori r2, r2, lo(exception_count)
|
|---|
| 78 | lw r3, (r2+0)
|
|---|
| 79 | addi r4, r3, 1
|
|---|
| 80 | sw (r2+0), r4
|
|---|
| 81 | bne r3, r0, nest_exception
|
|---|
| 82 |
|
|---|
| 83 | mv r2, sp
|
|---|
| 84 | mvhi r3, hi(_fstack)
|
|---|
| 85 | ori r3, r3, lo(_fstack)
|
|---|
| 86 | mv sp, r3
|
|---|
| 87 | addi sp, sp, -4
|
|---|
| 88 | sw (sp+4), r2
|
|---|
| 89 |
|
|---|
| 90 | nest_exception:
|
|---|
| 91 |
|
|---|
| 92 | ori r2, r0, 6
|
|---|
| 93 | be r1, r2, _process_interrupt
|
|---|
| 94 | rcsr r2, ie
|
|---|
| 95 | ori r2, r2, 0x1
|
|---|
| 96 | wcsr ie, r2
|
|---|
| 97 |
|
|---|
| 98 | _process_interrupt:
|
|---|
| 99 |
|
|---|
| 100 | addi sp, sp, -4
|
|---|
| 101 | sw (sp+4), r1
|
|---|
| 102 |
|
|---|
| 103 | sli r3, r1, 2
|
|---|
| 104 | mvhi r2, hi(exc_table)
|
|---|
| 105 | ori r2, r2, lo(exc_table)
|
|---|
| 106 | add r3, r3, r2
|
|---|
| 107 | lw r2, (r3+0)
|
|---|
| 108 | call r2
|
|---|
| 109 |
|
|---|
| 110 | addi sp, sp, 4
|
|---|
| 111 | lw r1, (sp+0)
|
|---|
| 112 |
|
|---|
| 113 | ori r2, r0, 6
|
|---|
| 114 | be r1, r2, _process_interrupt_exit
|
|---|
| 115 | rcsr r2, ie
|
|---|
| 116 | andi r2, r2, 0x6
|
|---|
| 117 | wcsr ie, r2
|
|---|
| 118 |
|
|---|
| 119 | _process_interrupt_exit:
|
|---|
| 120 |
|
|---|
| 121 | mvhi r1, hi(exception_count)
|
|---|
| 122 | ori r1, r1, lo(exception_count)
|
|---|
| 123 | lw r2, (r1+0)
|
|---|
| 124 | addi r2, r2, -1
|
|---|
| 125 | sw (r1+0), r2
|
|---|
| 126 | bne r2, r0, return_to_task_exc
|
|---|
| 127 |
|
|---|
| 128 | addi sp, sp, 4
|
|---|
| 129 | lw r1, (sp+0)
|
|---|
| 130 | mv sp, r1
|
|---|
| 131 |
|
|---|
| 132 | mvhi r2, hi(reqflg)
|
|---|
| 133 | ori r2, r2, lo(reqflg)
|
|---|
| 134 | lw r1, (r2+0)
|
|---|
| 135 | be r1, r0, return_to_task_exc
|
|---|
| 136 | sw (r2+0), r0
|
|---|
| 137 | bi ret_exc
|
|---|
| 138 |
|
|---|
| 139 | return_to_task_exc:
|
|---|
| 140 | addi sp, sp, 4
|
|---|
| 141 | lw ra, (sp+0)
|
|---|
| 142 | ret
|
|---|
| 143 |
|
|---|
| 144 | _save_all:
|
|---|
| 145 | addi sp, sp, -128
|
|---|
| 146 | sw (sp+4), r1
|
|---|
| 147 | sw (sp+8), r2
|
|---|
| 148 | sw (sp+12), r3
|
|---|
| 149 | sw (sp+16), r4
|
|---|
| 150 | sw (sp+20), r5
|
|---|
| 151 | sw (sp+24), r6
|
|---|
| 152 | sw (sp+28), r7
|
|---|
| 153 | sw (sp+32), r8
|
|---|
| 154 | sw (sp+36), r9
|
|---|
| 155 | sw (sp+40), r10
|
|---|
| 156 | sw (sp+44), r11
|
|---|
| 157 | sw (sp+48), r12
|
|---|
| 158 | sw (sp+52), r13
|
|---|
| 159 | sw (sp+56), r14
|
|---|
| 160 | sw (sp+60), r15
|
|---|
| 161 | sw (sp+64), r16
|
|---|
| 162 | sw (sp+68), r17
|
|---|
| 163 | sw (sp+72), r18
|
|---|
| 164 | sw (sp+76), r19
|
|---|
| 165 | sw (sp+80), r20
|
|---|
| 166 | sw (sp+84), r21
|
|---|
| 167 | sw (sp+88), r22
|
|---|
| 168 | sw (sp+92), r23
|
|---|
| 169 | sw (sp+96), r24
|
|---|
| 170 | sw (sp+100), r25
|
|---|
| 171 | sw (sp+104), r26
|
|---|
| 172 | sw (sp+108), r27
|
|---|
| 173 |
|
|---|
| 174 | sw (sp+120), ea
|
|---|
| 175 | sw (sp+124), ba
|
|---|
| 176 |
|
|---|
| 177 | lw r1, (sp+128)
|
|---|
| 178 | sw (sp+116), r1
|
|---|
| 179 | mv r1, sp
|
|---|
| 180 | addi r1, r1, 128
|
|---|
| 181 | sw (sp+112), r1
|
|---|
| 182 |
|
|---|
| 183 | mvhi r1, hi(exception_registers)
|
|---|
| 184 | ori r1, r1, lo(exception_registers)
|
|---|
| 185 | sw (r1+0), r0
|
|---|
| 186 | sw (r1+8), r2
|
|---|
| 187 | sw (r1+12), r3
|
|---|
| 188 | sw (r1+16), r4
|
|---|
| 189 | sw (r1+20), r5
|
|---|
| 190 | sw (r1+24), r6
|
|---|
| 191 | sw (r1+28), r7
|
|---|
| 192 | sw (r1+32), r8
|
|---|
| 193 | sw (r1+36), r9
|
|---|
| 194 | sw (r1+40), r10
|
|---|
| 195 | sw (r1+44), r11
|
|---|
| 196 | sw (r1+48), r12
|
|---|
| 197 | sw (r1+52), r13
|
|---|
| 198 | sw (r1+56), r14
|
|---|
| 199 | sw (r1+60), r15
|
|---|
| 200 | sw (r1+64), r16
|
|---|
| 201 | sw (r1+68), r17
|
|---|
| 202 | sw (r1+72), r18
|
|---|
| 203 | sw (r1+76), r19
|
|---|
| 204 | sw (r1+80), r20
|
|---|
| 205 | sw (r1+84), r21
|
|---|
| 206 | sw (r1+88), r22
|
|---|
| 207 | sw (r1+92), r23
|
|---|
| 208 | sw (r1+96), r24
|
|---|
| 209 | sw (r1+100), r25
|
|---|
| 210 | sw (r1+104), r26
|
|---|
| 211 | sw (r1+108), r27
|
|---|
| 212 | sw (r1+120), ea
|
|---|
| 213 | sw (r1+124), ba
|
|---|
| 214 |
|
|---|
| 215 | lw r2, (sp+4)
|
|---|
| 216 | sw (r1+4), r2
|
|---|
| 217 | lw r2, (sp+56)
|
|---|
| 218 | sw (r1+116), r2
|
|---|
| 219 | addi r2, sp, 56
|
|---|
| 220 | sw (r1+112), r2
|
|---|
| 221 | rcsr r2, ie
|
|---|
| 222 | sw (r1+128), r2
|
|---|
| 223 | rcsr r2, im
|
|---|
| 224 | sw (r1+132), r2
|
|---|
| 225 | rcsr r2, ip
|
|---|
| 226 | sw (r1+138), r2
|
|---|
| 227 | rcsr r2, icc
|
|---|
| 228 | sw (r1+140), r2
|
|---|
| 229 | rcsr r2, dcc
|
|---|
| 230 | sw (r1+144), r2
|
|---|
| 231 | rcsr r2, cc
|
|---|
| 232 | sw (r1+148), r2
|
|---|
| 233 | rcsr r2, cfg
|
|---|
| 234 | sw (r1+152), r2
|
|---|
| 235 | rcsr r2, eba
|
|---|
| 236 | sw (r1+158), r2
|
|---|
| 237 |
|
|---|
| 238 | ret
|
|---|
| 239 |
|
|---|
| 240 | _restore_all_and_eret:
|
|---|
| 241 | lw r1, (sp+4)
|
|---|
| 242 | lw r2, (sp+8)
|
|---|
| 243 | lw r3, (sp+12)
|
|---|
| 244 | lw r4, (sp+16)
|
|---|
| 245 | lw r5, (sp+20)
|
|---|
| 246 | lw r6, (sp+24)
|
|---|
| 247 | lw r7, (sp+28)
|
|---|
| 248 | lw r8, (sp+32)
|
|---|
| 249 | lw r9, (sp+36)
|
|---|
| 250 | lw r10, (sp+40)
|
|---|
| 251 | lw r11, (sp+44)
|
|---|
| 252 | lw r12, (sp+48)
|
|---|
| 253 | lw r13, (sp+52)
|
|---|
| 254 | lw r14, (sp+56)
|
|---|
| 255 | lw r15, (sp+60)
|
|---|
| 256 | lw r16, (sp+64)
|
|---|
| 257 | lw r17, (sp+68)
|
|---|
| 258 | lw r18, (sp+72)
|
|---|
| 259 | lw r19, (sp+76)
|
|---|
| 260 | lw r20, (sp+80)
|
|---|
| 261 | lw r21, (sp+84)
|
|---|
| 262 | lw r22, (sp+88)
|
|---|
| 263 | lw r23, (sp+92)
|
|---|
| 264 | lw r24, (sp+96)
|
|---|
| 265 | lw r25, (sp+100)
|
|---|
| 266 | lw r26, (sp+104)
|
|---|
| 267 | lw r27, (sp+108)
|
|---|
| 268 | lw ra, (sp+116)
|
|---|
| 269 | lw ea, (sp+120)
|
|---|
| 270 | lw ba, (sp+124)
|
|---|
| 271 | lw sp, (sp+112)
|
|---|
| 272 | eret
|
|---|
| 273 |
|
|---|
| 274 | _restore_all_and_bret:
|
|---|
| 275 | lw r1, (sp+4)
|
|---|
| 276 | lw r2, (sp+8)
|
|---|
| 277 | lw r3, (sp+12)
|
|---|
| 278 | lw r4, (sp+16)
|
|---|
| 279 | lw r5, (sp+20)
|
|---|
| 280 | lw r6, (sp+24)
|
|---|
| 281 | lw r7, (sp+28)
|
|---|
| 282 | lw r8, (sp+32)
|
|---|
| 283 | lw r9, (sp+36)
|
|---|
| 284 | lw r10, (sp+40)
|
|---|
| 285 | lw r11, (sp+44)
|
|---|
| 286 | lw r12, (sp+48)
|
|---|
| 287 | lw r13, (sp+52)
|
|---|
| 288 | lw r14, (sp+56)
|
|---|
| 289 | lw r15, (sp+60)
|
|---|
| 290 | lw r16, (sp+64)
|
|---|
| 291 | lw r17, (sp+68)
|
|---|
| 292 | lw r18, (sp+72)
|
|---|
| 293 | lw r19, (sp+76)
|
|---|
| 294 | lw r20, (sp+80)
|
|---|
| 295 | lw r21, (sp+84)
|
|---|
| 296 | lw r22, (sp+88)
|
|---|
| 297 | lw r23, (sp+92)
|
|---|
| 298 | lw r24, (sp+96)
|
|---|
| 299 | lw r25, (sp+100)
|
|---|
| 300 | lw r26, (sp+104)
|
|---|
| 301 | lw r27, (sp+108)
|
|---|
| 302 | lw ra, (sp+116)
|
|---|
| 303 | lw ea, (sp+120)
|
|---|
| 304 | lw ba, (sp+124)
|
|---|
| 305 | lw sp, (sp+112)
|
|---|
| 306 | bret
|
|---|
| 307 |
|
|---|
| 308 | Interrupt_exception_handler:
|
|---|
| 309 | addi sp, sp, -4
|
|---|
| 310 | sw (sp+4), ra
|
|---|
| 311 |
|
|---|
| 312 | rcsr r1, ip
|
|---|
| 313 | rcsr r2, im
|
|---|
| 314 | and r1, r1, r2
|
|---|
| 315 |
|
|---|
| 316 | addi r2, r0, 1
|
|---|
| 317 | addi r4, r0, 0
|
|---|
| 318 |
|
|---|
| 319 | find_bit_loop:
|
|---|
| 320 | and r3, r1, r2
|
|---|
| 321 | sli r2, r2, 1
|
|---|
| 322 | addi r4, r4, 1
|
|---|
| 323 | be r3, r0, find_bit_loop
|
|---|
| 324 | addi r4, r4, -1
|
|---|
| 325 |
|
|---|
| 326 | save_intr_mask:
|
|---|
| 327 | rcsr r1, im
|
|---|
| 328 | addi sp, sp, -4
|
|---|
| 329 | sw (sp+4), r1
|
|---|
| 330 |
|
|---|
| 331 | mvhi r1, hi(int_mask_table)
|
|---|
| 332 | ori r1, r1, lo(int_mask_table)
|
|---|
| 333 | sli r5, r4, 2
|
|---|
| 334 | add r1, r1, r5
|
|---|
| 335 | lw r1, (r1+0)
|
|---|
| 336 | rcsr r2, im
|
|---|
| 337 | and r1, r1, r2
|
|---|
| 338 | wcsr im, r1
|
|---|
| 339 |
|
|---|
| 340 | mvhi r2, hi(int_table)
|
|---|
| 341 | ori r2, r2, lo(int_table)
|
|---|
| 342 | sli r5, r4, 2
|
|---|
| 343 | add r2, r2, r5
|
|---|
| 344 | lw r2, (r2+0)
|
|---|
| 345 | be r2, r0, undefined_interrupt
|
|---|
| 346 |
|
|---|
| 347 | addi sp, sp, -4
|
|---|
| 348 | sw (sp+4), r4
|
|---|
| 349 |
|
|---|
| 350 | /* Enable Interrupt */
|
|---|
| 351 | rcsr r1, ie
|
|---|
| 352 | ori r1, r1, 0x1
|
|---|
| 353 | wcsr ie, r1
|
|---|
| 354 |
|
|---|
| 355 | call_user_isr:
|
|---|
| 356 | call r2
|
|---|
| 357 |
|
|---|
| 358 | /* Disable Interrupt */
|
|---|
| 359 | rcsr r1, ie
|
|---|
| 360 | andi r1, r1, 0x6
|
|---|
| 361 | wcsr ie, r1
|
|---|
| 362 |
|
|---|
| 363 | clear_intr_pending:
|
|---|
| 364 | addi sp, sp, 4
|
|---|
| 365 | lw r4, (sp+0)
|
|---|
| 366 |
|
|---|
| 367 | addi r1, r0, 1
|
|---|
| 368 | sl r2, r1, r4
|
|---|
| 369 | wcsr ip, r2
|
|---|
| 370 |
|
|---|
| 371 | restore_intr_mask:
|
|---|
| 372 | addi sp, sp, 4
|
|---|
| 373 | lw r1, (sp+0)
|
|---|
| 374 | wcsr im, r1
|
|---|
| 375 |
|
|---|
| 376 | addi sp, sp, 4
|
|---|
| 377 | lw ra, (sp+0)
|
|---|
| 378 | ret
|
|---|
| 379 | nop
|
|---|
| 380 |
|
|---|
| 381 | undefined_interrupt:
|
|---|
| 382 | bi undef_interrupt
|
|---|
![(please configure the [header_logo] section in trac.ini)](/trac_user/contrib/chrome/site/your_project_logo.png){kind=logo}
