[101] | 1 | /*
|
---|
| 2 | * TOPPERS/SSP Kernel
|
---|
| 3 | * Smallest Set Profile Kernel
|
---|
| 4 | *
|
---|
| 5 | * Copyright (C) 2011 by Meika Sugimoto
|
---|
| 6 | *
|
---|
| 7 | * ãLì ÒÍCÈºÌ (1)`(4) Ìðð½·êÉÀèC{\tgEF
|
---|
| 8 | * Ai{\tgEFAðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»EüÏE
|
---|
| 9 | * ÄzziȺCpÆÄÔj·é±Æð³Åø·éD
|
---|
| 10 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
| 11 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[X
|
---|
| 12 | * R[hÉÜÜêÄ¢é±ÆD
|
---|
| 13 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉgp
|
---|
| 14 | * Å«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
| 15 | gipÒ}
|
---|
| 16 | * j
|
---|
| 17 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL̳Û
|
---|
| 18 | * ØKèðfÚ·é±ÆD
|
---|
| 19 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉgp
|
---|
| 20 | * Å«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±ÆD
|
---|
| 21 | * (a) Äzzɺ¤hL
|
---|
| 22 | gipÒ}j
|
---|
| 23 | AÈÇjÉCãLÌì
|
---|
| 24 | * \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
| 25 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉñ
|
---|
| 26 | * ·é±ÆD
|
---|
| 27 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹Q
|
---|
| 28 | * ©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆDܽC
|
---|
| 29 | * {\tgEFAÌ[UܽÍGh[U©çÌ¢©ÈéRÉîÃ
|
---|
| 30 | * ¿©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
| 31 | *
|
---|
| 32 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨æ
|
---|
| 33 | * ÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚIÉη
|
---|
| 34 | * éK«àÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEFAÌp
|
---|
| 35 | * Éæè¼ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»ÌÓCð
|
---|
| 36 | * íÈ¢D
|
---|
| 37 | *
|
---|
| 38 | */
|
---|
| 39 |
|
---|
| 40 | #include "kernel_impl.h"
|
---|
| 41 |
|
---|
| 42 | #include "time_event.h"
|
---|
| 43 |
|
---|
| 44 |
|
---|
| 45 | /*
|
---|
| 46 | * »ÝÌVXeiPÊ: 1~bj
|
---|
| 47 | *
|
---|
| 48 | * µ§ÉÍCOÌ^CeBbNÌVXeD
|
---|
| 49 | */
|
---|
| 50 | EVTTIM current_time;
|
---|
| 51 |
|
---|
| 52 | /*
|
---|
| 53 | * ^CCxgq[vÅLøÈŬÌVXeiPÊ: 1~bj
|
---|
| 54 | */
|
---|
| 55 | EVTTIM min_time;
|
---|
| 56 |
|
---|
| 57 |
|
---|
| 58 | /*
|
---|
| 59 | * ^CCxgL
|
---|
| 60 | [ÌL
|
---|
| 61 | [wb_
|
---|
| 62 | *
|
---|
| 63 | * ^CCxgL
|
---|
| 64 | [ubNÌI[ÉmÛ·éD
|
---|
| 65 | */
|
---|
| 66 | #define TMEVT_HEAD() (tmevt_queue[tnum_tmevt_queue])
|
---|
| 67 | #define TMEVT_NULL ((QUEIDX)tnum_tmevt_queue)
|
---|
| 68 |
|
---|
| 69 | /*
|
---|
| 70 | * Cxg¶är}N
|
---|
| 71 | *
|
---|
| 72 | * Cxg¶ÍCmin_time©çÌÎlÅär·éD·Èí¿C
|
---|
| 73 | * min_timeðŬliÅàߢjCmit_time-1ªÅåliÅà¢j
|
---|
| 74 | * ÆÝȵÄär·éD
|
---|
| 75 | */
|
---|
| 76 | #define EVTTIM_LT(t1, t2) (((t1) - min_time) < ((t2) - min_time))
|
---|
| 77 | #define EVTTIM_LE(t1, t2) (((t1) - min_time) <= ((t2) - min_time))
|
---|
| 78 |
|
---|
| 79 | /*
|
---|
| 80 | * ^CCxgÌú»
|
---|
| 81 | */
|
---|
| 82 |
|
---|
| 83 | #ifdef TOPPERS_tmevtini
|
---|
| 84 |
|
---|
| 85 | void
|
---|
| 86 | initialize_time_event(void)
|
---|
| 87 | {
|
---|
| 88 | /* ÏÌú» */
|
---|
| 89 | current_time = 0U;
|
---|
| 90 | min_time = 0U;
|
---|
| 91 |
|
---|
| 92 | /* ^CCxgL
|
---|
| 93 | [Ìú» */
|
---|
| 94 | queue_initialize(&TMEVT_HEAD() , (QUEIDX)tnum_tmevt_queue);
|
---|
| 95 | }
|
---|
| 96 |
|
---|
| 97 | #endif /* TOPPERS_tmevtini */
|
---|
| 98 |
|
---|
| 99 | /*
|
---|
| 100 | * ^CCxgÌo^
|
---|
| 101 | */
|
---|
| 102 |
|
---|
| 103 | #ifdef TOPPERS_tmevtenq
|
---|
| 104 |
|
---|
| 105 | void
|
---|
| 106 | time_event_enqueue(ID tmevtid , EVTTIM evttim , CBACK callback , uintptr_t arg)
|
---|
| 107 | {
|
---|
| 108 | QUEIDX pos = TMEVT_HEAD().next;
|
---|
| 109 |
|
---|
| 110 | /* }üÊuðõ */
|
---|
| 111 | while((pos != TMEVT_NULL)
|
---|
| 112 | && (EVTTIM_LE(tmevt_time[pos] , evttim))) {
|
---|
| 113 | pos = tmevt_queue[pos].next;
|
---|
| 114 | }
|
---|
| 115 |
|
---|
| 116 | /* L
|
---|
| 117 | [É}ü */
|
---|
| 118 | queue_insert_prev(&(tmevt_queue[0]) , pos , (QUEIDX)tmevtid);
|
---|
| 119 | tmevt_callback[tmevtid] = (CBACK)callback;
|
---|
| 120 | tmevt_arg[tmevtid] = arg;
|
---|
| 121 | tmevt_time[tmevtid] = evttim;
|
---|
| 122 | }
|
---|
| 123 |
|
---|
| 124 | #endif /* TOPPERS_tmevtenq */
|
---|
| 125 |
|
---|
| 126 | /*
|
---|
| 127 | * ^CCxgÌí
|
---|
| 128 | */
|
---|
| 129 |
|
---|
| 130 | #ifdef TOPPERS_tmevtdeq
|
---|
| 131 |
|
---|
| 132 | void
|
---|
| 133 | time_event_dequeue(ID tmevtid)
|
---|
| 134 | {
|
---|
| 135 | /* L
|
---|
| 136 | [©çí */
|
---|
| 137 | (void)queue_delete_next(&(tmevt_queue[0]) , (QUEIDX)tmevtid);
|
---|
| 138 | }
|
---|
| 139 |
|
---|
| 140 | #endif /* TOPPERS_tmevtdeq */
|
---|
| 141 |
|
---|
| 142 | /*
|
---|
| 143 | * VXeÌÊm
|
---|
| 144 | */
|
---|
| 145 |
|
---|
| 146 | #ifdef TOPPERS_sig_tim
|
---|
| 147 |
|
---|
| 148 | void
|
---|
| 149 | signal_time(void)
|
---|
| 150 | {
|
---|
| 151 | QUEIDX pos = TMEVT_HEAD().next , evtid;
|
---|
| 152 |
|
---|
| 153 | i_lock_cpu();
|
---|
| 154 |
|
---|
| 155 | /* »ÝÌXV */
|
---|
| 156 | current_time += (EVTTIM)TIC_NUME;
|
---|
| 157 |
|
---|
| 158 | /* R[obNÌÀs */
|
---|
| 159 | while((pos != TMEVT_NULL)
|
---|
| 160 | && EVTTIM_LT(tmevt_time[pos] , current_time)) {
|
---|
| 161 | (void)queue_delete_next(&(tmevt_queue[0]) , pos);
|
---|
| 162 | evtid = pos;
|
---|
| 163 | pos = tmevt_queue[pos].next;
|
---|
| 164 | (*tmevt_callback[evtid])(tmevt_arg[evtid]);
|
---|
| 165 | }
|
---|
| 166 |
|
---|
| 167 | /* min_timeÌXV */
|
---|
| 168 | min_time = current_time;
|
---|
| 169 |
|
---|
| 170 | i_unlock_cpu();
|
---|
| 171 | }
|
---|
| 172 |
|
---|
| 173 | #endif /* TOPPERS_sig_tim */
|
---|