[172] | 1 | /*
|
---|
| 2 | * TOPPERS ATK2
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems
|
---|
| 4 | * Automotive Kernel Version 2
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 8 | * Copyright (C) 2004-2015 by Center for Embedded Computing Systems
|
---|
| 9 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 10 | * Copyright (C) 2011-2015 by FUJI SOFT INCORPORATED, JAPAN
|
---|
| 11 | * Copyright (C) 2011-2013 by Spansion LLC, USA
|
---|
| 12 | * Copyright (C) 2011-2015 by NEC Communication Systems, Ltd., JAPAN
|
---|
| 13 | * Copyright (C) 2011-2015 by Panasonic Advanced Technology Development Co., Ltd., JAPAN
|
---|
| 14 | * Copyright (C) 2011-2014 by Renesas Electronics Corporation, JAPAN
|
---|
| 15 | * Copyright (C) 2011-2015 by Sunny Giken Inc., JAPAN
|
---|
| 16 | * Copyright (C) 2011-2015 by TOSHIBA CORPORATION, JAPAN
|
---|
| 17 | * Copyright (C) 2004-2015 by Witz Corporation
|
---|
| 18 | * Copyright (C) 2014-2015 by AISIN COMCRUISE Co., Ltd., JAPAN
|
---|
| 19 | * Copyright (C) 2014-2015 by eSOL Co.,Ltd., JAPAN
|
---|
| 20 | * Copyright (C) 2014-2015 by SCSK Corporation, JAPAN
|
---|
| 21 | * Copyright (C) 2015 by SUZUKI MOTOR CORPORATION
|
---|
| 22 | *
|
---|
| 23 | * ä¸è¨èä½æ¨©è
|
---|
| 24 | ã¯ï¼ä»¥ä¸ã®(1)ã(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
|
---|
| 25 | * ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹
|
---|
| 26 | * å¤ã»åé
|
---|
| 27 | å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 28 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
| 29 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
| 30 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 31 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 32 | * ç¨ã§ããå½¢ã§åé
|
---|
| 33 | å¸ããå ´åã«ã¯ï¼åé
|
---|
| 34 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
| 35 | * è
|
---|
| 36 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
| 37 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 38 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 39 | * ç¨ã§ããªãå½¢ã§åé
|
---|
| 40 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
| 41 | * ã¨ï¼
|
---|
| 42 | * (a) åé
|
---|
| 43 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 44 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
| 45 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 46 | * (b) åé
|
---|
| 47 | å¸ã®å½¢æ
|
---|
| 48 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
| 49 | * å ±åãããã¨ï¼
|
---|
| 50 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
| 51 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 52 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 53 | 責ãããã¨ï¼
|
---|
| 54 | * ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãç
|
---|
| 55 | * ç±ã«åºã¥ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 56 | ããã³TOPPERSããã¸ã§ã¯ãã
|
---|
| 57 | * å
|
---|
| 58 | 責ãããã¨ï¼
|
---|
| 59 | *
|
---|
| 60 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼AUTOSARï¼AUTomotive Open System ARchitectureï¼ä»
|
---|
| 61 | * æ§ã«åºã¥ãã¦ããï¼ä¸è¨ã®è¨±è«¾ã¯ï¼AUTOSARã®ç¥ç財ç£æ¨©ã許諾ãããã®ã§
|
---|
| 62 | * ã¯ãªãï¼AUTOSARã¯ï¼AUTOSARä»æ§ã«åºã¥ããã½ããã¦ã§ã¢ãåç¨ç®çã§å©
|
---|
| 63 | * ç¨ããè
|
---|
| 64 | ã«å¯¾ãã¦ï¼AUTOSARãã¼ããã¼ã«ãªããã¨ãæ±ãã¦ããï¼
|
---|
| 65 | *
|
---|
| 66 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 67 | ã
|
---|
| 68 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç
|
---|
| 69 | * ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§
|
---|
| 70 | * ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ã
|
---|
| 71 | * ã®è²¬ä»»ãè² ããªãï¼
|
---|
| 72 | *
|
---|
| 73 | * $Id: counter_manage.c 425 2015-12-07 08:06:19Z witz-itoyo $
|
---|
| 74 | */
|
---|
| 75 |
|
---|
| 76 | /*
|
---|
| 77 | * ã«ã¦ã³ã¿ç®¡çã¢ã¸ã¥ã¼ã«
|
---|
| 78 | */
|
---|
| 79 |
|
---|
| 80 | #include "kernel_impl.h"
|
---|
| 81 | #include "check.h"
|
---|
| 82 | #include "counter.h"
|
---|
| 83 |
|
---|
| 84 | /*
|
---|
| 85 | * ãã¬ã¼ã¹ãã°ãã¯ãã®ããã©ã«ãå®ç¾©
|
---|
| 86 | */
|
---|
| 87 | #ifndef LOG_INCCNT_ENTER
|
---|
| 88 | #define LOG_INCCNT_ENTER(cntid)
|
---|
| 89 | #endif /* LOG_INCCNT_ENTER */
|
---|
| 90 |
|
---|
| 91 | #ifndef LOG_INCCNT_LEAVE
|
---|
| 92 | #define LOG_INCCNT_LEAVE(ercd)
|
---|
| 93 | #endif /* LOG_INCCNT_LEAVE */
|
---|
| 94 |
|
---|
| 95 | #ifndef LOG_GETCNT_ENTER
|
---|
| 96 | #define LOG_GETCNT_ENTER(cntid)
|
---|
| 97 | #endif /* LOG_GETCNT_ENTER */
|
---|
| 98 |
|
---|
| 99 | #ifndef LOG_GETCNT_LEAVE
|
---|
| 100 | #define LOG_GETCNT_LEAVE(ercd, p_val)
|
---|
| 101 | #endif /* LOG_GETCNT_LEAVE */
|
---|
| 102 |
|
---|
| 103 | #ifndef LOG_GETEPS_ENTER
|
---|
| 104 | #define LOG_GETEPS_ENTER(cntid, p_val)
|
---|
| 105 | #endif /* LOG_GETEPS_ENTER */
|
---|
| 106 |
|
---|
| 107 | #ifndef LOG_GETEPS_LEAVE
|
---|
| 108 | #define LOG_GETEPS_LEAVE(ercd, p_val, p_eval)
|
---|
| 109 | #endif /* LOG_GETEPS_LEAVE */
|
---|
| 110 |
|
---|
| 111 | /*
|
---|
| 112 | * ã«ã¦ã³ã¿ã®ã¤ã³ã¯ãªã¡ã³ã
|
---|
| 113 | */
|
---|
| 114 | #ifdef TOPPERS_IncrementCounter
|
---|
| 115 |
|
---|
| 116 | StatusType
|
---|
| 117 | IncrementCounter(CounterType CounterID)
|
---|
| 118 | {
|
---|
| 119 | StatusType ercd = E_OK;
|
---|
| 120 | CNTCB *p_cntcb;
|
---|
| 121 | OSAPCB *p_osapcb;
|
---|
| 122 |
|
---|
| 123 | CHECK_DISABLEDINT();
|
---|
| 124 | CHECK_CALLEVEL(CALLEVEL_INCREMENTCOUNTER);
|
---|
| 125 | CHECK_ID(CounterID < tnum_counter);
|
---|
| 126 | CHECK_ID(CounterID >= tnum_hardcounter);
|
---|
| 127 |
|
---|
| 128 | p_cntcb = get_cntcb(CounterID);
|
---|
| 129 | CHECK_RIGHT(p_cntcb->p_cntinib->acsbtmp);
|
---|
| 130 |
|
---|
| 131 | p_osapcb = p_cntcb->p_cntinib->p_osapcb;
|
---|
| 132 | x_nested_lock_os_int();
|
---|
| 133 |
|
---|
| 134 | /* ã«ã¦ã³ã¿æå±ã®OSAPã®ç¶æ
|
---|
| 135 | ããã§ã㯠*/
|
---|
| 136 | D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) ||
|
---|
| 137 | (p_osapcb == p_runosap));
|
---|
| 138 |
|
---|
| 139 | /*
|
---|
| 140 | * ã«ã¦ã³ã¿ã®ã¤ã³ã¯ãªã¡ã³ã
|
---|
| 141 | * ã¨ã©ã¼ã®å ´åã¯incr_counter_processã§ã¨ã©ã¼ããã¯å¼ã³åºãã¦ããã®ã§ï¼
|
---|
| 142 | * ããã§ã¯ï¼ã¨ã©ã¼ããã¯ãå¼ã³åºããªã
|
---|
| 143 | */
|
---|
| 144 | ercd = incr_counter_process(p_cntcb, CounterID);
|
---|
| 145 |
|
---|
| 146 | d_exit_no_errorhook:
|
---|
| 147 | x_nested_unlock_os_int();
|
---|
| 148 | exit_no_errorhook:
|
---|
| 149 | return(ercd);
|
---|
| 150 |
|
---|
| 151 | #ifdef CFG_USE_ERRORHOOK
|
---|
| 152 | exit_errorhook:
|
---|
| 153 | x_nested_lock_os_int();
|
---|
| 154 | d_exit_errorhook:
|
---|
| 155 | #ifdef CFG_USE_PARAMETERACCESS
|
---|
| 156 | _errorhook_par1.cntid = CounterID;
|
---|
| 157 | #endif /* CFG_USE_PARAMETERACCESS */
|
---|
| 158 | call_errorhook(ercd, OSServiceId_IncrementCounter);
|
---|
| 159 | goto d_exit_no_errorhook;
|
---|
| 160 | #endif /* CFG_USE_ERRORHOOK */
|
---|
| 161 | }
|
---|
| 162 |
|
---|
| 163 | #endif /* TOPPERS_IncrementCounter */
|
---|
| 164 |
|
---|
| 165 | /*
|
---|
| 166 | * ã«ã¦ã³ã¿å¤ã®åç
|
---|
| 167 | §
|
---|
| 168 | */
|
---|
| 169 | #ifdef TOPPERS_GetCounterValue
|
---|
| 170 |
|
---|
| 171 | StatusType
|
---|
| 172 | GetCounterValue(CounterType CounterID, TickRefType Value)
|
---|
| 173 | {
|
---|
| 174 | StatusType ercd = E_OK;
|
---|
| 175 | CNTCB *p_cntcb;
|
---|
| 176 | TickType curval;
|
---|
| 177 | OSAPCB *p_osapcb;
|
---|
| 178 |
|
---|
| 179 | LOG_GETCNT_ENTER(CounterID);
|
---|
| 180 | CHECK_DISABLEDINT();
|
---|
| 181 | CHECK_CALLEVEL(CALLEVEL_GETCOUNTERVALUE);
|
---|
| 182 | CHECK_ID(CounterID < tnum_counter);
|
---|
| 183 | CHECK_PARAM_POINTER(Value);
|
---|
| 184 | CHECK_MEM_WRITE(Value, TickType);
|
---|
| 185 | p_cntcb = get_cntcb(CounterID);
|
---|
| 186 | CHECK_RIGHT(p_cntcb->p_cntinib->acsbtmp);
|
---|
| 187 |
|
---|
| 188 | /*
|
---|
| 189 | * å
|
---|
| 190 | é¨å¦çã®ããï¼ã³ã³ãã£ã®ã¥ã¬ã¼ã·ã§ã³è¨å®å¤ã®ï¼åï¼ï¼ã¾ã§ã«ã¦ã³ã
|
---|
| 191 | * ã¢ããããã®ã§ã«ã¦ã³ã¿å¤ãè¨å®å¤ããã大ããå ´åã¯è¨å®å¤ãæ¸ç®ãã
|
---|
| 192 | *
|
---|
| 193 | * *Value ãç´æ¥æä½ãã¦ãããã,å±æå¤æ°ãã¬ã¸ã¹ã¿ã«å²å½ã¦ããããã¨
|
---|
| 194 | * ã«ããé度ãæå¾
|
---|
| 195 | ãã¦ãã
|
---|
| 196 | */
|
---|
| 197 | p_osapcb = p_cntcb->p_cntinib->p_osapcb;
|
---|
| 198 | x_nested_lock_os_int();
|
---|
| 199 |
|
---|
| 200 | /* ã«ã¦ã³ã¿æå±ã®OSAPã®ç¶æ
|
---|
| 201 | ããã§ã㯠*/
|
---|
| 202 | D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) ||
|
---|
| 203 | (p_osapcb == p_runosap));
|
---|
| 204 |
|
---|
| 205 | curval = get_curval(p_cntcb, CounterID);
|
---|
| 206 | x_nested_unlock_os_int();
|
---|
| 207 |
|
---|
| 208 | if (curval > p_cntcb->p_cntinib->maxval) {
|
---|
| 209 | curval -= (p_cntcb->p_cntinib->maxval + 1U);
|
---|
| 210 | }
|
---|
| 211 | *Value = curval;
|
---|
| 212 |
|
---|
| 213 | exit_no_errorhook:
|
---|
| 214 | LOG_GETCNT_LEAVE(ercd, Value);
|
---|
| 215 | return(ercd);
|
---|
| 216 |
|
---|
| 217 | #ifdef CFG_USE_ERRORHOOK
|
---|
| 218 | exit_errorhook:
|
---|
| 219 | x_nested_lock_os_int();
|
---|
| 220 | d_exit_errorhook:
|
---|
| 221 | #ifdef CFG_USE_PARAMETERACCESS
|
---|
| 222 | _errorhook_par1.cntid = CounterID;
|
---|
| 223 | _errorhook_par2.p_val = Value;
|
---|
| 224 | #endif /* CFG_USE_PARAMETERACCESS */
|
---|
| 225 | call_errorhook(ercd, OSServiceId_GetCounterValue);
|
---|
| 226 | #endif /* CFG_USE_ERRORHOOK */
|
---|
| 227 | d_exit_no_errorhook:
|
---|
| 228 | x_nested_unlock_os_int();
|
---|
| 229 | goto exit_no_errorhook;
|
---|
| 230 | }
|
---|
| 231 |
|
---|
| 232 | #endif /* TOPPERS_GetCounterValue */
|
---|
| 233 |
|
---|
| 234 | /*
|
---|
| 235 | * çµéã«ã¦ã³ã¿å¤ã®åç
|
---|
| 236 | §
|
---|
| 237 | */
|
---|
| 238 | #ifdef TOPPERS_GetElapsedValue
|
---|
| 239 |
|
---|
| 240 | StatusType
|
---|
| 241 | GetElapsedValue(CounterType CounterID, TickRefType Value, TickRefType ElapsedValue)
|
---|
| 242 | {
|
---|
| 243 | StatusType ercd = E_OK;
|
---|
| 244 | CNTCB *p_cntcb;
|
---|
| 245 | TickType curval;
|
---|
| 246 | OSAPCB *p_osapcb;
|
---|
| 247 |
|
---|
| 248 | LOG_GETEPS_ENTER(CounterID, Value);
|
---|
| 249 | CHECK_DISABLEDINT();
|
---|
| 250 | CHECK_CALLEVEL(CALLEVEL_GETELAPSEDVALUE);
|
---|
| 251 | CHECK_ID(CounterID < tnum_counter);
|
---|
| 252 | CHECK_PARAM_POINTER(Value);
|
---|
| 253 | CHECK_PARAM_POINTER(ElapsedValue);
|
---|
| 254 | CHECK_MEM_RW(Value, TickType);
|
---|
| 255 | CHECK_MEM_WRITE(ElapsedValue, TickType);
|
---|
| 256 | p_cntcb = get_cntcb(CounterID);
|
---|
| 257 | CHECK_RIGHT(p_cntcb->p_cntinib->acsbtmp);
|
---|
| 258 |
|
---|
| 259 | CHECK_VALUE(*Value <= p_cntcb->p_cntinib->maxval);
|
---|
| 260 |
|
---|
| 261 | /*
|
---|
| 262 | * å
|
---|
| 263 | é¨å¦çã®ããï¼ã³ã³ãã£ã®ã¥ã¬ã¼ã·ã§ã³è¨å®å¤ã®ï¼åï¼ï¼ã¾ã§ã«ã¦ã³ã
|
---|
| 264 | * ã¢ããããã®ã§ã«ã¦ã³ã¿å¤ãè¨å®å¤ããã大ããå ´åã¯è¨å®å¤ãæ¸ç®ãã
|
---|
| 265 | */
|
---|
| 266 | p_osapcb = p_cntcb->p_cntinib->p_osapcb;
|
---|
| 267 | x_nested_lock_os_int();
|
---|
| 268 |
|
---|
| 269 | /* ã«ã¦ã³ã¿æå±ã®OSAPã®ç¶æ
|
---|
| 270 | ããã§ã㯠*/
|
---|
| 271 | D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) ||
|
---|
| 272 | (p_osapcb == p_runosap));
|
---|
| 273 |
|
---|
| 274 | curval = get_curval(p_cntcb, CounterID);
|
---|
| 275 | x_nested_unlock_os_int();
|
---|
| 276 |
|
---|
| 277 | if (curval > p_cntcb->p_cntinib->maxval) {
|
---|
| 278 | curval -= (p_cntcb->p_cntinib->maxval + 1U);
|
---|
| 279 | }
|
---|
| 280 | *ElapsedValue = diff_tick(curval, *Value, p_cntcb->p_cntinib->maxval);
|
---|
| 281 | *Value = curval;
|
---|
| 282 |
|
---|
| 283 | exit_no_errorhook:
|
---|
| 284 | LOG_GETEPS_LEAVE(ercd, Value, ElapsedValue);
|
---|
| 285 | return(ercd);
|
---|
| 286 |
|
---|
| 287 | #ifdef CFG_USE_ERRORHOOK
|
---|
| 288 | exit_errorhook:
|
---|
| 289 | x_nested_lock_os_int();
|
---|
| 290 | d_exit_errorhook:
|
---|
| 291 | #ifdef CFG_USE_PARAMETERACCESS
|
---|
| 292 | _errorhook_par1.cntid = CounterID;
|
---|
| 293 | _errorhook_par2.p_val = Value;
|
---|
| 294 | _errorhook_par3.p_eval = ElapsedValue;
|
---|
| 295 | #endif /* CFG_USE_PARAMETERACCESS */
|
---|
| 296 | call_errorhook(ercd, OSServiceId_GetElapsedValue);
|
---|
| 297 | #endif /* CFG_USE_ERRORHOOK */
|
---|
| 298 | d_exit_no_errorhook:
|
---|
| 299 | x_nested_unlock_os_int();
|
---|
| 300 | goto exit_no_errorhook;
|
---|
| 301 | }
|
---|
| 302 |
|
---|
| 303 | #endif /* TOPPERS_GetElapsedValue */
|
---|
| 304 |
|
---|
| 305 | /*
|
---|
| 306 | * ãã¼ãã¦ã§ã¢ã«ã¦ã³ã¿æºäºå¦ç
|
---|
| 307 | *
|
---|
| 308 | * å²è¾¼ã¿ã«ã¼ãã³ããå®è¡ããã
|
---|
| 309 | */
|
---|
| 310 | #ifdef TOPPERS_notify_hardware_counter
|
---|
| 311 |
|
---|
| 312 | void
|
---|
| 313 | notify_hardware_counter(CounterType cntid)
|
---|
| 314 | {
|
---|
| 315 | CNTCB *p_cntcb;
|
---|
| 316 |
|
---|
| 317 | p_cntcb = get_cntcb(cntid);
|
---|
| 318 |
|
---|
| 319 | /* ã«ã¦ã³ã¿æºäºå¦çä¸ã¯OSå²è¾¼ã¿ãç¦æ¢ */
|
---|
| 320 | x_nested_lock_os_int();
|
---|
| 321 |
|
---|
| 322 | /*
|
---|
| 323 | * ãã¼ãã¦ã§ã¢ã«ã¦ã³ã¿ã«å¯¾å¿ããC2ISRãèµ·åããéã«ï¼
|
---|
| 324 | * å²è¾¼ã¿è¦æ±ã®ã¯ãªã¢å¦çãå®è¡ãã
|
---|
| 325 | */
|
---|
| 326 | (hwcntinib_table[cntid].intclear)();
|
---|
| 327 |
|
---|
| 328 | expire_process(p_cntcb, cntid);
|
---|
| 329 |
|
---|
| 330 | x_nested_unlock_os_int();
|
---|
| 331 | }
|
---|
| 332 |
|
---|
| 333 | #endif /* TOPPERS_notify_hardware_counter */
|
---|
| 334 |
|
---|
| 335 | /*
|
---|
| 336 | * ã«ã¦ã³ã¿ã®ã¤ã³ã¯ãªã¡ã³ã
|
---|
| 337 | *
|
---|
| 338 | * æ¡ä»¶ï¼å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 339 | ã§å¼ã°ãã
|
---|
| 340 | */
|
---|
| 341 | #ifdef TOPPERS_incr_counter_process
|
---|
| 342 |
|
---|
| 343 | StatusType
|
---|
| 344 | incr_counter_process(CNTCB *p_cntcb, CounterType CounterID)
|
---|
| 345 | {
|
---|
| 346 | StatusType ercd = E_OK;
|
---|
| 347 | TickType newval;
|
---|
| 348 |
|
---|
| 349 | LOG_INCCNT_ENTER(CounterID);
|
---|
| 350 |
|
---|
| 351 | /*
|
---|
| 352 | * ã«ã¦ã³ã¿ãæä½ä¸(IncrementCounterã®ãã¹ãï¼ã®å ´åã¨ã©ã¼
|
---|
| 353 | * â»ç¬èªä»æ§
|
---|
| 354 | */
|
---|
| 355 | D_CHECK_STATE(p_cntcb->cstat == CS_NULL);
|
---|
| 356 |
|
---|
| 357 | p_cntcb->cstat = CS_DOING;
|
---|
| 358 |
|
---|
| 359 | newval = add_tick(p_cntcb->curval, 1U, p_cntcb->p_cntinib->maxval2);
|
---|
| 360 |
|
---|
| 361 | p_cntcb->curval = newval;
|
---|
| 362 |
|
---|
| 363 | if (p_runisr == NULL) {
|
---|
| 364 | p_cntcb->p_prevcntcb = p_runtsk->p_lastcntcb;
|
---|
| 365 | p_runtsk->p_lastcntcb = p_cntcb;
|
---|
| 366 | }
|
---|
| 367 | else {
|
---|
| 368 | p_cntcb->p_prevcntcb = p_runisr->p_lastcntcb;
|
---|
| 369 | p_runisr->p_lastcntcb = p_cntcb->p_prevcntcb;
|
---|
| 370 | }
|
---|
| 371 |
|
---|
| 372 | expire_process(p_cntcb, CounterID);
|
---|
| 373 |
|
---|
| 374 | if (p_runisr == NULL) {
|
---|
| 375 | p_runtsk->p_lastcntcb = p_cntcb->p_prevcntcb;
|
---|
| 376 | }
|
---|
| 377 | else {
|
---|
| 378 | p_runisr->p_lastcntcb = p_cntcb->p_prevcntcb;
|
---|
| 379 | }
|
---|
| 380 |
|
---|
| 381 | p_cntcb->cstat = CS_NULL;
|
---|
| 382 |
|
---|
| 383 | d_exit_no_errorhook:
|
---|
| 384 | LOG_INCCNT_LEAVE(ercd);
|
---|
| 385 | return(ercd);
|
---|
| 386 |
|
---|
| 387 | #ifdef CFG_USE_ERRORHOOK
|
---|
| 388 | d_exit_errorhook:
|
---|
| 389 | #ifdef CFG_USE_PARAMETERACCESS
|
---|
| 390 | _errorhook_par1.cntid = CounterID;
|
---|
| 391 | #endif /* CFG_USE_PARAMETERACCESS */
|
---|
| 392 | call_errorhook(ercd, OSServiceId_IncrementCounter);
|
---|
| 393 | goto d_exit_no_errorhook;
|
---|
| 394 | #endif /* CFG_USE_ERRORHOOK */
|
---|
| 395 | }
|
---|
| 396 |
|
---|
| 397 | #endif /* TOPPERS_incr_counter_process */
|
---|
| 398 |
|
---|
| 399 | /*
|
---|
| 400 | * ã¢ã©ã¼ã æºäºã«ããã«ã¦ã³ã¿ã®ã¤ã³ã¯ãªã¡ã³ã
|
---|
| 401 | *
|
---|
| 402 | * æ¡ä»¶ï¼å²è¾¼ã¿ç¦æ¢ç¶æ
|
---|
| 403 | ã§å¼ã°ãã
|
---|
| 404 | */
|
---|
| 405 | #ifdef TOPPERS_incr_counter_action
|
---|
| 406 |
|
---|
| 407 | StatusType
|
---|
| 408 | incr_counter_action(OSAPCB *p_expire_osapcb, CounterType CounterID)
|
---|
| 409 | {
|
---|
| 410 | StatusType ercd = E_OK;
|
---|
| 411 | CNTCB *p_cntcb;
|
---|
| 412 | OSAPCB *p_osapcb;
|
---|
| 413 |
|
---|
| 414 | p_cntcb = get_cntcb(CounterID);
|
---|
| 415 | p_osapcb = p_cntcb->p_cntinib->p_osapcb;
|
---|
| 416 | /* æºäºç¹æå±ã®OSAPåã³ã¤ã³ã¯ãªã¡ã³ãã«ã¦ã³ã¿æå±ã®OSAPã®ç¶æ
|
---|
| 417 | ããã§ã㯠*/
|
---|
| 418 | D_CHECK_ACCESS((p_osapcb->osap_stat == APPLICATION_ACCESSIBLE) || (p_expire_osapcb == p_osapcb));
|
---|
| 419 |
|
---|
| 420 | ercd = incr_counter_process(p_cntcb, CounterID);
|
---|
| 421 |
|
---|
| 422 | d_exit_no_errorhook:
|
---|
| 423 | return(ercd);
|
---|
| 424 |
|
---|
| 425 | #ifdef CFG_USE_ERRORHOOK
|
---|
| 426 | d_exit_errorhook:
|
---|
| 427 | #ifdef CFG_USE_PARAMETERACCESS
|
---|
| 428 | _errorhook_par1.cntid = CounterID;
|
---|
| 429 | #endif /* CFG_USE_PARAMETERACCESS */
|
---|
| 430 | call_errorhook(ercd, OSServiceId_IncrementCounter);
|
---|
| 431 | goto d_exit_no_errorhook;
|
---|
| 432 | #endif /* CFG_USE_ERRORHOOK */
|
---|
| 433 | }
|
---|
| 434 |
|
---|
| 435 | #endif /* TOPPERS_incr_counter_action */
|
---|