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 */
|
---|