| 1 | /* |
|---|
| 2 | * TOPPERS Software |
|---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems |
|---|
| 4 | * |
|---|
| 5 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory |
|---|
| 6 | * Toyohashi Univ. of Technology, JAPAN |
|---|
| 7 | * Copyright (C) 2005-2011 by Embedded and Real-Time Systems Laboratory |
|---|
| 8 | * Graduate School of Information Science, Nagoya Univ., JAPAN |
|---|
| 9 | * |
|---|
| 10 | * ŸåµÃøºîž¢ŒÔ€Ï¡€°Ê²Œ€Î(1)¡Á(4)€ÎŸò·ï€òËþ€¿€¹Ÿì¹ç€ËžÂ€ê¡€ËÜ¥œ¥Õ¥È¥Š¥§ |
|---|
| 11 | * ¥¢¡ÊËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò²þÊÑ€·€¿€â€Î€òŽÞ€à¡¥°Ê²ŒÆ±€ž¡Ë€ò»ÈÍÑ¡ŠÊ£Àœ¡Š²þ |
|---|
| 12 | * ÊÑ¡ŠºÆÇÛÉۡʰʲŒ¡€ÍøÍрȞƀ֡ˀ¹€ë€³€È€ò̵œþ€ÇµöÂú€¹€ë¡¥ |
|---|
| 13 | * (1) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¥œ¡Œ¥¹¥³¡Œ¥É€Î·Á€ÇÍøÍÑ€¹€ëŸì¹ç€Ë€Ï¡€Ÿåµ€ÎÃøºî |
|---|
| 14 | * ž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ€Î̵ÊÝŸÚµ¬Äꀬ¡€€œ€Î€Þ€Þ€Î·Á€Ç¥œ¡Œ |
|---|
| 15 | * ¥¹¥³¡Œ¥ÉÃæ€ËŽÞ€Þ€ì€Æ€€€ë€³€È¡¥ |
|---|
| 16 | * (2) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€¥é¥€¥Ö¥é¥ê·ÁŒ°€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È |
|---|
| 17 | * Íрǀ€ë·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€ºÆÇÛÉÛ€ËÈŒ€Š¥É¥¥å¥á¥ó¥È¡ÊÍøÍÑ |
|---|
| 18 | * ŒÔ¥Þ¥Ë¥å¥¢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ€ÎÃøºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ |
|---|
| 19 | * €Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥ |
|---|
| 20 | * (3) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€µ¡Žï€ËÁȀ߹þ€à€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È |
|---|
| 21 | * Íрǀ€Ê€€·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€Œ¡€Î€€€º€ì€«€ÎŸò·ï€òËþ€¿€¹€³ |
|---|
| 22 | * €È¡¥ |
|---|
| 23 | * (a) ºÆÇÛÉÛ€ËÈŒ€Š¥É¥¥å¥á¥ó¥È¡ÊÍøÍьԥޥ˥奢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ€ÎÃø |
|---|
| 24 | * ºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ€Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥ |
|---|
| 25 | * (b) ºÆÇÛÉۀηÁÂÖ€ò¡€ÊÌ€ËÄê€á€ëÊýË¡€Ë€è€Ã€Æ¡€TOPPERS¥×¥í¥ž¥§¥¯¥È€Ë |
|---|
| 26 | * Êó¹ð€¹€ë€³€È¡¥ |
|---|
| 27 | * (4) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€ë€€€«€Ê€ë» |
|---|
| 28 | * ³²€«€é€â¡€ŸåµÃøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€òÌÈÀÕ€¹€ë€³€È¡¥ |
|---|
| 29 | * €Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Î¥æ¡Œ¥¶€Þ€¿€Ï¥š¥ó¥É¥æ¡Œ¥¶€«€é€Î€€€«€Ê€ëÍý |
|---|
| 30 | * ͳ€ËŽð€Å€¯ÀÁµá€«€é€â¡€ŸåµÃøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€ò |
|---|
| 31 | * ÌÈÀÕ€¹€ë€³€È¡¥ |
|---|
| 32 | * |
|---|
| 33 | * ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Ï¡€ÌµÊÝŸÚ€ÇÄó¶¡€µ€ì€Æ€€€ë€â€Î€Ç€¢€ë¡¥ŸåµÃøºîž¢ŒÔ€ª |
|---|
| 34 | * €è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€Ï¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ËŽØ€·€Æ¡€ÆÃÄê€Î»ÈÍÑÌÜŪ |
|---|
| 35 | * €ËÂЀ¹€ëŬ¹çÀ€âŽÞ€á€Æ¡€€€€«€Ê€ëÊÝŸÚ€â¹Ô€ï€Ê€€¡¥€Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§ |
|---|
| 36 | * ¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€¿€€€«€Ê€ë»³²€ËŽØ€·€Æ€â¡€€œ |
|---|
| 37 | * €ÎÀÕÇ€€òÉé€ï€Ê€€¡¥ |
|---|
| 38 | * |
|---|
| 39 | * $Id$ |
|---|
| 40 | */ |
|---|
| 41 | |
|---|
| 42 | /* |
|---|
| 43 | * ¥È¥ì¡Œ¥¹¥í¥°µ¡Çœ |
|---|
| 44 | */ |
|---|
| 45 | |
|---|
| 46 | #include "kernel_impl.h" |
|---|
| 47 | #include "task.h" |
|---|
| 48 | #include "time_event.h" |
|---|
| 49 | #include <sil.h> |
|---|
| 50 | |
|---|
| 51 | /* |
|---|
| 52 | * ¥È¥ì¡Œ¥¹¥í¥°¥Ð¥Ã¥Õ¥¡€È€œ€ì€Ë¥¢¥¯¥»¥¹€¹€ë€¿€á€Î¥Ý¥€¥ó¥¿ |
|---|
| 53 | */ |
|---|
| 54 | SYSLOG trace_buffer[TCNT_TRACE_BUFFER]; /* ¥È¥ì¡Œ¥¹¥í¥°¥Ð¥Ã¥Õ¥¡ */ |
|---|
| 55 | uint_t trace_count; /* ¥È¥ì¡Œ¥¹¥í¥°¥Ð¥Ã¥Õ¥¡Ãæ€Î¥í¥°€Î¿ô */ |
|---|
| 56 | uint_t trace_head; /* ÀèÆ¬€Î¥È¥ì¡Œ¥¹¥í¥°€Î³ÊÇŒ°ÌÃÖ */ |
|---|
| 57 | uint_t trace_tail; /* Œ¡€Î¥È¥ì¡Œ¥¹¥í¥°€Î³ÊÇŒ°ÌÃÖ */ |
|---|
| 58 | MODE trace_mode; /* ¥È¥ì¡Œ¥¹¥â¡Œ¥É */ |
|---|
| 59 | |
|---|
| 60 | /* |
|---|
| 61 | * ¥È¥ì¡Œ¥¹¥í¥°µ¡Çœ€ÎœéŽü²œ |
|---|
| 62 | */ |
|---|
| 63 | void |
|---|
| 64 | trace_initialize(intptr_t exinf) |
|---|
| 65 | { |
|---|
| 66 | MODE mode = ((MODE) exinf); |
|---|
| 67 | |
|---|
| 68 | trace_count = 0U; |
|---|
| 69 | trace_head = 0U; |
|---|
| 70 | trace_tail = 0U; |
|---|
| 71 | trace_mode = mode; |
|---|
| 72 | } |
|---|
| 73 | |
|---|
| 74 | /* |
|---|
| 75 | * ¥È¥ì¡Œ¥¹¥í¥°€Î³«»Ï |
|---|
| 76 | */ |
|---|
| 77 | ER |
|---|
| 78 | trace_sta_log(MODE mode) |
|---|
| 79 | { |
|---|
| 80 | if ((mode & TRACE_CLEAR) != 0U) { |
|---|
| 81 | trace_count = 0U; |
|---|
| 82 | trace_head = 0U; |
|---|
| 83 | trace_tail = 0U; |
|---|
| 84 | } |
|---|
| 85 | trace_mode = mode; |
|---|
| 86 | return(E_OK); |
|---|
| 87 | } |
|---|
| 88 | |
|---|
| 89 | /* |
|---|
| 90 | * ¥È¥ì¡Œ¥¹¥í¥°€Îœñ¹þ€ß |
|---|
| 91 | */ |
|---|
| 92 | ER |
|---|
| 93 | trace_wri_log(TRACE *p_trace) |
|---|
| 94 | { |
|---|
| 95 | SIL_PRE_LOC; |
|---|
| 96 | |
|---|
| 97 | if (trace_mode != TRACE_STOP) { |
|---|
| 98 | SIL_LOC_INT(); |
|---|
| 99 | |
|---|
| 100 | /* |
|---|
| 101 | * ¥È¥ì¡Œ¥¹»þ¹ï€ÎÀßÄê |
|---|
| 102 | * |
|---|
| 103 | * LOG_WRI_LOG_ENTER€«€éžÆ€Ð€ì€¿Ÿì¹ç€Ëp_trace->logtim€òœñ€Ž¹ |
|---|
| 104 | * €š€Æ€·€Þ€Š€Î€Ïµ€»ý€Á€¬°€€€¬¡€wri_log€ÎÊý€ÇŸåœñ€€¹€ë€¿€áÌä |
|---|
| 105 | * Âê€Ï€Ê€€¡¥ |
|---|
| 106 | */ |
|---|
| 107 | p_trace->logtim = TRACE_GET_TIM(); |
|---|
| 108 | |
|---|
| 109 | /* |
|---|
| 110 | * ¥È¥ì¡Œ¥¹¥Ð¥Ã¥Õ¥¡€ËµÏ¿ |
|---|
| 111 | */ |
|---|
| 112 | trace_buffer[trace_tail] = *p_trace; |
|---|
| 113 | trace_tail++; |
|---|
| 114 | if (trace_tail >= TCNT_TRACE_BUFFER) { |
|---|
| 115 | trace_tail = 0U; |
|---|
| 116 | } |
|---|
| 117 | if (trace_count < TCNT_TRACE_BUFFER) { |
|---|
| 118 | trace_count++; |
|---|
| 119 | if (trace_count >= TCNT_TRACE_BUFFER |
|---|
| 120 | && (trace_mode & TRACE_AUTOSTOP) != 0U) { |
|---|
| 121 | trace_mode = TRACE_STOP; |
|---|
| 122 | } |
|---|
| 123 | } |
|---|
| 124 | else { |
|---|
| 125 | trace_head = trace_tail; |
|---|
| 126 | } |
|---|
| 127 | |
|---|
| 128 | SIL_UNL_INT(); |
|---|
| 129 | } |
|---|
| 130 | return(E_OK); |
|---|
| 131 | } |
|---|
| 132 | |
|---|
| 133 | /* |
|---|
| 134 | * ¥È¥ì¡Œ¥¹¥í¥°€ÎÆÉœÐ€· |
|---|
| 135 | */ |
|---|
| 136 | ER |
|---|
| 137 | trace_rea_log(TRACE *p_trace) |
|---|
| 138 | { |
|---|
| 139 | ER_UINT ercd; |
|---|
| 140 | SIL_PRE_LOC; |
|---|
| 141 | |
|---|
| 142 | SIL_LOC_INT(); |
|---|
| 143 | |
|---|
| 144 | /* |
|---|
| 145 | * ¥È¥ì¡Œ¥¹¥í¥°¥Ð¥Ã¥Õ¥¡€«€é€ÎŒèœÐ€· |
|---|
| 146 | */ |
|---|
| 147 | if (trace_count > 0U) { |
|---|
| 148 | *p_trace = trace_buffer[trace_head]; |
|---|
| 149 | trace_count--; |
|---|
| 150 | trace_head++; |
|---|
| 151 | if (trace_head >= TCNT_TRACE_BUFFER) { |
|---|
| 152 | trace_head = 0U; |
|---|
| 153 | } |
|---|
| 154 | ercd = E_OK; |
|---|
| 155 | } |
|---|
| 156 | else { |
|---|
| 157 | ercd = E_OBJ; |
|---|
| 158 | } |
|---|
| 159 | |
|---|
| 160 | SIL_UNL_INT(); |
|---|
| 161 | return(ercd); |
|---|
| 162 | } |
|---|
| 163 | |
|---|
| 164 | /* |
|---|
| 165 | * ¥È¥ì¡Œ¥¹¥í¥°€òœÐÎÏ€¹€ë€¿€á€Î¥é¥€¥Ö¥é¥êŽØ¿ô |
|---|
| 166 | */ |
|---|
| 167 | |
|---|
| 168 | void |
|---|
| 169 | trace_write_0(uint_t type) |
|---|
| 170 | { |
|---|
| 171 | TRACE trace; |
|---|
| 172 | |
|---|
| 173 | trace.logtype = type; |
|---|
| 174 | (void) trace_wri_log(&trace); |
|---|
| 175 | } |
|---|
| 176 | |
|---|
| 177 | void |
|---|
| 178 | trace_write_1(uint_t type, intptr_t arg1) |
|---|
| 179 | { |
|---|
| 180 | TRACE trace; |
|---|
| 181 | |
|---|
| 182 | trace.logtype = type; |
|---|
| 183 | trace.loginfo[0] = arg1; |
|---|
| 184 | (void) trace_wri_log(&trace); |
|---|
| 185 | } |
|---|
| 186 | |
|---|
| 187 | void |
|---|
| 188 | trace_write_2(uint_t type, intptr_t arg1, intptr_t arg2) |
|---|
| 189 | { |
|---|
| 190 | TRACE trace; |
|---|
| 191 | |
|---|
| 192 | trace.logtype = type; |
|---|
| 193 | trace.loginfo[0] = arg1; |
|---|
| 194 | trace.loginfo[1] = arg2; |
|---|
| 195 | (void) trace_wri_log(&trace); |
|---|
| 196 | } |
|---|
| 197 | |
|---|
| 198 | void |
|---|
| 199 | trace_write_3(uint_t type, intptr_t arg1, intptr_t arg2, intptr_t arg3) |
|---|
| 200 | { |
|---|
| 201 | TRACE trace; |
|---|
| 202 | |
|---|
| 203 | trace.logtype = type; |
|---|
| 204 | trace.loginfo[0] = arg1; |
|---|
| 205 | trace.loginfo[1] = arg2; |
|---|
| 206 | trace.loginfo[2] = arg3; |
|---|
| 207 | (void) trace_wri_log(&trace); |
|---|
| 208 | } |
|---|
| 209 | |
|---|
| 210 | /* |
|---|
| 211 | * ¥¢¥»¥ó¥Ö¥êžÀžì€ÇµœÒ€µ€ì€ë¥³¡Œ¥É€«€é¥È¥ì¡Œ¥¹¥í¥°€òœÐÎÏ€¹€ë€¿€á€ÎŽØ |
|---|
| 212 | * ¿ô |
|---|
| 213 | */ |
|---|
| 214 | |
|---|
| 215 | void |
|---|
| 216 | log_dsp_enter(TCB *p_tcb) |
|---|
| 217 | { |
|---|
| 218 | trace_1(LOG_TYPE_DSP|LOG_ENTER, p_tcb); |
|---|
| 219 | } |
|---|
| 220 | |
|---|
| 221 | void |
|---|
| 222 | log_dsp_leave(TCB *p_tcb) |
|---|
| 223 | { |
|---|
| 224 | trace_1(LOG_TYPE_DSP|LOG_LEAVE, p_tcb); |
|---|
| 225 | } |
|---|
| 226 | |
|---|
| 227 | void |
|---|
| 228 | log_inh_enter(INHNO inhno) |
|---|
| 229 | { |
|---|
| 230 | trace_1(LOG_TYPE_INH|LOG_ENTER, inhno); |
|---|
| 231 | } |
|---|
| 232 | |
|---|
| 233 | void |
|---|
| 234 | log_inh_leave(INHNO inhno) |
|---|
| 235 | { |
|---|
| 236 | trace_1(LOG_TYPE_INH|LOG_LEAVE, inhno); |
|---|
| 237 | } |
|---|
| 238 | |
|---|
| 239 | void |
|---|
| 240 | log_exc_enter(EXCNO excno) |
|---|
| 241 | { |
|---|
| 242 | trace_1(LOG_TYPE_EXC|LOG_ENTER, excno); |
|---|
| 243 | } |
|---|
| 244 | |
|---|
| 245 | void |
|---|
| 246 | log_exc_leave(EXCNO excno) |
|---|
| 247 | { |
|---|
| 248 | trace_1(LOG_TYPE_EXC|LOG_LEAVE, excno); |
|---|
| 249 | } |
|---|