[101] | 1 | /*
|
---|
| 2 | * TOPPERS/SSP Kernel
|
---|
| 3 | * Smallest Set Profile Kernel
|
---|
| 4 | *
|
---|
| 5 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
|
---|
| 6 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 7 | * Copyright (C) 2005-2010 by Embedded and Real-Time Systems Laboratory
|
---|
| 8 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 9 | * Copyright (C) 2011 by Meika Sugimoto
|
---|
| 10 | * Copyright (C) 2015 by Naoki Saito
|
---|
| 11 | * Nagoya Municipal Industrial Research Institute, JAPAN
|
---|
| 12 | *
|
---|
| 13 | * ãLì ÒÍCÈºÌ (1)`(4) Ìðð½·êÉÀèC{\tgEF
|
---|
| 14 | * Ai{\tgEFAðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»EüÏE
|
---|
| 15 | * ÄzziȺCpÆÄÔj·é±Æð³Åø·éD
|
---|
| 16 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
| 17 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[X
|
---|
| 18 | * R[hÉÜÜêÄ¢é±ÆD
|
---|
| 19 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉgp
|
---|
| 20 | * Å«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
| 21 | gipÒ}
|
---|
| 22 | * j
|
---|
| 23 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL̳Û
|
---|
| 24 | * ØKèðfÚ·é±ÆD
|
---|
| 25 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉgp
|
---|
| 26 | * Å«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±ÆD
|
---|
| 27 | * (a) Äzzɺ¤hL
|
---|
| 28 | gipÒ}j
|
---|
| 29 | AÈÇjÉCãLÌì
|
---|
| 30 | * \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
| 31 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉñ
|
---|
| 32 | * ·é±ÆD
|
---|
| 33 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹Q
|
---|
| 34 | * ©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆDܽC
|
---|
| 35 | * {\tgEFAÌ[UܽÍGh[U©çÌ¢©ÈéRÉîÃ
|
---|
| 36 | * ¿©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
| 37 | *
|
---|
| 38 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨æ
|
---|
| 39 | * ÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚIÉη
|
---|
| 40 | * éK«àÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEFAÌp
|
---|
| 41 | * Éæè¼ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»ÌÓCð
|
---|
| 42 | * íÈ¢D
|
---|
| 43 | *
|
---|
| 44 | */
|
---|
| 45 | /*
|
---|
| 46 | * CxgtO@\
|
---|
| 47 | */
|
---|
| 48 |
|
---|
| 49 |
|
---|
| 50 | #include "kernel_impl.h"
|
---|
| 51 | #include "check.h"
|
---|
| 52 | #include "eventflag.h"
|
---|
| 53 |
|
---|
| 54 | /*
|
---|
| 55 | * g[XO}NÌftHgè`
|
---|
| 56 | */
|
---|
| 57 | #ifndef LOG_SET_FLG_ENTER
|
---|
| 58 | #define LOG_SET_FLG_ENTER(flgid, setptn)
|
---|
| 59 | #endif /* LOG_SET_FLG_ENTER */
|
---|
| 60 |
|
---|
| 61 | #ifndef LOG_SET_FLG_LEAVE
|
---|
| 62 | #define LOG_SET_FLG_LEAVE(ercd)
|
---|
| 63 | #endif /* LOG_SET_FLG_LEAVE */
|
---|
| 64 |
|
---|
| 65 | #ifndef LOG_ISET_FLG_ENTER
|
---|
| 66 | #define LOG_ISET_FLG_ENTER(flgid, setptn)
|
---|
| 67 | #endif /* LOG_ISET_FLG_ENTER */
|
---|
| 68 |
|
---|
| 69 | #ifndef LOG_ISET_FLG_LEAVE
|
---|
| 70 | #define LOG_ISET_FLG_LEAVE(ercd)
|
---|
| 71 | #endif /* LOG_ISET_FLG_LEAVE */
|
---|
| 72 |
|
---|
| 73 | #ifndef LOG_CLR_FLG_ENTER
|
---|
| 74 | #define LOG_CLR_FLG_ENTER(flgid, clrptn)
|
---|
| 75 | #endif /* LOG_CLR_FLG_ENTER */
|
---|
| 76 |
|
---|
| 77 | #ifndef LOG_CLR_FLG_LEAVE
|
---|
| 78 | #define LOG_CLR_FLG_LEAVE(ercd)
|
---|
| 79 | #endif /* LOG_CLR_FLG_LEAVE */
|
---|
| 80 |
|
---|
| 81 | #ifndef LOG_POL_FLG_ENTER
|
---|
| 82 | #define LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn)
|
---|
| 83 | #endif /* LOG_POL_FLG_ENTER */
|
---|
| 84 |
|
---|
| 85 | #ifndef LOG_POL_FLG_LEAVE
|
---|
| 86 | #define LOG_POL_FLG_LEAVE(ercd, flgptn)
|
---|
| 87 | #endif /* LOG_POL_FLG_LEAVE */
|
---|
| 88 |
|
---|
| 89 |
|
---|
| 90 |
|
---|
| 91 | /* CxgtOIDID©çÌzñItZbgÖÌÏ·}N */
|
---|
| 92 | #define INDEX_FLG(flgid) ((uint_t)((flgid) - TMIN_FLGID))
|
---|
| 93 |
|
---|
| 94 | #ifdef TOPPERS_iniflg
|
---|
| 95 |
|
---|
| 96 | void initialize_eventflag(void)
|
---|
| 97 | {
|
---|
| 98 | int_t i;
|
---|
| 99 |
|
---|
| 100 | for(i = 0 ; i < tmax_flgid ; i++)
|
---|
| 101 | {
|
---|
| 102 | /* rbgp^[Ìú» */
|
---|
| 103 | flgcb_flgptn[i] = flginib_iflgptn[i];
|
---|
| 104 | }
|
---|
| 105 | }
|
---|
| 106 |
|
---|
| 107 | #endif /* TOPPERS_iniflg */
|
---|
| 108 |
|
---|
| 109 | /*
|
---|
| 110 | * CxgtO𪬧µÄ¢é©Ì`FbN
|
---|
| 111 | */
|
---|
| 112 | Inline bool_t
|
---|
| 113 | check_flg_cond(FLGPTN curptn , FLGPTN waiptn, MODE wfmode)
|
---|
| 114 | {
|
---|
| 115 | bool_t flgset = false;
|
---|
| 116 |
|
---|
| 117 | if ((wfmode & TWF_ORW) != 0U)
|
---|
| 118 | {
|
---|
| 119 | if((curptn & waiptn) != 0U)
|
---|
| 120 | {
|
---|
| 121 | flgset = true;
|
---|
| 122 | }
|
---|
| 123 | }
|
---|
| 124 | else /* (wfmode & TWF_ANDW) != 0U */
|
---|
| 125 | {
|
---|
| 126 | if((curptn & waiptn) == waiptn)
|
---|
| 127 | {
|
---|
| 128 | flgset = true;
|
---|
| 129 | }
|
---|
| 130 | }
|
---|
| 131 |
|
---|
| 132 | return (flgset);
|
---|
| 133 | }
|
---|
| 134 |
|
---|
| 135 | /*
|
---|
| 136 | * CxgtOÌZbg
|
---|
| 137 | */
|
---|
| 138 | #ifdef TOPPERS_set_flg
|
---|
| 139 |
|
---|
| 140 | ER
|
---|
| 141 | set_flg(ID flgid, FLGPTN setptn)
|
---|
| 142 | {
|
---|
| 143 | ER ercd;
|
---|
| 144 |
|
---|
| 145 | LOG_SET_FLG_ENTER(flgid, setptn);
|
---|
| 146 | CHECK_TSKCTX_UNL();
|
---|
| 147 | CHECK_FLGID(flgid);
|
---|
| 148 |
|
---|
| 149 | t_lock_cpu();
|
---|
| 150 | flgcb_flgptn[INDEX_FLG(flgid)] |= setptn;
|
---|
| 151 | ercd = E_OK;
|
---|
| 152 | t_unlock_cpu();
|
---|
| 153 |
|
---|
| 154 | error_exit:
|
---|
| 155 | LOG_SET_FLG_LEAVE(ercd);
|
---|
| 156 | return(ercd);
|
---|
| 157 | }
|
---|
| 158 |
|
---|
| 159 |
|
---|
| 160 | #endif /* TOPPERS_set_flg */
|
---|
| 161 |
|
---|
| 162 | /*
|
---|
| 163 | * CxgtOÌZbgiñ^XNReLXgpj
|
---|
| 164 | */
|
---|
| 165 | #ifdef TOPPERS_iset_flg
|
---|
| 166 |
|
---|
| 167 | ER
|
---|
| 168 | iset_flg(ID flgid, FLGPTN setptn)
|
---|
| 169 | {
|
---|
| 170 | ER ercd;
|
---|
| 171 |
|
---|
| 172 | LOG_ISET_FLG_ENTER(flgid, setptn);
|
---|
| 173 | CHECK_INTCTX_UNL();
|
---|
| 174 | CHECK_FLGID(flgid);
|
---|
| 175 |
|
---|
| 176 | i_lock_cpu();
|
---|
| 177 | flgcb_flgptn[INDEX_FLG(flgid)] |= setptn;
|
---|
| 178 | ercd = E_OK;
|
---|
| 179 | i_unlock_cpu();
|
---|
| 180 |
|
---|
| 181 | error_exit:
|
---|
| 182 | LOG_ISET_FLG_LEAVE(ercd);
|
---|
| 183 | return(ercd);
|
---|
| 184 | }
|
---|
| 185 |
|
---|
| 186 | #endif /* TOPPERS_iset_flg */
|
---|
| 187 |
|
---|
| 188 | /*
|
---|
| 189 | * CxgtOÌNA
|
---|
| 190 | */
|
---|
| 191 | #ifdef TOPPERS_clr_flg
|
---|
| 192 |
|
---|
| 193 | ER
|
---|
| 194 | clr_flg(ID flgid, FLGPTN clrptn)
|
---|
| 195 | {
|
---|
| 196 | ER ercd;
|
---|
| 197 |
|
---|
| 198 | LOG_CLR_FLG_ENTER(flgid, clrptn);
|
---|
| 199 | CHECK_TSKCTX_UNL();
|
---|
| 200 | CHECK_FLGID(flgid);
|
---|
| 201 |
|
---|
| 202 | t_lock_cpu();
|
---|
| 203 | flgcb_flgptn[INDEX_FLG(flgid)] &= clrptn;
|
---|
| 204 | ercd = E_OK;
|
---|
| 205 | t_unlock_cpu();
|
---|
| 206 |
|
---|
| 207 | error_exit:
|
---|
| 208 | LOG_CLR_FLG_LEAVE(ercd);
|
---|
| 209 | return(ercd);
|
---|
| 210 | }
|
---|
| 211 |
|
---|
| 212 | #endif /* TOPPERS_clr_flg */
|
---|
| 213 |
|
---|
| 214 |
|
---|
| 215 | /*
|
---|
| 216 | * CxgtOÒ¿i|[Oj
|
---|
| 217 | */
|
---|
| 218 | #ifdef TOPPERS_pol_flg
|
---|
| 219 |
|
---|
| 220 | ER
|
---|
| 221 | pol_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
|
---|
| 222 | {
|
---|
| 223 | ER ercd;
|
---|
| 224 | int_t index;
|
---|
| 225 |
|
---|
| 226 | LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
|
---|
| 227 | CHECK_TSKCTX_UNL();
|
---|
| 228 | CHECK_FLGID(flgid);
|
---|
| 229 | CHECK_PAR(waiptn != 0U);
|
---|
| 230 | CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
|
---|
| 231 |
|
---|
| 232 | t_lock_cpu();
|
---|
| 233 |
|
---|
| 234 | index = INDEX_FLG(flgid);
|
---|
| 235 |
|
---|
| 236 | if (check_flg_cond(flgcb_flgptn[index], waiptn, wfmode)) {
|
---|
| 237 | ercd = E_OK;
|
---|
| 238 | *p_flgptn = flgcb_flgptn[index];
|
---|
| 239 |
|
---|
| 240 | if((flginib_atr[index] & TA_CLR) != 0U)
|
---|
| 241 | {
|
---|
| 242 | flgcb_flgptn[index] = 0U;
|
---|
| 243 | }
|
---|
| 244 | }
|
---|
| 245 | else {
|
---|
| 246 | ercd = E_TMOUT;
|
---|
| 247 | }
|
---|
| 248 | t_unlock_cpu();
|
---|
| 249 |
|
---|
| 250 | error_exit:
|
---|
| 251 | LOG_POL_FLG_LEAVE(ercd, *p_flgptn);
|
---|
| 252 | return(ercd);
|
---|
| 253 | }
|
---|
| 254 |
|
---|
| 255 | #endif /* TOPPERS_pol_flg */
|
---|
| 256 |
|
---|
| 257 |
|
---|