[61] | 1 | /*
|
---|
| 2 | * TOPPERS/ASP Kernel
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
| 4 | * Advanced Standard Profile Kernel
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2008 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 8 | *
|
---|
| 9 | * ãLì ÒÍCȺÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
|
---|
| 10 | * Ai{\tgEFAðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»Eü
|
---|
| 11 | * ÏEÄzziȺCpÆÄÔj·é±Æð³Åø·éD
|
---|
| 12 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
| 13 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[
|
---|
| 14 | * XR[hÉÜÜêÄ¢é±ÆD
|
---|
| 15 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
|
---|
| 16 | * pÅ«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
| 17 | gip
|
---|
| 18 | * Ò}j
|
---|
| 19 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL
|
---|
| 20 | * ̳ÛØKèðfÚ·é±ÆD
|
---|
| 21 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
|
---|
| 22 | * pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
|
---|
| 23 | * ÆD
|
---|
| 24 | * (a) Äzzɺ¤hL
|
---|
| 25 | gipÒ}j
|
---|
| 26 | AÈÇjÉCãLÌ
|
---|
| 27 | * ì \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
| 28 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
|
---|
| 29 | * ñ·é±ÆD
|
---|
| 30 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹
|
---|
| 31 | * Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
| 32 | * ܽC{\tgEFAÌ[UܽÍGh[U©çÌ¢©Èé
|
---|
| 33 | * RÉîÿ©çàCãLì Ò¨æÑTOPPERSvWFNgð
|
---|
| 34 | * ÆÓ·é±ÆD
|
---|
| 35 | *
|
---|
| 36 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
|
---|
| 37 | * æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
|
---|
| 38 | * ÉηéK«àÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEF
|
---|
| 39 | * AÌpÉæè¼ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»
|
---|
| 40 | * ÌÓCðíÈ¢D
|
---|
| 41 | *
|
---|
| 42 | */
|
---|
| 43 |
|
---|
| 44 | /*
|
---|
| 45 | * vZbT˶W
|
---|
| 46 | [iARM-Mpj
|
---|
| 47 | *
|
---|
| 48 | * ±ÌCN[ht@CÍCtarget_config.hiܽÍC»±©çCN
|
---|
| 49 | * [h³êét@CjÌÝ©çCN[h³êéD¼Ìt@C©ç
|
---|
| 50 | * ¼ÚCN[hµÄÍÈçÈ¢D
|
---|
| 51 | */
|
---|
| 52 |
|
---|
| 53 | #ifndef TOPPERS_PRC_CONFIG_H
|
---|
| 54 | #define TOPPERS_PRC_CONFIG_H
|
---|
| 55 |
|
---|
| 56 | #ifndef TOPPERS_MACRO_ONLY
|
---|
| 57 |
|
---|
| 58 | /*
|
---|
| 59 | * vZbTÌÁê½ßÌCCÖè`
|
---|
| 60 | */
|
---|
| 61 | #include "prc_insn.h"
|
---|
| 62 |
|
---|
| 63 |
|
---|
| 64 | #define TOPPERS_EMPTY_LABEL(x,y) x y[1]
|
---|
| 65 |
|
---|
| 66 |
|
---|
| 67 | /*
|
---|
| 68 | * ^[Qbg˶ÌIuWFNg®«
|
---|
| 69 | */
|
---|
| 70 | #define TARGET_INHATR TA_NONKERNEL /* ^[Qbgè`ÌÝnh®« */
|
---|
| 71 |
|
---|
| 72 | /*
|
---|
| 73 | * G[`FbNû@Ìwè
|
---|
| 74 | */
|
---|
| 75 | #define CHECK_STKSZ_ALIGN 8 /* X^bNTCYÌACPÊ */
|
---|
| 76 | #define CHECK_FUNC_ALIGN 1 /* ÖÌACPÊ */
|
---|
| 77 | #define CHECK_FUNC_NONNULL /* ÖÌñNULL`FbN */
|
---|
| 78 | #define CHECK_STACK_ALIGN 8 /* X^bNÌæÌACPÊ */
|
---|
| 79 | #define CHECK_STACK_NONNULL /* X^bNÌæÌñNULL`FbN */
|
---|
| 80 | #define CHECK_MPF_ALIGN 4 /* Åè·v[ÌæÌACPÊ */
|
---|
| 81 | #define CHECK_MPF_NONNULL /* Åè·v[ÌæÌñNULL`FbN */
|
---|
| 82 | #define CHECK_MB_ALIGN 4 /* ÇÌæÌACPÊ */
|
---|
| 83 |
|
---|
| 84 | /*
|
---|
| 85 | * ñ^XNReLXgpÌX^bNúl
|
---|
| 86 | */
|
---|
| 87 | #define TOPPERS_ISTKPT(istk, istksz) ((STK_T *)((char_t *)(istk) + (istksz)))
|
---|
| 88 |
|
---|
| 89 | /*
|
---|
| 90 | * ^XNReLXgubNÌè`
|
---|
| 91 | */
|
---|
| 92 | typedef struct task_context_block {
|
---|
| 93 | void *sp; /* X^bN|C^ */
|
---|
| 94 | FP pc; /* vOJE^ */
|
---|
| 95 | } TSKCTXB;
|
---|
| 96 |
|
---|
| 97 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
| 98 |
|
---|
| 99 | #ifndef TOPPERS_MACRO_ONLY
|
---|
| 100 | /*
|
---|
| 101 | * ReLXgÌQÆ
|
---|
| 102 | *
|
---|
| 103 | */
|
---|
| 104 | #pragma inline
|
---|
| 105 | bool_t
|
---|
| 106 | sense_context(void)
|
---|
| 107 | {
|
---|
| 108 | /*
|
---|
| 109 | * PSPªLøÈç^XNReLXgCMSPªLøÈçñ^XNReLXg
|
---|
| 110 | * Æ·éD
|
---|
| 111 | */
|
---|
| 112 | if ((get_control() & CONTROL_PSP) == CONTROL_PSP){
|
---|
| 113 | return false;
|
---|
| 114 | }
|
---|
| 115 | else {
|
---|
| 116 | return true;
|
---|
| 117 | }
|
---|
| 118 | }
|
---|
| 119 |
|
---|
| 120 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
| 121 |
|
---|
| 122 | /*
|
---|
| 123 | * TOPPERSWÝfÌÀ»
|
---|
| 124 | *
|
---|
| 125 | * ÝDæx}XNƵÄÍCBASEPRIðp¢éDSÝðÖ~·é
|
---|
| 126 | * @\ƵÄCFAULTMASKâPRIMASKª éªCJ[lÇOÌÝð
|
---|
| 127 | * T|[g·é½ßC±êçÍCPUbN̽ßÉp¢È¢D
|
---|
| 128 | * »Ì½ßCBASEPRIðp¢Ä[IÉCPUbNtOðÀ»·éD
|
---|
| 129 | *
|
---|
| 130 | * ܸCCPUbNóÔðÇ·½ßÌÏ(lock_flag)ðpÓ·éD
|
---|
| 131 | *
|
---|
| 132 | * CPUbNtOªNA³êÄ¢éÔÍCBASEPRIðfãÌÝ
|
---|
| 133 | * Dæx}XNÌlÉÝè·éD±ÌÔÍCfãÌÝDæx}X
|
---|
| 134 | * NÍCBASEPRIðp¢éD
|
---|
| 135 | *
|
---|
| 136 | * »êÉεÄCPUbNtOªZbg³ê¢éÔÍCBASEPRIðCJ[l
|
---|
| 137 | * ÇOÌàÌð·×ÄÌÝvð}XN·él(TIPM_LOCK)ÆC
|
---|
| 138 | * fãÌÝDæx}XNÆÌ¢ûÉÝè·éD±ÌÔÌfã
|
---|
| 139 | * ÌÝDæx}XNÍC»Ì½ßÌÏ(saved_iipm, à\»ÅÛ)
|
---|
| 140 | * ðpÓµÄÛ·éD
|
---|
| 141 | */
|
---|
| 142 |
|
---|
| 143 | /*
|
---|
| 144 | * ÝDæx}XNÌO\»Æà\»ÌÏ·
|
---|
| 145 | *
|
---|
| 146 | * AZu¾êÌ\[Xt@C©çCN[h·éê̽ßÉC
|
---|
| 147 | * CASTðgp
|
---|
| 148 | * ÝDæxÌrbg(TBITW_IPRI)ª 8 ÌêÍCàDæx 255
|
---|
| 149 | * ÍCODæx -1 ÉηéD
|
---|
| 150 | */
|
---|
| 151 | #define EXT_IPM(iipm) (CAST(PRI,((iipm >> (8 - TBITW_IPRI)) - (1 << TBITW_IPRI)))) /* à\»ðO\»É */
|
---|
| 152 | #define INT_IPM(ipm) (((1 << TBITW_IPRI) - CAST(uint8_t, -(ipm))) << (8 - TBITW_IPRI)) /* O\»ðà\»É */
|
---|
| 153 |
|
---|
| 154 | /*
|
---|
| 155 | * CPUbNóÔÅÌÝDæx}XN
|
---|
| 156 | */
|
---|
| 157 | #define TIPM_LOCK TMIN_INTPRI
|
---|
| 158 |
|
---|
| 159 | /*
|
---|
| 160 | * CPUbNóÔÅÌÝDæx}XNÌà\»
|
---|
| 161 | *
|
---|
| 162 | * TIPM_LOCKÍCCPUbNóÔÅÌBASEPRIÌlDJ[lÇOÌàÌð
|
---|
| 163 | * ·×ÄÌÝð}XN·élÉè`·éD
|
---|
| 164 | */
|
---|
| 165 | #define IIPM_LOCK INT_IPM(TIPM_LOCK)
|
---|
| 166 |
|
---|
| 167 | /*
|
---|
| 168 | * TIPM_ENAALLiÝDæx}XNSðjÌà\»
|
---|
| 169 | *
|
---|
| 170 | * BASEPRIÉ '0' ðÝè·é±ÆÅCSÝð·éD
|
---|
| 171 | */
|
---|
| 172 | #define IIPM_ENAALL (0)
|
---|
| 173 |
|
---|
| 174 | #define _kernel_vector_table __vector_table
|
---|
| 175 |
|
---|
| 176 | #ifndef TOPPERS_MACRO_ONLY
|
---|
| 177 |
|
---|
| 178 | /*
|
---|
| 179 | * CPUbNtOÀ»Ì½ßÌÏ
|
---|
| 180 | *
|
---|
| 181 | * ±êçÌÏÍCCPUbNóÔÌÌÝ«·¦Äàæ¢Æ·éD
|
---|
| 182 | * CCÖÅCANZX̪ϻµÈ¢æ¤Cvolatile ðwèD
|
---|
| 183 | */
|
---|
| 184 | extern volatile bool_t lock_flag; /* CPUbNtOÌlðÛ·éÏ */
|
---|
| 185 | extern volatile uint32_t saved_iipm; /* ÝDæxð}XN·éÏ */
|
---|
| 186 |
|
---|
| 187 | /*
|
---|
| 188 | * CPUbNóÔÖÌÚs
|
---|
| 189 | *
|
---|
| 190 | * BASEPRIin[hEFAÌÝDæx}XNjðCsaved_iipmÉÛ¶µC
|
---|
| 191 | * J[lÇOÌàÌð·×ÄÌÝð}XN·éliTIPM_LOCKj
|
---|
| 192 | * ÉÝè·éDܽClock_flagðtrueÉ·éD
|
---|
| 193 | *
|
---|
| 194 | * BASEPRIªCÅ©çTIPM_LOCKƯ¶©»êæè¢êÉÍC»êð
|
---|
| 195 | * saved_iipmÉÛ¶·éÌÝÅCTIPM_LOCKÉÍÝèµÈ¢D±êÍCf
|
---|
| 196 | * ãÌÝDæx}XNªCTIPM_LOCKƯ¶©»êæè¢xÉÝè
|
---|
| 197 | * ³êÄ¢éóÔÉ ½éD
|
---|
| 198 | *
|
---|
| 199 | * ±ÌÖÍCCPUbNóÔilock_flagªtrueÌóÔjÅÄÎêé±ÆÍ
|
---|
| 200 | * È¢àÌÆzèµÄ¢éD
|
---|
| 201 | */
|
---|
| 202 | #pragma inline
|
---|
| 203 | void
|
---|
| 204 | x_lock_cpu(void)
|
---|
| 205 | {
|
---|
| 206 | uint32_t iipm;
|
---|
| 207 |
|
---|
| 208 | /*
|
---|
| 209 | * current_iipm()ÌÔèlð¼Úsaved_iipmÉÛ¶¹¸CêÏiipm
|
---|
| 210 | * ðp¢Ä¢éÌÍCcurrent_iipm()ðÄñ¾¼ãÉݪ¶µC
|
---|
| 211 | * N®³ê½ÝÅsaved_iipmªÏX³êéÂ\«ª é½ßÅ
|
---|
| 212 | * éD
|
---|
| 213 | */
|
---|
| 214 | iipm = get_basepri();
|
---|
| 215 | if ((IIPM_LOCK < iipm) || (IIPM_ENAALL == iipm)) {
|
---|
| 216 | set_basepri(IIPM_LOCK);
|
---|
| 217 | }
|
---|
| 218 | saved_iipm = iipm;
|
---|
| 219 | lock_flag = true;
|
---|
| 220 | /* NeBJZNVÌOãŪ«·íéÂ\«ª é */
|
---|
| 221 | Asm("":::"memory");
|
---|
| 222 | }
|
---|
| 223 |
|
---|
| 224 | #define t_lock_cpu() x_lock_cpu()
|
---|
| 225 | #define i_lock_cpu() x_lock_cpu()
|
---|
| 226 |
|
---|
| 227 | /*
|
---|
| 228 | * CPUbNóÔÌð
|
---|
| 229 | *
|
---|
| 230 | * lock_flagðfalseɵCIPMin[hEFAÌÝDæx}XNjðC
|
---|
| 231 | * saved_iipmÉÛ¶µ½lÉß·D
|
---|
| 232 | *
|
---|
| 233 | * ±ÌÖÍCCPUbNóÔilock_flagªtrueÌóÔjÅÌÝÄÎêéà
|
---|
| 234 | * ÌÆzèµÄ¢éD
|
---|
| 235 | */
|
---|
| 236 | #pragma inline
|
---|
| 237 | void
|
---|
| 238 | x_unlock_cpu(void)
|
---|
| 239 | {
|
---|
| 240 | /* NeBJZNVÌOãŪ«·íéÂ\«ª é */
|
---|
| 241 | Asm("":::"memory");
|
---|
| 242 | lock_flag = false;
|
---|
| 243 | set_basepri(saved_iipm);
|
---|
| 244 | }
|
---|
| 245 |
|
---|
| 246 | #define t_unlock_cpu() x_unlock_cpu()
|
---|
| 247 | #define i_unlock_cpu() x_unlock_cpu()
|
---|
| 248 |
|
---|
| 249 | /*
|
---|
| 250 | * CPUbNóÔÌQÆ
|
---|
| 251 | */
|
---|
| 252 | #pragma inline
|
---|
| 253 | bool_t
|
---|
| 254 | x_sense_lock(void)
|
---|
| 255 | {
|
---|
| 256 | return(lock_flag);
|
---|
| 257 | }
|
---|
| 258 |
|
---|
| 259 | #define t_sense_lock() x_sense_lock()
|
---|
| 260 | #define i_sense_lock() x_sense_lock()
|
---|
| 261 |
|
---|
| 262 | /*
|
---|
| 263 | * chg_ipmÅLøÈÝDæxÌÍÍÌ»è
|
---|
| 264 | *
|
---|
| 265 | * TMIN_INTPRIÌlÉæç¸Cchg_ipmÅÍC-(1 << TBITW_IPRI)`TIPM_ENAALLi0j
|
---|
| 266 | * ÌÍÍÉÝèÅ«é±ÆÆ·éi^[Qbgè`Ìg£jD
|
---|
| 267 | * ÝDæxÌrbg(TBITW_IPRI)ª 8 ÌêÍC-256 ` 0 ªwèÂ\Å éD
|
---|
| 268 | *
|
---|
| 269 | */
|
---|
| 270 | #define VALID_INTPRI_CHGIPM(intpri) \
|
---|
| 271 | ((-((1 << TBITW_IPRI) - 1) <= (intpri) && (intpri) <= TIPM_ENAALL))
|
---|
| 272 |
|
---|
| 273 | /*
|
---|
| 274 | * ifãÌjÝDæx}XNÌÝè
|
---|
| 275 | *
|
---|
| 276 | * CPUbNtOªNA³êÄ¢éÍCn[hEFAÌÝDæx}
|
---|
| 277 | * XNðÝè·éDCPUbNtOªZbg³êÄ¢éÍCsaved_iipm
|
---|
| 278 | * ðÝèµC³çÉCn[hEFAÌÝDæx}XNðCÝèµæ¤Æ
|
---|
| 279 | * µ½ifãÌjÝDæx}XNÆTIPM_LOCKÌ¢ûÉÝè·éD
|
---|
| 280 | */
|
---|
| 281 | #pragma inline
|
---|
| 282 | void
|
---|
| 283 | x_set_ipm(PRI intpri)
|
---|
| 284 | {
|
---|
| 285 | uint8_t iipm = INT_IPM(intpri);
|
---|
| 286 |
|
---|
| 287 | if (intpri == TIPM_ENAALL){
|
---|
| 288 | iipm = IIPM_ENAALL;
|
---|
| 289 | }
|
---|
| 290 |
|
---|
| 291 | if (!lock_flag) {
|
---|
| 292 | set_basepri(iipm);
|
---|
| 293 | }
|
---|
| 294 | else {
|
---|
| 295 | saved_iipm = iipm;
|
---|
| 296 | set_basepri(iipm < IIPM_LOCK ? iipm : IIPM_LOCK);
|
---|
| 297 | }
|
---|
| 298 | }
|
---|
| 299 |
|
---|
| 300 | #define t_set_ipm(intpri) x_set_ipm(intpri)
|
---|
| 301 | #define i_set_ipm(intpri) x_set_ipm(intpri)
|
---|
| 302 |
|
---|
| 303 | /*
|
---|
| 304 | * ifãÌjÝDæx}XNÌQÆ
|
---|
| 305 | *
|
---|
| 306 | * CPUbNtOªNA³êÄ¢éÍn[hEFAÌÝDæx}
|
---|
| 307 | * XNðCZbg³êÄ¢éÍsaved_iipmðQÆ·éD
|
---|
| 308 | */
|
---|
| 309 | #pragma inline
|
---|
| 310 | PRI
|
---|
| 311 | x_get_ipm(void)
|
---|
| 312 | {
|
---|
| 313 | uint8_t iipm;
|
---|
| 314 |
|
---|
| 315 | if (!lock_flag) {
|
---|
| 316 | iipm = get_basepri();
|
---|
| 317 | }
|
---|
| 318 | else {
|
---|
| 319 | iipm = saved_iipm;
|
---|
| 320 | }
|
---|
| 321 |
|
---|
| 322 | if (iipm == IIPM_ENAALL) {
|
---|
| 323 | return(TIPM_ENAALL);
|
---|
| 324 | }
|
---|
| 325 | else {
|
---|
| 326 | return(EXT_IPM(iipm));
|
---|
| 327 | }
|
---|
| 328 | }
|
---|
| 329 |
|
---|
| 330 | #define t_get_ipm() x_get_ipm()
|
---|
| 331 | #define i_get_ipm() x_get_ipm()
|
---|
| 332 |
|
---|
| 333 | /*
|
---|
| 334 | * SVCnhiprc_support.Sj
|
---|
| 335 | */
|
---|
| 336 | extern void svc_handler(void);
|
---|
| 337 |
|
---|
| 338 | /*
|
---|
| 339 | * X^[gAbv[`istart.Sj
|
---|
| 340 | */
|
---|
| 341 | extern void _start(void);
|
---|
| 342 |
|
---|
| 343 | /*
|
---|
| 344 | * ÅDæÊ^XNÖÌfBXpb`iprc_support.Sj
|
---|
| 345 | *
|
---|
| 346 | * dispatchÍC^XNReLXg©çÄÑo³ê½T[rXR[©
|
---|
| 347 | * çÄÑo·×«àÌÅC^XNReLXgECPUbNóÔEfBXpb
|
---|
| 348 | * `ÂóÔEifãÌjÝDæx}XNSðóÔÅÄÑo³È
|
---|
| 349 | * ¯êÎÈçÈ¢D
|
---|
| 350 | */
|
---|
| 351 | extern void dispatch(void);
|
---|
| 352 |
|
---|
| 353 | /*
|
---|
| 354 | * fBXpb`Ì®ìJniprc_support.Sj
|
---|
| 355 | *
|
---|
| 356 | * start_dispatchÍCJ[lN®ÉÄÑo·×«àÌÅC·×ÄÌ
|
---|
| 357 | * ÝðÖ~µ½óÔiÝbNóÔƯÌóÔjÅÄÑo³È¯êÎ
|
---|
| 358 | * ÈçÈ¢D
|
---|
| 359 | */
|
---|
| 360 | extern NoReturn void start_dispatch(void);
|
---|
| 361 |
|
---|
| 362 | /*
|
---|
| 363 | * »ÝÌReLXgðÌÄÄfBXpb`iprc_support.Sj
|
---|
| 364 | *
|
---|
| 365 | * exit_and_dispatchÍCext_tsk©çÄÑo·×«àÌÅC^XNReL
|
---|
| 366 | * XgECPUbNóÔEfBXpb`ÂóÔEifãÌjÝDæ
|
---|
| 367 | * x}XNSðóÔÅÄÑo³È¯êÎÈçÈ¢D
|
---|
| 368 | */
|
---|
| 369 | extern NoReturn void exit_and_dispatch(void);
|
---|
| 370 |
|
---|
| 371 | /*
|
---|
| 372 | * J[lÌI¹ÌÄoµiprc_support.Sj
|
---|
| 373 | *
|
---|
| 374 | * call_exit_kernelÍCJ[lÌI¹ÉÄÑo·×«àÌÅCñ^XN
|
---|
| 375 | * ReLXgÉØè·¦ÄCJ[lÌI¹iexit_kerneljðÄÑo
|
---|
| 376 | * ·D
|
---|
| 377 | */
|
---|
| 378 | extern NoReturn void call_exit_kernel(void);
|
---|
| 379 |
|
---|
| 380 | /*
|
---|
| 381 | * ^XNReLXgÌú»
|
---|
| 382 | *
|
---|
| 383 | * ^XNªx~óÔ©çÀsÅ«éóÔÉÚs·éÉÄÎêéD±Ì_
|
---|
| 384 | * ÅX^bNÌæðgÁÄÍÈçÈ¢D
|
---|
| 385 | *
|
---|
| 386 | * activate_contextðCCCÖÅÍÈ}Nè`ƵĢéÌÍC
|
---|
| 387 | * ±Ì_ÅÍTCBªè`³êĢȢ½ßÅ éD
|
---|
| 388 | */
|
---|
| 389 | extern void start_r(void);
|
---|
| 390 |
|
---|
| 391 | #define activate_context(p_tcb) \
|
---|
| 392 | { \
|
---|
| 393 | (p_tcb)->tskctxb.sp = (void *)((char_t *)((p_tcb)->p_tinib->stk) \
|
---|
| 394 | + (p_tcb)->p_tinib->stksz); \
|
---|
| 395 | (p_tcb)->tskctxb.pc = (FP) start_r; \
|
---|
| 396 | }
|
---|
| 397 |
|
---|
| 398 | /*
|
---|
| 399 | * calltexÍgpµÈ¢
|
---|
| 400 | */
|
---|
| 401 | #define OMIT_CALLTEX
|
---|
| 402 |
|
---|
| 403 | /*
|
---|
| 404 | * ÝÔEÝnhÔ
|
---|
| 405 | *
|
---|
| 406 | * ÝnhÔ(inhno)ÆÝÔ(intno)ÍCèݶÉ
|
---|
| 407 | * EPSRÉÝè³êéáOÔÆ·éD
|
---|
| 408 | */
|
---|
| 409 |
|
---|
| 410 | /*
|
---|
| 411 | * ÝÔÌÍÍÌ»è
|
---|
| 412 | */
|
---|
| 413 | #define VALID_INTNO(intno) ((TMIN_INTNO <= (intno)) && ((intno) <= TMAX_INTNO))
|
---|
| 414 | #define VALID_INTNO_DISINT(intno) VALID_INTNO(intno)
|
---|
| 415 | #define VALID_INTNO_CFGINT(intno) VALID_INTNO(intno)
|
---|
| 416 |
|
---|
| 417 | /*
|
---|
| 418 | * ÝnhÌÝè
|
---|
| 419 | *
|
---|
| 420 | * xNgÔinhnoÌÝnhÌN®Ônint_entryÉÝè·éDÝ
|
---|
| 421 | * nhe[u
|
---|
| 422 | */
|
---|
| 423 | #pragma inline
|
---|
| 424 | void
|
---|
| 425 | x_define_inh(INHNO inhno, FP int_entry)
|
---|
| 426 | {
|
---|
| 427 |
|
---|
| 428 | }
|
---|
| 429 |
|
---|
| 430 | /*
|
---|
| 431 | * ÝnhÌoüû̶¬}N
|
---|
| 432 | *
|
---|
| 433 | */
|
---|
| 434 | #define INT_ENTRY(inhno, inthdr) inthdr
|
---|
| 435 | #define INTHDR_ENTRY(inhno, inhno_num, inthdr) extern void inthdr(void);
|
---|
| 436 |
|
---|
| 437 | /*
|
---|
| 438 | * ÝvÖ~tO
|
---|
| 439 | */
|
---|
| 440 |
|
---|
| 441 | /*
|
---|
| 442 | * Ý®«ªÝè³êÄ¢é©ð»Ê·é½ßÌÏikernel_cfg.cj
|
---|
| 443 | */
|
---|
| 444 | extern const uint32_t bitpat_cfgint[];
|
---|
| 445 |
|
---|
| 446 | /*
|
---|
| 447 | * ÝvÖ~tOÌZbg
|
---|
| 448 | *
|
---|
| 449 | * Ý®«ªÝè³êĢȢÝvCÉεÄÝvÖ~
|
---|
| 450 | * tOðNAµæ¤Æµ½êÉÍCfalseðÔ·D
|
---|
| 451 | */
|
---|
| 452 | #pragma inline
|
---|
| 453 | bool_t
|
---|
| 454 | x_disable_int(INTNO intno)
|
---|
| 455 | {
|
---|
| 456 | uint32_t tmp;
|
---|
| 457 |
|
---|
| 458 | /*
|
---|
| 459 | * Ý®«ªÝè³êĢȢê
|
---|
| 460 | */
|
---|
| 461 | if ((bitpat_cfgint[intno >> 5] & (1 << (intno & 0x1f))) == 0x00) {
|
---|
| 462 | return(false);
|
---|
| 463 | }
|
---|
| 464 |
|
---|
| 465 | if (intno == IRQNO_SYSTICK) {
|
---|
| 466 | tmp = sil_rew_mem((void *)SYSTIC_CONTROL_STATUS);
|
---|
| 467 | tmp &= ~SYSTIC_TICINT;
|
---|
| 468 | sil_wrw_mem((void *)SYSTIC_CONTROL_STATUS, tmp);
|
---|
| 469 | }else {
|
---|
| 470 | tmp = intno - 16;
|
---|
| 471 | sil_wrw_mem((void *)((uint32_t *)NVIC_CLRENA0 + (tmp >> 5)),
|
---|
| 472 | (1 << (tmp & 0x1f)));
|
---|
| 473 | }
|
---|
| 474 |
|
---|
| 475 | return(true);
|
---|
| 476 | }
|
---|
| 477 |
|
---|
| 478 | #define t_disable_int(intno) x_disable_int(intno)
|
---|
| 479 | #define i_disable_int(intno) x_disable_int(intno)
|
---|
| 480 |
|
---|
| 481 | /*
|
---|
| 482 | * ÝvÖ~tOÌð
|
---|
| 483 | *
|
---|
| 484 | * Ý®«ªÝè³êĢȢÝvCÉεÄÝvÖ~
|
---|
| 485 | * tOðNAµæ¤Æµ½êÉÍCfalseðÔ·D
|
---|
| 486 | */
|
---|
| 487 | #pragma inline
|
---|
| 488 | bool_t
|
---|
| 489 | x_enable_int(INTNO intno)
|
---|
| 490 | {
|
---|
| 491 | uint32_t tmp;
|
---|
| 492 |
|
---|
| 493 | /*
|
---|
| 494 | * Ý®«ªÝè³êĢȢê
|
---|
| 495 | */
|
---|
| 496 | if ((bitpat_cfgint[intno >> 5] & (1 << (intno & 0x1f))) == 0x00) {
|
---|
| 497 | return(false);
|
---|
| 498 | }
|
---|
| 499 |
|
---|
| 500 | if (intno == IRQNO_SYSTICK) {
|
---|
| 501 | tmp = sil_rew_mem((void *)SYSTIC_CONTROL_STATUS);
|
---|
| 502 | tmp |= SYSTIC_TICINT;
|
---|
| 503 | sil_wrw_mem((void *)SYSTIC_CONTROL_STATUS, tmp);
|
---|
| 504 | }else {
|
---|
| 505 | tmp = intno - 16;
|
---|
| 506 | sil_wrw_mem((void *)((uint32_t *)NVIC_SETENA0 + (tmp >> 5)),
|
---|
| 507 | (1 << (tmp & 0x1f)));
|
---|
| 508 | }
|
---|
| 509 |
|
---|
| 510 | return(true);
|
---|
| 511 | }
|
---|
| 512 |
|
---|
| 513 | #define t_enable_int(intno) x_enable_int(intno)
|
---|
| 514 | #define i_enable_int(intno) x_enable_int(intno)
|
---|
| 515 |
|
---|
| 516 | /*
|
---|
| 517 | * ÝvCÌ®«ÌÝè
|
---|
| 518 | */
|
---|
| 519 | extern void x_config_int(INTNO intno, ATR intatr, PRI intpri);
|
---|
| 520 |
|
---|
| 521 | /*
|
---|
| 522 | * ÝnhüûÅKvÈIRCì
|
---|
| 523 | */
|
---|
| 524 | #pragma inline
|
---|
| 525 | void
|
---|
| 526 | i_begin_int(INTNO intno)
|
---|
| 527 | {
|
---|
| 528 | }
|
---|
| 529 |
|
---|
| 530 | /*
|
---|
| 531 | * ÝnhÌoûÅKvÈIRCì
|
---|
| 532 | */
|
---|
| 533 | #pragma inline
|
---|
| 534 | void
|
---|
| 535 | i_end_int(INTNO intno)
|
---|
| 536 | {
|
---|
| 537 | }
|
---|
| 538 |
|
---|
| 539 | /*
|
---|
| 540 | * CPUáOnhÖW
|
---|
| 541 | */
|
---|
| 542 |
|
---|
| 543 | /*
|
---|
| 544 | * CPUáOnhÔ
|
---|
| 545 | */
|
---|
| 546 | #define VALID_EXCNO_DEFEXC(excno) (TMIN_EXCNO <= (excno) && (excno) <= TMAX_EXCNO)
|
---|
| 547 |
|
---|
| 548 | /*
|
---|
| 549 | * CPUáOnhÌÂ
|
---|
| 550 | */
|
---|
| 551 | extern void enable_exc(EXCNO excno);
|
---|
| 552 |
|
---|
| 553 | /*
|
---|
| 554 | * CPUáOnhÌÖ~
|
---|
| 555 | */
|
---|
| 556 | extern void disable_exc(EXCNO excno);
|
---|
| 557 |
|
---|
| 558 | /*
|
---|
| 559 | * CPUáOnhÌÝè
|
---|
| 560 | */
|
---|
| 561 | #pragma inline
|
---|
| 562 | void
|
---|
| 563 | x_define_exc(EXCNO excno, FP exc_entry)
|
---|
| 564 | {
|
---|
| 565 | /*
|
---|
| 566 | * êÌáOÍÂðs¤Kvª é
|
---|
| 567 | */
|
---|
| 568 | enable_exc(excno);
|
---|
| 569 | }
|
---|
| 570 |
|
---|
| 571 | /*
|
---|
| 572 | * CPUáOnhÌüû̶¬}N
|
---|
| 573 | */
|
---|
| 574 | #define EXC_ENTRY(excno, exchdr) exchdr
|
---|
| 575 | #define EXCHDR_ENTRY(excno, excno_num, exchdr) extern void exchdr(void *p_excinf);
|
---|
| 576 |
|
---|
| 577 | /*
|
---|
| 578 | * CPUáO̶µ½ÌReLXgÌQÆ
|
---|
| 579 | *
|
---|
| 580 | * CPUáO̶µ½ÌReLXgªC^XNReLXgÌÉfalseC
|
---|
| 581 | * »¤ÅÈ¢ÉtrueðÔ·D
|
---|
| 582 | */
|
---|
| 583 | #pragma inline
|
---|
| 584 | bool_t
|
---|
| 585 | exc_sense_context(void *p_excinf)
|
---|
| 586 | {
|
---|
| 587 | uint32_t exc_return;
|
---|
| 588 |
|
---|
| 589 | exc_return = *((uint32_t *)p_excinf + P_EXCINF_OFFSET_EXC_RETURN);
|
---|
| 590 | if ((exc_return & EXC_RETURN_PSP) == EXC_RETURN_PSP){
|
---|
| 591 | return false;
|
---|
| 592 | }
|
---|
| 593 | else {
|
---|
| 594 | return true;
|
---|
| 595 | }
|
---|
| 596 | }
|
---|
| 597 |
|
---|
| 598 | /*
|
---|
| 599 | * CPUáO̶µ½ÌIPMin[hEFAÌÝDæx}XNCà\
|
---|
| 600 | * »jÌQÆ
|
---|
| 601 | */
|
---|
| 602 | #pragma inline
|
---|
| 603 | uint32_t
|
---|
| 604 | exc_get_iipm(void *p_excinf)
|
---|
| 605 | {
|
---|
| 606 | return(*((uint32_t *)p_excinf + P_EXCINF_OFFSET_BASEPRI));
|
---|
| 607 | }
|
---|
| 608 |
|
---|
| 609 | /*
|
---|
| 610 | * CPUáO̶µ½ÌReLXgÆÝÌ}XNóÔÌQÆ
|
---|
| 611 | *
|
---|
| 612 | * CPUáO̶µ½ÌVXeóÔªCJ[lÀsÅÈC^XNR
|
---|
| 613 | * eLXgÅ èCÝbNóÔÅÈCCPUbNóÔÅÈCi
|
---|
| 614 | * fãÌjÝDæx}XNSðóÔÅ éÉtrueC»¤ÅÈ¢
|
---|
| 615 | * ÉfalseðÔ·iCPUáOªJ[lÇOÌÝŶµ½ê
|
---|
| 616 | * ÉàfalseðÔ·jD
|
---|
| 617 | *
|
---|
| 618 | * PUáO̶µ½ÌBASEPRIin[hEFAÌÝDæx}XNj
|
---|
| 619 | * ª·×ÄÌÝð·éóÔÅ é±Æð`FbN·é±ÆÅCJ[
|
---|
| 620 | * lÀsÅÈ¢±ÆCÝbNóÔÅÈ¢±ÆCCPUbNóÔÅÈ
|
---|
| 621 | * ¢±ÆCifãÌjÝDæx}XNSðóÔÅ é±ÆÌ4ÂÌ
|
---|
| 622 | * ðð`FbN·é±ÆªÅ«éiCPUáOª¶µ½Ìlock_flagðQ
|
---|
| 623 | * Æ·éKvÍÈ¢jD
|
---|
| 624 | */
|
---|
| 625 | #pragma inline
|
---|
| 626 | bool_t
|
---|
| 627 | exc_sense_intmask(void *p_excinf)
|
---|
| 628 | {
|
---|
| 629 | return(!exc_sense_context(p_excinf)
|
---|
| 630 | && (exc_get_iipm(p_excinf) == IIPM_ENAALL));
|
---|
| 631 | }
|
---|
| 632 |
|
---|
| 633 | /*
|
---|
| 634 | * CPUáOGgiprc_support.Sj
|
---|
| 635 | */
|
---|
| 636 | extern void core_exc_entry(void);
|
---|
| 637 |
|
---|
| 638 | /*
|
---|
| 639 | * ÝGgiprc_support.Sj
|
---|
| 640 | */
|
---|
| 641 | extern void core_int_entry(void);
|
---|
| 642 |
|
---|
| 643 | /*
|
---|
| 644 | * vZbT˶Ìú»
|
---|
| 645 | */
|
---|
| 646 | extern void core_initialize(void);
|
---|
| 647 |
|
---|
| 648 | /*
|
---|
| 649 | * vZbT˶ÌI¹
|
---|
| 650 | */
|
---|
| 651 | extern void core_terminate(void);
|
---|
| 652 |
|
---|
| 653 | /*
|
---|
| 654 | * o^³êĢȢáOª¶·éÆÄÑo³êé
|
---|
| 655 | */
|
---|
| 656 | extern void default_exc_handler(void *p_excinf);
|
---|
| 657 |
|
---|
| 658 | /*
|
---|
| 659 | * ¢o^Ìݪ¶µ½êÉÄÑo³êé
|
---|
| 660 | */
|
---|
| 661 | extern void default_int_handler(void *p_excinf);
|
---|
| 662 |
|
---|
| 663 | #endif /* TOPPERS_MACRO_ONLY */
|
---|
| 664 | #endif /* TOPPERS_PRC_CONFIG_H */
|
---|