| 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: cpu_support.S,v 1.37 2005/08/22 16:57:25 honda Exp $
|
|---|
| 51 | */
|
|---|
| 52 |
|
|---|
| 53 |
|
|---|
| 54 | #define _MACRO_ONLY
|
|---|
| 55 | #include "jsp_kernel.h"
|
|---|
| 56 | #include "offset.h"
|
|---|
| 57 | #include <t_config.h>
|
|---|
| 58 |
|
|---|
| 59 |
|
|---|
| 60 | /*
|
|---|
| 61 | * ä¾å¤/å²ãè¾¼ã¿åºå
|
|---|
| 62 | ¥ãå£å¦çã«ã¼ãã³
|
|---|
| 63 | * SH3ã¯ãã¯ã¿ãã¼ãã«ãæãããä¾å¤,TRAPAãçºçããã¨VBR+0x100çªå°ãã
|
|---|
| 64 | * å
|
|---|
| 65 | é¨/å¤é¨/NMIå²ãè¾¼ã¿ãçºçããã¨ãVBR+0x600çªå°ãå®è¡ããã
|
|---|
| 66 | */
|
|---|
| 67 |
|
|---|
| 68 | /*
|
|---|
| 69 | * VBR ã«è¨å®ããå¤
|
|---|
| 70 | */
|
|---|
| 71 | .section .text
|
|---|
| 72 | .align 2
|
|---|
| 73 | .global _BASE_VBR
|
|---|
| 74 | _BASE_VBR:
|
|---|
| 75 | nop
|
|---|
| 76 | nop
|
|---|
| 77 | nop
|
|---|
| 78 |
|
|---|
| 79 | /*
|
|---|
| 80 | * Exception 100 vector
|
|---|
| 81 | * ã¢ãã¬ã¹ã¨ã©ã¼,ã¹ãããä¸å½å½ä»¤ä¾å¤ãTrapaä¾å¤çãçºçããã¨å®è¡ãããã
|
|---|
| 82 | *
|
|---|
| 83 | * CPUä¾å¤ãã³ãã©ã¯ãéã¿ã¹ã¯ã³ã³ããã¹ãã§å®è¡ããããã®ãããCPUä¾å¤ãã³
|
|---|
| 84 | * ãã©ãå¼ã³åºãåã«ä¾å¤/å²ãè¾¼ã¿ã示ãã¬ã¸ã¹ã¿ãã³ã¯1ã® r7 ã¬ã¸ã¹ã¿ãã¤ã³
|
|---|
| 85 | * ã¯ã¡ã³ããããªã¿ã¼ã³ãã¦ããå¾ã«ãã¯ãªã¡ã³ããããCPUä¾å¤ãã¿ã¹ã¯ã³ã³ãã
|
|---|
| 86 | * ã¹ãã§çºçããregflg ã TRUE ã«ãªã£ãæã«ã ret_exc ã¸åå²ããã
|
|---|
| 87 | * regflg ããã§ãã¯ããåã«å²ãè¾¼ã¿ãç¦æ¢ããªãã¨ãreqflg ããã§ãã¯å¾ã«èµ·
|
|---|
| 88 | * åãããå²ãè¾¼ã¿ãã³ãã©å
|
|---|
| 89 | ã§ãã£ã¹ããããè¦æ±ãããå ´åã«ããã£ã¹ããã
|
|---|
| 90 | * ãããªãã
|
|---|
| 91 | *
|
|---|
| 92 | *
|
|---|
| 93 | * ä¾å¤ãçºçããã¨ãä¾å¤çºçå
|
|---|
| 94 | ã®ã³ã³ããã¹ãã§ããspc,pr,ssr,r0ãr7ãéé¿
|
|---|
| 95 | * ãããä¾å¤ãçºçããæç¹ã§ã®ã³ã³ããã¹ãã調ã¹éã¿ã¹ã¯ã³ã³ããã¹ããªã
|
|---|
| 96 | * _exception_from_intããå®è¡ãéå§ãããä¾å¤ã®è¦å ã¯EXPEVTã¬ã¸ã¹ã¿èªã¿ã
|
|---|
| 97 | * exc_tableããCPUä¾å¤ãã³ãã©ã®éå§çªå°ãèªã¿è¾¼ããçºçããä¾å¤ã«å¯¾ãã¦
|
|---|
| 98 | * CPUä¾å¤ãã³ãã©ãç»é²ããã¦ããªããã°ã_no_reg_exceptionã«ãã©ã³ããã¦ã
|
|---|
| 99 | * ssr,sr,spc,prã®å
|
|---|
| 100 | 容ãåºåãã¦åæ¢ãããCPUä¾å¤ãã³ãã©ãããªã¿ã¼ã³ãã¦
|
|---|
| 101 | * ããããreqflgã調ã¹0以å¤ãªãrec_exc()ã«é£ã³ã0ãªãå
|
|---|
| 102 | ã®å¦çã«ãªã¿ã¼ã³ã
|
|---|
| 103 | * ãã
|
|---|
| 104 | *
|
|---|
| 105 | *
|
|---|
| 106 | * BLãããã®æ±ãã«ã¤ãã¦
|
|---|
| 107 | * ssr,spc ã«æ»ãå
|
|---|
| 108 | ã®ã³ã³ããã¹ããæ»ã㦠rte ãçºè¡ããéã«ã¯ï¼å²è¾¼ã¿ï¼NMI
|
|---|
| 109 | * ãå«ãï¼ãåãä»ããªãããã« BL ãããã1ã«ããå¿
|
|---|
| 110 | è¦ãããï¼ä¾å¤/å²è¾¼ã¿ã
|
|---|
| 111 | * ã³ãã©çµäºæã«ã¯ BL ããããã1ã«ãã IPM ã MAX_IPM ã«è¨å®ããï¼ããã¯ï¼
|
|---|
| 112 | * BL ãããã1ã®å ´åã«ä¾å¤ãçºçãã㨠CPU ããªã»ããããããã¨ãèæ
|
|---|
| 113 | ®ãã¦ï¼
|
|---|
| 114 | * å®å
|
|---|
| 115 | ¨ã®ããï¼ssr,spcã復帰ããç´åã§BLã1ã«è¨å®ãã¦ããï¼
|
|---|
| 116 | *
|
|---|
| 117 | */
|
|---|
| 118 |
|
|---|
| 119 |
|
|---|
| 120 | .org 0x0100 /* _BASE_VBR + 0x0100çªå°ã«é
|
|---|
| 121 | ç½® */
|
|---|
| 122 | .align 2
|
|---|
| 123 | .global _general_exception
|
|---|
| 124 | _general_exception:
|
|---|
| 125 | stc.l spc,@-r15 /* spc,pr,ssr ãã¹ã¿ãã¯ã«ä¿åãã */
|
|---|
| 126 | sts.l pr,@-r15
|
|---|
| 127 | stc.l ssr,@-r15
|
|---|
| 128 | stc.l gbr,@-r15
|
|---|
| 129 | sts.l macl,@-r15
|
|---|
| 130 | sts.l mach,@-r15
|
|---|
| 131 | stc.l r0_bank,@-r15 /* ä¾å¤çºçæã®r0ãr7ãä¿å */
|
|---|
| 132 | stc.l r1_bank,@-r15
|
|---|
| 133 | stc.l r2_bank,@-r15
|
|---|
| 134 | stc.l r3_bank,@-r15
|
|---|
| 135 | stc.l r4_bank,@-r15
|
|---|
| 136 | stc.l r5_bank,@-r15
|
|---|
| 137 | stc.l r6_bank,@-r15
|
|---|
| 138 | stc.l r7_bank,@-r15
|
|---|
| 139 | tst r7,r7 /* ä¾å¤çºçå
|
|---|
| 140 | ã®ã³ã³ããã¹ããå¤å® */
|
|---|
| 141 | bf/s _exception_from_exc /* çºçå
|
|---|
| 142 | ãä¾å¤/å²ãè¾¼ã¿ãã³ãã©ãªãã¸ã£ã³ã */
|
|---|
| 143 | add #0x01,r7 /* ä¾å¤/å²ãè¾¼ã¿ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã */
|
|---|
| 144 | mov r15,r1 /* æ»ãå
|
|---|
| 145 | ãå²ãè¾¼ã¿ãã³ãã©ã§ãªãã®ã§ã¹ã¿ã */
|
|---|
| 146 | mov.l _stacktop_exc,r15 /* ã¯ãå
|
|---|
| 147 | ¥ãæ¿ãå
|
|---|
| 148 | ã®ã¹ã¿ãã¯ãã¤ã³ã¿ãä¿å */
|
|---|
| 149 | mov.l r1,@-r15
|
|---|
| 150 | mov.l _expevt,r0 /* ä¾å¤ã許å¯ããã¨æ¶ããã¬ã¸ã¹ã¿ãä¿å */
|
|---|
| 151 | mov.l @r0,r5 /* EXPEVTã¬ã¸ã¹ã¿ãåå¾ */
|
|---|
| 152 | ldc r1,r4_bank /* CPUä¾å¤ãã³ãã©ã¸ã®å¼æ° */
|
|---|
| 153 | ldc r5,r5_bank
|
|---|
| 154 | mov.l _unmak_rb_bl_exc,r2 /* BLãããã0ã«ï¼ã¬ã¸ã¹ã¿ãã³ã¯ãåãæ¿ã */
|
|---|
| 155 | stc sr,r3
|
|---|
| 156 | and r3,r2
|
|---|
| 157 | ldc r2,sr
|
|---|
| 158 | shlr2 r5 /* EXPEVTã3ãããå³ã·ãã */
|
|---|
| 159 | shlr r5
|
|---|
| 160 | mov.l _exc_table_exc,r0 /* exc_tableã®ã¢ãã¬ã¹ãr0ã« */
|
|---|
| 161 | mov.l @(r0,r5),r2 /* ãã³ãã©ã®ã¢ãã¬ã¹ãåå¾ */
|
|---|
| 162 | tst r2,r2 /* ãã³ãã©ãç»é²ããã¦ããªãä¾å¤ãªã */
|
|---|
| 163 | bt _no_reg_exception /* no_reg_exceptionã¸ã¸ã£ã³ã */
|
|---|
| 164 | jsr @r2 /* CPUä¾å¤ãã³ãã©ã¸ */
|
|---|
| 165 | nop
|
|---|
| 166 | mov.l _mask_md_ipm_exc,r0
|
|---|
| 167 | ldc r0,sr /* å²ãè¾¼ã¿ç¦æ¢ */
|
|---|
| 168 | stc r7_bank,r7 /* ä¾å¤/å²ãè¾¼ã¿ã®ãã¹ãåæ°ããã¯ãªã¡ã³ã */
|
|---|
| 169 | dt r7
|
|---|
| 170 | ldc r7,r7_bank
|
|---|
| 171 | mov.l _reqflg_exc,r2 /* reqflgã®ãã§ã㯠*/
|
|---|
| 172 | mov.l @r2,r1
|
|---|
| 173 | tst r1,r1 /* reqflgãFALSEãªãret_to_task_excã«é£ã³ */
|
|---|
| 174 | bt/s _ret_to_task_exc /* ã¿ã¹ã¯ã«æ»ã */
|
|---|
| 175 | mov.l @r15,r15 /* æ»ãå
|
|---|
| 176 | ãã¿ã¹ã¯ãªã®ã§ã¹ã¿ãã¯ãæ»ã */
|
|---|
| 177 | xor r0,r0
|
|---|
| 178 | bra ret_exc
|
|---|
| 179 | mov.l r0,@r2 /* reqflgãã¯ãªã¢ */
|
|---|
| 180 |
|
|---|
| 181 |
|
|---|
| 182 | /*
|
|---|
| 183 | * exception_from_int
|
|---|
| 184 | * CPUä¾å¤çºçæã®ã³ã³ããã¹ããéã¿ã¹ã¯ã³ã³ããã¹ãã®å ´åã®å¦ç
|
|---|
| 185 | * ã¿ã¹ã¯ã³ã³ããã¹ãã®å ´åã¨ã®å¦çã®éãã¯ãã¨CPUä¾å¤ãã³ãã©ã®
|
|---|
| 186 | * å¦çãçµäºããã¨å¿
|
|---|
| 187 | ãå
|
|---|
| 188 | ã®å¦çã«æ»ããã¨ã§ããã
|
|---|
| 189 | */
|
|---|
| 190 |
|
|---|
| 191 | _exception_from_exc:
|
|---|
| 192 | mov.l _expevt,r0 /* ä¾å¤ã許å¯ããã¨æ¶ããã¬ã¸ã¹ã¿ãä¿å */
|
|---|
| 193 | mov.l @r0,r5 /* EXPEVTã¬ã¸ã¹ã¿ãåå¾ */
|
|---|
| 194 | ldc r15,r4_bank /* CPUä¾å¤ãã³ãã©ã¸ã®å¼æ° */
|
|---|
| 195 | ldc r5,r5_bank
|
|---|
| 196 | mov.l _unmak_rb_bl_exc,r2 /* BLãããã0ã«ï¼ã¬ã¸ã¹ã¿ãã³ã¯ãåãæ¿ã */
|
|---|
| 197 | stc sr,r3
|
|---|
| 198 | and r3,r2
|
|---|
| 199 | ldc r2,sr
|
|---|
| 200 | shlr2 r5 /* EXPECTã3ãããå³ã·ãã */
|
|---|
| 201 | shlr r5
|
|---|
| 202 | mov.l _exc_table_exc,r0 /* exc_tableã®ã¢ãã¬ã¹ãr0ã« */
|
|---|
| 203 | mov.l @(r0,r5),r2 /* ãã³ãã©ã®ã¢ãã¬ã¹ãåå¾ */
|
|---|
| 204 | tst r2,r2 /* ãã³ãã©ãç»é²ããã¦ããªãä¾å¤ãªã */
|
|---|
| 205 | bt _no_reg_exception /* no_reg_exceptionã¸ã¸ã£ã³ã */
|
|---|
| 206 | jsr @r2 /* CPUä¾å¤ãã³ãã©ã¸ */
|
|---|
| 207 | nop
|
|---|
| 208 | mov.l _mask_md_ipm_exc,r0
|
|---|
| 209 | ldc r0,sr /* BL=1,å²ãè¾¼ã¿ç¦æ¢ */
|
|---|
| 210 | stc r7_bank,r7 /* ä¾å¤/å²ãè¾¼ã¿ã®ãã¹ãåæ°ããã¯ãªã¡ã³ã */
|
|---|
| 211 | dt r7
|
|---|
| 212 | ldc r7,r7_bank
|
|---|
| 213 | _ret_to_task_exc:
|
|---|
| 214 | mov.l @r15+,r7 /* r0ãr1,ssr,pr,spcã復帰ãã¿ã¹ã¯ã«æ»ã */
|
|---|
| 215 | mov.l @r15+,r6
|
|---|
| 216 | mov.l @r15+,r5
|
|---|
| 217 | mov.l @r15+,r4
|
|---|
| 218 | mov.l @r15+,r3
|
|---|
| 219 | mov.l @r15+,r2
|
|---|
| 220 | mov.l @r15+,r1
|
|---|
| 221 | mov.l _mask_md_bl_exc,r0
|
|---|
| 222 | ldc r0,sr /* BLã1ã« */
|
|---|
| 223 | mov.l @r15+,r0
|
|---|
| 224 | lds.l @r15+,mach
|
|---|
| 225 | lds.l @r15+,macl
|
|---|
| 226 | ldc.l @r15+,gbr
|
|---|
| 227 | ldc.l @r15+,ssr
|
|---|
| 228 | lds.l @r15+,pr
|
|---|
| 229 | ldc.l @r15+,spc
|
|---|
| 230 | rte
|
|---|
| 231 | nop
|
|---|
| 232 |
|
|---|
| 233 |
|
|---|
| 234 | /*
|
|---|
| 235 | * no_reg_exception()
|
|---|
| 236 | * CPUä¾å¤ã¨ãã¦ç»é²ããã¦ããªãä¾å¤ãçºçããã¨å¼ã³åºããã
|
|---|
| 237 | * ä¾å¤ã³ã¼ããä¾å¤ãçºçããæç¹ã®pc,sr,prãåºåãã¦ã«ã¼ãã«
|
|---|
| 238 | * ãåæ¢ããã
|
|---|
| 239 | */
|
|---|
| 240 | _no_reg_exception:
|
|---|
| 241 | mov.l _expevt,r5
|
|---|
| 242 | mov.l @r5,r4
|
|---|
| 243 | stc spc,r5
|
|---|
| 244 | stc ssr,r6
|
|---|
| 245 | sts pr,r7
|
|---|
| 246 | mov.l _cpu_expevt_k,r1
|
|---|
| 247 | jsr @r1
|
|---|
| 248 | nop
|
|---|
| 249 |
|
|---|
| 250 | .align 4
|
|---|
| 251 | _stacktop_exc:
|
|---|
| 252 | .long STACKTOP /* ã¿ã¹ã¯ç¬ç«é¨ã®ã¹ã¿ãã¯ã®åæå¤ */
|
|---|
| 253 | _expevt:
|
|---|
| 254 | .long EXPEVT
|
|---|
| 255 | _exc_table_exc:
|
|---|
| 256 | .long _exc_table
|
|---|
| 257 | _unmak_rb_bl_exc:
|
|---|
| 258 | .long 0x4fffffff
|
|---|
| 259 | _mask_md_ipm_exc:
|
|---|
| 260 | .long 0x40000000 + MAX_IPM << 4
|
|---|
| 261 | _reqflg_exc:
|
|---|
| 262 | .long _reqflg
|
|---|
| 263 | _cpu_expevt_k:
|
|---|
| 264 | .long _cpu_expevt
|
|---|
| 265 | _mask_md_bl_exc:
|
|---|
| 266 | .long 0x50000000 + MAX_IPM << 4
|
|---|
| 267 |
|
|---|
| 268 |
|
|---|
| 269 |
|
|---|
| 270 |
|
|---|
| 271 | /*
|
|---|
| 272 | * ã¿ã¹ã¯ãã£ã¹ãããã£
|
|---|
| 273 | *
|
|---|
| 274 | * _dispatch ã¯ãr7_bank1 = 0,å²è¾¼ã¿ç¦æ¢ç¶æ
|
|---|
| 275 | ã§å¼ã³åºããªããã°ãªããª
|
|---|
| 276 | * ãï¼_exit_and_dispatch ãï¼r7_bank1 = 0ã»å²è¾¼ã¿ç¦æ¢ç¶æ
|
|---|
| 277 | ã§å¼ã³åºã
|
|---|
| 278 | * ã®ãååã§ãããï¼ã«ã¼ãã«èµ·åæã«å¯¾å¿ããããï¼r7_bank1 = 1ã§å¼ã³
|
|---|
| 279 | * åºããå ´åã«ã対å¿ãã¦ããï¼
|
|---|
| 280 | */
|
|---|
| 281 |
|
|---|
| 282 | .text
|
|---|
| 283 | .align 2
|
|---|
| 284 | .global _dispatch
|
|---|
| 285 | _dispatch:
|
|---|
| 286 | sts.l pr,@-r15 /* pr,r8ãr15 ãã¹ã¿ãã¯ã«ä¿å */
|
|---|
| 287 | mov.l r14,@-r15 /* r0ãr7ã¯å¼ã³åºãå
|
|---|
| 288 | ã§ä¿åãã¦ãããã */
|
|---|
| 289 | mov.l r13,@-r15 /* ä¿åããå¿
|
|---|
| 290 | è¦ãç¡ã */
|
|---|
| 291 | mov.l r12,@-r15
|
|---|
| 292 | mov.l r11,@-r15
|
|---|
| 293 | mov.l r10,@-r15
|
|---|
| 294 | mov.l r9, @-r15
|
|---|
| 295 | mov.l r8, @-r15
|
|---|
| 296 | mov.l _runtsk_dis,r2 /* r0 <- runtsk */
|
|---|
| 297 | mov.l @r2,r0
|
|---|
| 298 | mov.l r15,@(TCB_sp,r0) /* ã¿ã¹ã¯ã¹ã¿ãã¯ãTCBã«ä¿å 60以ä¸ãªãOK*/
|
|---|
| 299 | mov.l dispatch_r_k,r1 /* å®è¡åéçªå°ãä¿å */
|
|---|
| 300 | mov.l r1,@(TCB_pc,r0) /* å®è¡åéçªå°ãTCBã«ä¿å 60以ä¸ãªãOK */
|
|---|
| 301 | bra dispatcher
|
|---|
| 302 | nop
|
|---|
| 303 |
|
|---|
| 304 | dispatch_r:
|
|---|
| 305 | mov.l @r15+,r8 /* ã¬ã¸ã¹ã¿ã復帰 */
|
|---|
| 306 | mov.l @r15+,r9
|
|---|
| 307 | mov.l @r15+,r10
|
|---|
| 308 | mov.l @r15+,r11
|
|---|
| 309 | mov.l @r15+,r12
|
|---|
| 310 | mov.l @r15+,r13
|
|---|
| 311 | mov.l @r15+,r14
|
|---|
| 312 | lds.l @r15+,pr
|
|---|
| 313 | /*
|
|---|
| 314 | * ã¿ã¹ã¯ä¾å¤å¦çã«ã¼ãã³ã®èµ·å
|
|---|
| 315 | * dispatch_rã¯dispatcherããå¼ã³åºãããããï¼
|
|---|
| 316 | * tcbã®ã¢ãã¬ã¹ã¯r0ã«å
|
|---|
| 317 | ¥ã£ã¦ããï¼
|
|---|
| 318 | */
|
|---|
| 319 | mov.l @(TCB_enatex,r0),r1
|
|---|
| 320 | mov.l _enatex_mask_dis,r2
|
|---|
| 321 | tst r1,r2
|
|---|
| 322 | bt dispatch_r_1 /* enatex ã FALSE ãªããªã¿ã¼ã³ */
|
|---|
| 323 | mov.l @(TCB_texptn,r0),r1 /* texptnããã¼ã */
|
|---|
| 324 | tst r1,r1
|
|---|
| 325 | bt dispatch_r_1 /* texptn ã 0ã§ç¡ããã° */
|
|---|
| 326 | mov.l _call_texrtn_dis,r1 /* ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®å¼ã³åºã */
|
|---|
| 327 | jmp @r1
|
|---|
| 328 | nop
|
|---|
| 329 | dispatch_r_1:
|
|---|
| 330 | rts
|
|---|
| 331 | nop
|
|---|
| 332 |
|
|---|
| 333 | .global _exit_and_dispatch
|
|---|
| 334 | _exit_and_dispatch:
|
|---|
| 335 | xor r1,r1 /* r7_bank1ã0ã¯ãªã¢ */
|
|---|
| 336 | ldc r1,r7_bank
|
|---|
| 337 | dispatcher:
|
|---|
| 338 | /*
|
|---|
| 339 | * ããã«ã¯å²ãè¾¼ã¿ç¦æ¢ã§æ¥ããã¨
|
|---|
| 340 | */
|
|---|
| 341 | mov.l _schedtsk_dis,r12 /* r0 <- schedtsk */
|
|---|
| 342 | mov.l @r12,r0
|
|---|
| 343 | mov.l _runtsk_dis,r2
|
|---|
| 344 | mov.l r0,@r2 /* schedtskãruntskã« */
|
|---|
| 345 | cmp/eq #0,r0 /* schedtsk ããããï¼ */
|
|---|
| 346 | bt dispatcher_1 /* ç¡ããã°ã¸ã£ã³ã */
|
|---|
| 347 | mov.l @(TCB_sp,r0),r15 /* TCBããã¿ã¹ã¯ã¹ã¿ãã¯ã復帰 */
|
|---|
| 348 | mov.l @(TCB_pc,r0),r1 /* TCBããå®è¡åéçªå°ã復帰 */
|
|---|
| 349 | jmp @r1
|
|---|
| 350 | nop
|
|---|
| 351 | dispatcher_1:
|
|---|
| 352 | /* ã¤ããã£ã¨ã¤ãå¤ãæ¯åèªã¿è¾¼ãã®ã¯å¹çãæªãã®ã§äºåã«ç¨æãã
|
|---|
| 353 | * r8 : å²ãè¾¼ã¿ç¦æ¢ã®ããã®SRã®å¤
|
|---|
| 354 | * r9 : å²ãè¾¼ã¿å¾
|
|---|
| 355 | ã¡ä¸ã®SRã®å¤
|
|---|
| 356 | * r10 : reqflgã®çªå°
|
|---|
| 357 | * r11 : 0x01
|
|---|
| 358 | * r12 : 0x00
|
|---|
| 359 | * r13 : sleepä¸ã®SRã®ç¶æ
|
|---|
| 360 |
|
|---|
| 361 | */
|
|---|
| 362 | mov.l _mask_md_ipm_dis,r8 /* å²ãè¾¼ã¿ç¦æ¢ã®SRã®å¤ */
|
|---|
| 363 | #ifdef NO_SLEEP
|
|---|
| 364 | mov.l _mask_md_dis,r9 /* å²ãè¾¼ã¿å¾
|
|---|
| 365 | ã¡ä¸ã®SRã®å¤ */
|
|---|
| 366 | #else
|
|---|
| 367 | mov.l _mask_bl_md_dis,r9 /* å²ãè¾¼ã¿å¾
|
|---|
| 368 | ã¡ä¸ã®SRã®å¤ */
|
|---|
| 369 | #endif
|
|---|
| 370 | #ifdef SUPPORT_CHG_IPM
|
|---|
| 371 | mov.l _task_intmask_k,r2
|
|---|
| 372 | mov.l @r2,r3
|
|---|
| 373 | or r3,r9
|
|---|
| 374 | #endif
|
|---|
| 375 | mov.l _reqflg_dis,r10
|
|---|
| 376 | mov #0x01,r11
|
|---|
| 377 | xor r12,r12
|
|---|
| 378 | mov.l _stacktop_dis,r15 /* ã¹ã¿ãã¯ãå²ãè¾¼ã¿ã¹ã¿ãã¯ã« */
|
|---|
| 379 | ldc r11,r7_bank /* r7_bank1 ã1ã«ãã¦å²ãè¾¼ã¿ç¶æ
|
|---|
| 380 | ã« */
|
|---|
| 381 | dispatcher_2:
|
|---|
| 382 | /*
|
|---|
| 383 | * ããã§å²è¾¼ã¿ã¢ã¼ãã«åãæããã®ã¯ï¼ããã§çºçããå²è¾¼ã¿å¦ç
|
|---|
| 384 | * ã«ã©ã®ã¹ã¿ãã¯ã使ããã¨ããåé¡ã®è§£æ±ºã¨ï¼å²è¾¼ã¿ãã³ãã©å
|
|---|
| 385 | ã§
|
|---|
| 386 | * ã®ã¿ã¹ã¯ãã£ã¹ãããã®é²æ¢ã¨ããäºã¤ã®æå³ãããï¼
|
|---|
| 387 | */
|
|---|
| 388 | /*
|
|---|
| 389 | * å²è¾¼ã¿è¨±å¯å¾ã«sleepå½ä»¤ãå®è¡ããã¨ï¼å²è¾¼ã¿è¨±å¯å½ä»¤ã®å®è¡åã«
|
|---|
| 390 | * å²è¾¼ã¿è¦æ±ãå
|
|---|
| 391 | ¥ã£ã¦ããå ´åï¼å²è¾¼ã¿è¨±å¯å½ä»¤ã®å®è¡ã¨å
|
|---|
| 392 | ±ã«å²è¾¼ã¿ã
|
|---|
| 393 | * åãä»ããããã®å¾©å¸°å¾ã«ï¼reqflgã®ãã§ãã¯ã§ã¯ãªã sleep ç¶æ
|
|---|
| 394 |
|
|---|
| 395 | * ã«å
|
|---|
| 396 | ¥ã£ã¦ãã¾ãï¼
|
|---|
| 397 | * ãã®åé¡ã¯ï¼å²è¾¼ã¿ã®è¨±å¯ã¨ sleep ç¶æ
|
|---|
| 398 | ã¸ã®ç§»è¡ãã¢ãããã¯ã«å®
|
|---|
| 399 | * è¡ã§ããªããã¨ã«èµ·å ããï¼
|
|---|
| 400 | * ãã®ããï¼sleep å®è¡ç´åã® SR å¤æ´ã§ã¯ BL ãããã'1'ã«è¨å®ã
|
|---|
| 401 | * ããã¨ã§ï¼å²è¾¼ã¿ã®è¨±å¯ã¨ sleep ç¶æ
|
|---|
| 402 | ã¸ã®ä»¥éãã¢ãããã¯ã«å®è¡
|
|---|
| 403 | * ããï¼
|
|---|
| 404 | * ldc r9,sr ã§ã¯BLããããã»ãããããããï¼å²è¾¼ã¿ã¯åãä»ããã¹
|
|---|
| 405 | * ãªã¼ãã¢ã¼ãã«ç§»è¡ããï¼ã¹ãªã¼ãã¢ã¼ãä¸ã¯ï¼BLãããã1ã§ãå²
|
|---|
| 406 | * è¾¼ã¿ãåãä»ãããã(SH7709ãã¼ãã¦ã§ã¢ããã¥ã¢ã« 8-10)ï¼ã¹ãªã¼
|
|---|
| 407 | * ãã¢ã¼ãã¸ã®ç§»è¡ç´å¾ã«å²è¾¼ã¿ãåä»ã¹ãªã¼ãã¢ã¼ããã復帰ããï¼
|
|---|
| 408 | */
|
|---|
| 409 |
|
|---|
| 410 | ldc r9,sr /* å²ãè¾¼ã¿ã®è¨±å¯ */
|
|---|
| 411 | #ifndef NO_SLEEP
|
|---|
| 412 | sleep /* å²è¾¼ã¿å¾
|
|---|
| 413 | ã¡ */
|
|---|
| 414 | #endif /* NO_SLEEP */
|
|---|
| 415 | ldc r8,sr /* å²ãè¾¼ã¿ç¦æ¢ */
|
|---|
| 416 | mov.l @r10,r7 /* r7 <- reqflg */
|
|---|
| 417 | tst r7,r7 /* reqflg ã FALSEãªã */
|
|---|
| 418 | bt dispatcher_2 /* dispatcher_2 㸠*/
|
|---|
| 419 | ldc r12,r7_bank /* r7_bank1 ãã¯ãªã¢ */
|
|---|
| 420 | mov.l r12,@r10 /* reqflg ã FALSEã« */
|
|---|
| 421 | bra dispatcher
|
|---|
| 422 | nop
|
|---|
| 423 | .align 4
|
|---|
| 424 | _runtsk_dis:
|
|---|
| 425 | .long _runtsk
|
|---|
| 426 | _schedtsk_dis:
|
|---|
| 427 | .long _schedtsk
|
|---|
| 428 | _enatex_mask_dis:
|
|---|
| 429 | .long TCB_enatex_mask
|
|---|
| 430 | _call_texrtn_dis:
|
|---|
| 431 | .long _call_texrtn
|
|---|
| 432 | _mask_md_ipm_dis:
|
|---|
| 433 | .long 0x40000000 + MAX_IPM << 4
|
|---|
| 434 | _mask_md_dis:
|
|---|
| 435 | .long 0x40000000
|
|---|
| 436 | _mask_bl_md_dis:
|
|---|
| 437 | .long 0x50000000
|
|---|
| 438 | dispatch_r_k:
|
|---|
| 439 | .long dispatch_r
|
|---|
| 440 | _stacktop_dis:
|
|---|
| 441 | .long STACKTOP /* ã¿ã¹ã¯ç¬ç«é¨ã®ã¹ã¿ãã¯ã®åæå¤ */
|
|---|
| 442 | _reqflg_dis:
|
|---|
| 443 | .long _reqflg
|
|---|
| 444 |
|
|---|
| 445 | /*
|
|---|
| 446 | * å²ãè¾¼ã¿ãã³ãã©/CPUä¾å¤ãã³ãã©åºå£å¦ç
|
|---|
| 447 | *
|
|---|
| 448 | * æ»ãå
|
|---|
| 449 | ãã¿ã¹ã¯ã§reqflgãã»ããããã¦ããå ´åã®ã¿ããã«ããã
|
|---|
| 450 | * r7_bank1 = 0,å²ãè¾¼ã¿ç¦æ¢ç¶æ
|
|---|
| 451 | ,ã¹ã¯ã©ããã¬ã¸ã¹ã¿ãä¿åãã
|
|---|
| 452 | * ç¶æ
|
|---|
| 453 | ã§å¼ã³åºããã¨ã
|
|---|
| 454 | *
|
|---|
| 455 | */
|
|---|
| 456 | .text
|
|---|
| 457 | .align 2
|
|---|
| 458 | .globl ret_int
|
|---|
| 459 | .globl ret_exc
|
|---|
| 460 | ret_exc:
|
|---|
| 461 | ret_int:
|
|---|
| 462 | mov.l _runtsk_ret,r1 /* r0 <- runtsk */
|
|---|
| 463 | mov.l @r1,r0
|
|---|
| 464 | mov.l _enadsp_ret,r2 /* enadspã®ãã§ã㯠*/
|
|---|
| 465 | mov.l @r2,r3
|
|---|
| 466 | tst r3,r3
|
|---|
| 467 | bt ret_int_1
|
|---|
| 468 | mov.l _schedtsk_ret,r4 /* r5 <- schedtsk */
|
|---|
| 469 | mov.l @r4,r5
|
|---|
| 470 | cmp/eq r0,r5 /* runtsk 㨠schedtsk ãæ¯è¼ */
|
|---|
| 471 | bt ret_int_1
|
|---|
| 472 | mov.l r14,@-r15 /* æ®ãã®ã¬ã¸ã¹ã¿ãä¿å */
|
|---|
| 473 | mov.l r13,@-r15
|
|---|
| 474 | mov.l r12,@-r15
|
|---|
| 475 | mov.l r11,@-r15
|
|---|
| 476 | mov.l r10,@-r15
|
|---|
| 477 | mov.l r9,@-r15
|
|---|
| 478 | mov.l r8,@-r15
|
|---|
| 479 | mov #TCB_sp,r1 /* ã¿ã¹ã¯ã¹ã¿ãã¯ãä¿å */
|
|---|
| 480 | mov.l r15,@(r0,r1)
|
|---|
| 481 | mov.l ret_int_r_k,r1 /* å®è¡åéçªå°ãä¿å */
|
|---|
| 482 | mov #TCB_pc,r2
|
|---|
| 483 | mov.l r1,@(r0,r2)
|
|---|
| 484 | bra dispatcher
|
|---|
| 485 | nop
|
|---|
| 486 |
|
|---|
| 487 | ret_int_r:
|
|---|
| 488 | mov.l @r15+,r8
|
|---|
| 489 | mov.l @r15+,r9
|
|---|
| 490 | mov.l @r15+,r10
|
|---|
| 491 | mov.l @r15+,r11
|
|---|
| 492 | mov.l @r15+,r12
|
|---|
| 493 | mov.l @r15+,r13
|
|---|
| 494 | mov.l @r15+,r14
|
|---|
| 495 | ret_int_1:
|
|---|
| 496 | /*
|
|---|
| 497 | * ã¿ã¹ã¯ä¾å¤å¦çã«ã¼ãã³ã®èµ·å
|
|---|
| 498 | * ret_int_r 㯠dispatcher ããå¼ã³åºãããããï¼tcbã®ã¢ãã¬ã¹ã¯r0ã«
|
|---|
| 499 | * å
|
|---|
| 500 | ¥ã£ã¦ããï¼
|
|---|
| 501 | * ãªãï¼å²è¾¼ã¿ã®åºå£ã§ã¿ã¹ã¯ã¹ã¤ãããçºçããªãå ´åã¯ãã£ã¹ãããã£
|
|---|
| 502 | * ãéããã« ret_int ããç´æ¥ ret_int_1 ã«é£ã¶
|
|---|
| 503 | */
|
|---|
| 504 | mov.l @(TCB_enatex,r0),r1
|
|---|
| 505 | mov.l _enatex_mask_ret,r2
|
|---|
| 506 | tst r1,r2
|
|---|
| 507 | bt ret_int_2 /* enatex ã FALSE ãªããªã¿ã¼ã³ */
|
|---|
| 508 | mov.l @(TCB_texptn,r0),r1 /* texptnããã¼ã */
|
|---|
| 509 | tst r1,r1
|
|---|
| 510 | bt ret_int_2 /* texptn ã 0ã§ç¡ããã°T<= 0 */
|
|---|
| 511 | mov.l _call_texrtn_ret,r1 /* ã¿ã¹ã¯ä¾å¤ã«ã¼ãã³ã®å¼ã³åºã */
|
|---|
| 512 | jsr @r1
|
|---|
| 513 | nop
|
|---|
| 514 | ret_int_2:
|
|---|
| 515 | #ifdef SUPPORT_CHG_IPM
|
|---|
| 516 | mov #44,r0
|
|---|
| 517 | mov.l @(r0,r15),r1
|
|---|
| 518 | mov.l _unmask_ipm,r2
|
|---|
| 519 | and r2,r1
|
|---|
| 520 | mov.l _task_intmask_k,r2
|
|---|
| 521 | mov.l @r2,r3
|
|---|
| 522 | or r3,r1
|
|---|
| 523 | mov.l r1,@(r0,r15)
|
|---|
| 524 | #endif /* SUPPORT_CHG_IMP */
|
|---|
| 525 | mov.l @r15+,r7 /* spc,pr,ssr,ã¹ã¯ã©ããã¬ã¸ã¹ã¿ã復帰 */
|
|---|
| 526 | mov.l @r15+,r6
|
|---|
| 527 | mov.l @r15+,r5
|
|---|
| 528 | mov.l @r15+,r4
|
|---|
| 529 | mov.l @r15+,r3
|
|---|
| 530 | mov.l @r15+,r2
|
|---|
| 531 | mov.l @r15+,r1
|
|---|
| 532 | mov.l _mask_md_bl_ret,r0
|
|---|
| 533 | ldc r0,sr /* BLã1ã« */
|
|---|
| 534 | mov.l @r15+,r0
|
|---|
| 535 | lds.l @r15+,mach
|
|---|
| 536 | lds.l @r15+,macl
|
|---|
| 537 | ldc.l @r15+,gbr
|
|---|
| 538 | ldc.l @r15+,ssr
|
|---|
| 539 | lds.l @r15+,pr
|
|---|
| 540 | ldc.l @r15+,spc
|
|---|
| 541 | rte
|
|---|
| 542 | nop
|
|---|
| 543 |
|
|---|
| 544 | .align 4
|
|---|
| 545 | _runtsk_ret:
|
|---|
| 546 | .long _runtsk
|
|---|
| 547 | _schedtsk_ret:
|
|---|
| 548 | .long _schedtsk
|
|---|
| 549 | _enadsp_ret:
|
|---|
| 550 | .long _enadsp
|
|---|
| 551 | ret_int_r_k:
|
|---|
| 552 | .long ret_int_r
|
|---|
| 553 | _enatex_mask_ret:
|
|---|
| 554 | .long TCB_enatex_mask
|
|---|
| 555 | _call_texrtn_ret:
|
|---|
| 556 | .long _call_texrtn
|
|---|
| 557 | _mask_md_bl_ret:
|
|---|
| 558 | .long 0x50000000
|
|---|
| 559 |
|
|---|
| 560 | /*
|
|---|
| 561 | * ã¿ã¹ã¯èµ·åå¦ç
|
|---|
| 562 | */
|
|---|
| 563 | .text
|
|---|
| 564 | .align 2
|
|---|
| 565 | .globl _activate_r
|
|---|
| 566 | _activate_r:
|
|---|
| 567 | stc sr,r0 /* å²ãè¾¼ã¿è¨±å¯ */
|
|---|
| 568 | mov.l _unmask_ipm,r1
|
|---|
| 569 | and r1,r0
|
|---|
| 570 | #ifdef SUPPORT_CHG_IPM
|
|---|
| 571 | mov.l _task_intmask_k,r1
|
|---|
| 572 | mov.l @r1,r2
|
|---|
| 573 | or r2,r0
|
|---|
| 574 | #endif /* SUPPORT_CHG_IPM */
|
|---|
| 575 | ldc r0,sr
|
|---|
| 576 | mov.l @r15+,r1
|
|---|
| 577 | lds.l @r15+,pr
|
|---|
| 578 | mov.l @r15+,r4
|
|---|
| 579 | jmp @r1
|
|---|
| 580 | nop
|
|---|
| 581 | .align 4
|
|---|
| 582 | _unmask_ipm:
|
|---|
| 583 | .long 0xffffff0f
|
|---|
| 584 | #ifdef SUPPORT_CHG_IPM
|
|---|
| 585 | _task_intmask_k:
|
|---|
| 586 | .long _task_intmask
|
|---|
| 587 | #endif /* SUPPORT_CHG_IPM */
|
|---|
| 588 |
|
|---|
| 589 |
|
|---|
| 590 | /*
|
|---|
| 591 | * Exception 600 vector
|
|---|
| 592 | * å²ãè¾¼ã¿ãçºçããã¨å®è¡ãããã
|
|---|
| 593 | *
|
|---|
| 594 | *
|
|---|
| 595 | * SH3ã¯å²ãè¾¼ã¿ãçºçããã¨ãã¹ã¦VBR+0x600çªå°ããããã°ã©ã ãå®è¡ããããã
|
|---|
| 596 | * ããã«é
|
|---|
| 597 | ç½®ããã«ã¼ãã³ã§ã¾ãã¹ã¿ãã¯ã®åãæ¿ããã¬ã¸ã¹ã¿ã®ä¿å,IPMã®è¨å®,
|
|---|
| 598 | * å²ãè¾¼ã¿è¦å ã®å¤å®ãè¡ããã®å¾BLãããã0ã«ãã¦å²ãè¾¼ã¿ãã³ãã©ãå¼ã¶å¿
|
|---|
| 599 | è¦
|
|---|
| 600 | * ãããã
|
|---|
| 601 | * å²ãè¾¼ã¿è¦å ã«å¯¾å¿ããå²ãè¾¼ã¿ãã³ãã©ã®éå§çªå°ã¯é
|
|---|
| 602 | åint_table[]ã«ç»é²ã
|
|---|
| 603 | * ã¦å¼ã³åºãããªãã»ããã®è¨ç®ã¯ãå²ãè¾¼ã¿è¦å ã¬ã¸ã¹ã¿ãå³ã«2ãããã·ããã
|
|---|
| 604 | * ã¦è¡ããå²ãè¾¼ã¿è¦å ã¬ã¸ã¹ã¿ã¯SH7708ã§ã¯INTEVTã¬ã¸ã¹ã¿ã«ã»ããããããã
|
|---|
| 605 | * SH7709ããã³SH7709Aã§ã¯INTEVT2ã«ã»ããããããããifdefã«ããåãåãã¦ã
|
|---|
| 606 | * ããã¾ããä¸é¨ã®ãã£ãã¤ã¹ã«ã¤ãã¦å²ãè¾¼ã¿è¦å ã¬ã¸ã¹ã¿ã§æ¸¡ãããå¤ã¨IPMã¨
|
|---|
| 607 | * ã®éã«ã¯é¢ä¿ããªããããåå²ãè¾¼ã¿è¦å ã«å¯¾å¿ããIPMãæã¤SRã®å
|
|---|
| 608 | 容ãé
|
|---|
| 609 | å
|
|---|
| 610 | * int_plevel_table[]ã«ç»é²ãã¦ãããèªã¿åºãã
|
|---|
| 611 | *
|
|---|
| 612 | * reqflg ããã§ãã¯ããåã«å²è¾¼ã¿ãç¦æ¢ããªãã¨ï¼reqflg ããã§ãã¯å¾
|
|---|
| 613 | * ã«èµ·åãããå²è¾¼ã¿ãã³ãã©å
|
|---|
| 614 | ã§ãã£ã¹ããããè¦æ±ãããå ´åã«ï¼ãã£
|
|---|
| 615 | * ã¹ããããããªãï¼
|
|---|
| 616 | *
|
|---|
| 617 | */
|
|---|
| 618 |
|
|---|
| 619 | .org 0x0600 /* _BASE_VBR + 0x0600çªå°ã«é
|
|---|
| 620 | ç½® */
|
|---|
| 621 | .align 2
|
|---|
| 622 | .global _interrupt
|
|---|
| 623 | _interrupt:
|
|---|
| 624 | stc.l spc,@-r15 /* å¤éå²ãè¾¼ã¿ãå
|
|---|
| 625 | ¥ãã¨æ¶ãã¦ãã¾ãã®ã§ */
|
|---|
| 626 | sts.l pr,@-r15 /* spc,pr,ssr,gbr,macl,mach */
|
|---|
| 627 | stc.l ssr,@-r15
|
|---|
| 628 | stc.l gbr,@-r15
|
|---|
| 629 | sts.l macl,@-r15
|
|---|
| 630 | sts.l mach,@-r15
|
|---|
| 631 | stc.l r0_bank,@-r15 /* ,r0ãr7ãã¹ã¿ãã¯ã«ä¿å */
|
|---|
| 632 | stc.l r1_bank,@-r15
|
|---|
| 633 | stc.l r2_bank,@-r15
|
|---|
| 634 | stc.l r3_bank,@-r15
|
|---|
| 635 | stc.l r4_bank,@-r15
|
|---|
| 636 | stc.l r5_bank,@-r15
|
|---|
| 637 | stc.l r6_bank,@-r15
|
|---|
| 638 | stc.l r7_bank,@-r15
|
|---|
| 639 | tst r7,r7 /* å²ãè¾¼ã¿çºçæã®ã³ã³ããã¹ããå¤å® */
|
|---|
| 640 | bf/s _interrupt_from_int /* ä¾å¤/å²ãè¾¼ã¿ãã³ãã©ãªãã¸ã£ã³ã */
|
|---|
| 641 | add #0x01,r7 /* å²ãè¾¼ã¿ã®ãã¹ãåæ°ãã¤ã³ã¯ãªã¡ã³ã*/
|
|---|
| 642 | mov r15,r1 /* ã¹ã¿ãã¯ãå
|
|---|
| 643 | ¥ãæ¿ãå
|
|---|
| 644 | ã®ã¹ã¿ãã¯ã㤠*/
|
|---|
| 645 | mov.l _stacktop_k,r15 /* ã³ã¿ãä¿å */
|
|---|
| 646 | mov.l r1,@-r15
|
|---|
| 647 | mov.l _intevt,r0 /* ä¾å¤è¦å ã¬ã¸ã¹ã¿ãåå¾ */
|
|---|
| 648 | mov.l @r0,r4
|
|---|
| 649 | shlr2 r4 /* 3ãããå³ã·ããããªãã»ãããæ±ãã */
|
|---|
| 650 | shlr r4
|
|---|
| 651 | mov.l _int_plevel_table_k,r0
|
|---|
| 652 | mov.l @(r0,r4),r5 /* å²ãè¾¼ã¿ã®åªå
|
|---|
| 653 | 度ãåå¾ */
|
|---|
| 654 | mov.l _int_table_k,r0
|
|---|
| 655 | mov.l @(r0,r4),r2 /* å²ãè¾¼ã¿ãã³ãã©ã®ã¢ãã¬ã¹ãåå¾ */
|
|---|
| 656 | ldc r2,r2_bank /* ãã³ã¯0ã«åãæ¿ããããã³ãã¼ */
|
|---|
| 657 | ldc r5,sr /* ãã以éå²ãè¾¼ã¿ãåãä»ããã */
|
|---|
| 658 | jsr @r2 /* å²ãè¾¼ã¿ãã³ãã©ã¸ */
|
|---|
| 659 | nop
|
|---|
| 660 | mov.l _mask_md_ipm_ret,r0
|
|---|
| 661 | ldc r0,sr /* å²ãè¾¼ã¿ç¦æ¢ */
|
|---|
| 662 | stc r7_bank,r7 /* ä¾å¤/å²ãè¾¼ã¿ã®ãã¹ãåæ°ããã¯ãªã¡ã³ã*/
|
|---|
| 663 | dt r7
|
|---|
| 664 | ldc r7,r7_bank
|
|---|
| 665 | mov.l _reqflg_k,r4 /* reqflgã®ãã§ã㯠*/
|
|---|
| 666 | mov.l @r4,r1
|
|---|
| 667 | tst r1,r1 /* reqflgãFALSEãªãret_to_task_intã«é£ã¶ */
|
|---|
| 668 | bt/s _ret_to_task_int /* ã¿ã¹ã¯ã«æ»ã */
|
|---|
| 669 | mov.l @r15,r15 /* æ»ãå
|
|---|
| 670 | ãã¿ã¹ã¯ãªã®ã§ã¹ã¿ãã¯ãæ»ã */
|
|---|
| 671 | xor r0,r0
|
|---|
| 672 | bra ret_int
|
|---|
| 673 | mov.l r0,@r4 /* reqflgãã¯ãªã¢ */
|
|---|
| 674 | _interrupt_from_int:
|
|---|
| 675 | mov.l _intevt,r0 /* ä¾å¤è¦å ã¬ã¸ã¹ã¿ãåå¾ */
|
|---|
| 676 | mov.l @r0,r4
|
|---|
| 677 | shlr2 r4 /* ãªãã»ãããæ±ãã */
|
|---|
| 678 | shlr r4 /* ãªãã»ãããæ±ãã */
|
|---|
| 679 | mov.l _int_plevel_table_k,r0
|
|---|
| 680 | mov.l @(r0,r4),r5 /* å²ãè¾¼ã¿ã®åªå
|
|---|
| 681 | 度ãåå¾ */
|
|---|
| 682 | mov.l _int_table_k,r0
|
|---|
| 683 | mov.l @(r0,r4),r2 /* å²ãè¾¼ã¿ãã³ãã©ã®ã¢ãã¬ã¹ãåå¾ */
|
|---|
| 684 | ldc r2,r2_bank /* ãã³ã¯0ã«åãæ¿ããããã³ãã¼ */
|
|---|
| 685 | ldc r5,sr /* ãã以éå²ãè¾¼ã¿ãåãä»ããã */
|
|---|
| 686 | jsr @r2 /* å²ãè¾¼ã¿ãã³ãã©ã¸ */
|
|---|
| 687 | nop
|
|---|
| 688 | mov.l _mask_md_ipm_ret,r0
|
|---|
| 689 | ldc r0,sr /* å²ãè¾¼ã¿ç¦æ¢ */
|
|---|
| 690 | stc r7_bank,r7 /* ä¾å¤/å²ãè¾¼ã¿ã®ãã¹ãåæ°ããã¯ãªã¡ã³ã*/
|
|---|
| 691 | dt r7
|
|---|
| 692 | ldc r7,r7_bank
|
|---|
| 693 | _ret_to_task_int:
|
|---|
| 694 | mov.l @r15+,r7 /* å²ãè¾¼ã¿å
|
|---|
| 695 | ã«æ»ã */
|
|---|
| 696 | mov.l @r15+,r6
|
|---|
| 697 | mov.l @r15+,r5
|
|---|
| 698 | mov.l @r15+,r4
|
|---|
| 699 | mov.l @r15+,r3
|
|---|
| 700 | mov.l @r15+,r2
|
|---|
| 701 | mov.l @r15+,r1
|
|---|
| 702 | mov.l _mask_md_bl_int,r0
|
|---|
| 703 | ldc r0,sr /* BL ã1ã« */
|
|---|
| 704 | mov.l @r15+,r0
|
|---|
| 705 | lds.l @r15+,mach
|
|---|
| 706 | lds.l @r15+,macl
|
|---|
| 707 | ldc.l @r15+,gbr
|
|---|
| 708 | ldc.l @r15+,ssr
|
|---|
| 709 | lds.l @r15+,pr
|
|---|
| 710 | ldc.l @r15+,spc
|
|---|
| 711 | rte
|
|---|
| 712 | nop
|
|---|
| 713 |
|
|---|
| 714 | /*
|
|---|
| 715 | * æªç»é²ã®å²è¾¼ã¿ãçºçããã¨ï¼ãã®æã® INTEVT,INTEVT2,SR,PC ã
|
|---|
| 716 | * å¼æ°ã«cpu_interrupt()ãå¼ã³åºãï¼
|
|---|
| 717 | */
|
|---|
| 718 | .global _no_reg_interrupt
|
|---|
| 719 | _no_reg_interrupt:
|
|---|
| 720 | mov.l _intevt1,r0
|
|---|
| 721 | mov.l @r0,r4
|
|---|
| 722 | #if defined(SH7709) || defined(SH7709A) || defined(SH7729R) || defined(SH7727)
|
|---|
| 723 | mov.l _intevt2,r0
|
|---|
| 724 | mov.l @r0,r5
|
|---|
| 725 | #endif
|
|---|
| 726 | stc spc,r6
|
|---|
| 727 | stc ssr,r7
|
|---|
| 728 | mov.l _cpu_interrupt_k,r1
|
|---|
| 729 | jsr @r1
|
|---|
| 730 | nop
|
|---|
| 731 |
|
|---|
| 732 |
|
|---|
| 733 | .align 4
|
|---|
| 734 | _stacktop_k:
|
|---|
| 735 | .long STACKTOP /* éã¿ã¹ã¯ç¬ç«é¨ã®ã¹ã¿ãã¯ã®åæå¤ */
|
|---|
| 736 | _intevt:
|
|---|
| 737 | #if defined(SH7708) || defined(SH7750)
|
|---|
| 738 | .long INTEVT
|
|---|
| 739 | #else
|
|---|
| 740 | .long INTEVT2
|
|---|
| 741 | #endif
|
|---|
| 742 | _int_table_k:
|
|---|
| 743 | .long _int_table
|
|---|
| 744 | _int_plevel_table_k:
|
|---|
| 745 | .long _int_plevel_table
|
|---|
| 746 | _reqflg_k:
|
|---|
| 747 | .long _reqflg
|
|---|
| 748 | _mask_md_ipm_ret:
|
|---|
| 749 | .long 0x40000000 + MAX_IPM << 4
|
|---|
| 750 | _mask_md_bl_int:
|
|---|
| 751 | .long 0x50000000
|
|---|
| 752 | _intevt1:
|
|---|
| 753 | .long INTEVT
|
|---|
| 754 | #if defined(SH7709) || defined(SH7709A) || defined(SH7729R) || defined(SH7727)
|
|---|
| 755 | _intevt2:
|
|---|
| 756 | .long INTEVT2
|
|---|
| 757 | #endif
|
|---|
| 758 | _cpu_interrupt_k:
|
|---|
| 759 | .long _cpu_interrupt
|
|---|
| 760 |
|
|---|
| 761 |
|
|---|
| 762 | /*
|
|---|
| 763 | * å¾®å°æéå¾
|
|---|
| 764 | ã¡
|
|---|
| 765 | */
|
|---|
| 766 | .globl _sil_dly_nse
|
|---|
| 767 | _sil_dly_nse:
|
|---|
| 768 | mov.l _sil_dly_tim1, r1
|
|---|
| 769 | add r1, r4
|
|---|
| 770 | cmp/pl r4
|
|---|
| 771 | bt _sil_dly_nse1
|
|---|
| 772 | rts
|
|---|
| 773 | nop
|
|---|
| 774 | _sil_dly_nse1:
|
|---|
| 775 | mov.l _sil_dly_tim2, r1
|
|---|
| 776 | add r1, r4
|
|---|
| 777 | cmp/pl r4
|
|---|
| 778 | bt _sil_dly_nse1
|
|---|
| 779 | rts
|
|---|
| 780 | nop
|
|---|
| 781 | .align 4
|
|---|
| 782 | _sil_dly_tim1:
|
|---|
| 783 | .long -SIL_DLY_TIM1
|
|---|
| 784 | _sil_dly_tim2:
|
|---|
| 785 | .long -SIL_DLY_TIM2
|
|---|
![(please configure the [header_logo] section in trac.ini)](/trac_user/contrib/chrome/site/your_project_logo.png){kind=logo}
