1 | /*
|
---|
2 | * TOPPERS Software
|
---|
3 | * Toyohashi Open Platform for Embedded Real-Time Systems
|
---|
4 | *
|
---|
5 | * Copyright (C) 2007-2009 by Embedded and Real-Time Systems Laboratory
|
---|
6 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
7 | *
|
---|
8 | * ãLì ÒÍCȺÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
|
---|
9 | * Ai{\tgEFAðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»Eü
|
---|
10 | * ÏEÄzziȺCpÆÄÔj·é±Æð³Åø·éD
|
---|
11 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
12 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[
|
---|
13 | * XR[hÉÜÜêÄ¢é±ÆD
|
---|
14 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
|
---|
15 | * pÅ«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
16 | gip
|
---|
17 | * Ò}j
|
---|
18 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL
|
---|
19 | * ̳ÛØKèðfÚ·é±ÆD
|
---|
20 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
|
---|
21 | * pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
|
---|
22 | * ÆD
|
---|
23 | * (a) Äzzɺ¤hL
|
---|
24 | gipÒ}j
|
---|
25 | AÈÇjÉCãLÌ
|
---|
26 | * ì \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
27 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
|
---|
28 | * ñ·é±ÆD
|
---|
29 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹
|
---|
30 | * Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
31 | * ܽC{\tgEFAÌ[UܽÍGh[U©çÌ¢©Èé
|
---|
32 | * RÉîÿ©çàCãLì Ò¨æÑTOPPERSvWFNgð
|
---|
33 | * ÆÓ·é±ÆD
|
---|
34 | *
|
---|
35 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
|
---|
36 | * æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
|
---|
37 | * ÉηéK«àÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEF
|
---|
38 | * AÌpÉæè¼ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»
|
---|
39 | * ÌÓCðíÈ¢D
|
---|
40 | *
|
---|
41 | * @(#) $Id: test_tex2.c 1577 2009-05-31 14:30:51Z ertl-hiro $
|
---|
42 | */
|
---|
43 |
|
---|
44 | /*
|
---|
45 | * ^XNáOÉÖ·éeXg(2)
|
---|
46 | *
|
---|
47 | * yeXgÌÚIz
|
---|
48 | *
|
---|
49 | * ÝnhiA[nhj¨æÑCPUáOnh©ç^XNá
|
---|
50 | * O[`ðN®·éðÔ
|
---|
51 | IÉeXg·éD
|
---|
52 | *
|
---|
53 | * yeXgÚz
|
---|
54 | *
|
---|
55 | * (A) iras_texÌG[o
|
---|
56 | * (A-1) ÎÛ^XNªx~óÔ
|
---|
57 | * (A-2) ÎÛ^XNÌ^XNáO[`ªè`³êĢȢ
|
---|
58 | * (B) Ýnh©çÄÎê½iras_tex̳í
|
---|
59 | * (B-1) ÎÛ^XNªÀsóÔÌ^XN©Â^XNáOÂ
|
---|
60 | * (B-2) ÎÛ^XNªÀsóÔÌ^XNÅÈ¢
|
---|
61 | * (B-3) ÎÛ^XNªÀsóÔÌ^XN¾ª^XNáOÖ~
|
---|
62 | * (C) CPUáOnh©çÄÎê½iras_tex̳í
|
---|
63 | * (C-1) ÎÛ^XNªÀsóÔÌ^XN©Â^XNáOÂ
|
---|
64 | * (C-2) ÎÛ^XNªÀsóÔÌ^XNÅÈ¢
|
---|
65 | * (C-3) ÎÛ^XNªÀsóÔÌ^XN¾ª^XNáOÖ~
|
---|
66 | * ¨ À{µÈ¢i^[Qbgñ˶ÉÀ»Å«È¢j
|
---|
67 | * (D) ÝnhÌoûÉæéN®
|
---|
68 | * (D-1) fBXpb`ãÌ^XNª^XNáOÂÅ^XNáOv
|
---|
69 | * è
|
---|
70 | * (E) CPUáOnhÌoûÉæéN®
|
---|
71 | * (E-1) fBXpb`ãÌ^XNª^XNáOÂÅ^XNáOv
|
---|
72 | * è
|
---|
73 | * (F) sns_texÅÀsóÔÌ^XNªÈ¢
|
---|
74 | *
|
---|
75 | * ygp\[Xz
|
---|
76 | *
|
---|
77 | * TASK1: CÌ^XNDÀsóÔÌ^XNÉεÄ^XNáOðv·
|
---|
78 | * éÎÛ^XN
|
---|
79 | * TASK2: ÀsóÔÅÈ¢^XNÉεÄ^XNáOðv·éÎÛ^XN
|
---|
80 | * TASK3: ^XNáO[`ªè`³êĢȢ^XN
|
---|
81 | * TASK4: x~óÔÌ^XN
|
---|
82 | * ALM1: A[nh1
|
---|
83 | * ALM2: A[nh2
|
---|
84 | * ALM3: A[nh3
|
---|
85 | * CPUEXC1: CPUáOnh
|
---|
86 | *
|
---|
87 | * yeXgV[PXz
|
---|
88 | *
|
---|
89 | * == TASK1iDæxF10j==
|
---|
90 | * 1: úóÔÌ`FbN
|
---|
91 | * ref_tex(TSK_SELF, &rtex)
|
---|
92 | * 2: sta_alm(ALM1, 1U)
|
---|
93 | * A[nh1ÌÀsðÒÂ
|
---|
94 | * == ALM1 ==
|
---|
95 | * 3: úóÔÌ`FbN
|
---|
96 | * iras_tex(TASK3, 0x0001) ... (A-2)
|
---|
97 | * iras_tex(TASK4, 0x0001) ... (A-1)
|
---|
98 | * iras_tex(TASK2, 0x0001) ... (B-2)
|
---|
99 | * iras_tex(TASK1, 0x0001) ... (B-3)
|
---|
100 | * ^[
|
---|
101 | * == TASK1i±«j==
|
---|
102 | * 4: ena_tex()
|
---|
103 | * == TASK1^XNáO[`i1ñÚj==
|
---|
104 | * 5: úóÔÌ`FbN
|
---|
105 | * 6: dis_dsp() ... 4ÂÌóÔð»ê¼êÏ»³¹é
|
---|
106 | * chg_ipm(TMAX_INTPRI)
|
---|
107 | * ena_tex()
|
---|
108 | * loc_cpu()
|
---|
109 | * ^[
|
---|
110 | * == TASK1i±«j==
|
---|
111 | * 7: ßÁÄ«½óÔÌ`FbN
|
---|
112 | * ref_tex(TSK_SELF, &rtex)
|
---|
113 | * 8: sta_alm(ALM2, 1U)
|
---|
114 | * A[nh2ÌÀsðÒÂ
|
---|
115 | * == ALM2 ==
|
---|
116 | * 9: úóÔÌ`FbN
|
---|
117 | * iras_tex(TASK1, 0x0002) ... (B-1)
|
---|
118 | * ^[ ... (D-1)
|
---|
119 | * == TASK1^XNáO[`i2ñÚj==
|
---|
120 | * 10: úóÔÌ`FbN
|
---|
121 | * ^[
|
---|
122 | * == TASK1i±«j==
|
---|
123 | * 11: sus_tsk(TASK2)
|
---|
124 | * sus_tsk(TASK3)
|
---|
125 | * 12: sta_alm(ALM3, 10U)
|
---|
126 | * 13: dly_tsk(50U)
|
---|
127 | * == ALM3 ==
|
---|
128 | * 14: úóÔÌ`FbN
|
---|
129 | * msns_tex()ðÜÞn ... (F)
|
---|
130 | * iget_tid(&tskid)
|
---|
131 | * iras_tex(TASK1, 0x0004) ... (B-2)
|
---|
132 | * ^[
|
---|
133 | * == TASK1^XNáO[`i3ñÚj==
|
---|
134 | * 15: úóÔÌ`FbN
|
---|
135 | * ^[
|
---|
136 | * == TASK1i±«j==
|
---|
137 | * 16: rsm_tsk(TASK2)
|
---|
138 | * rsm_tsk(TASK3)
|
---|
139 | * dis_dsp()
|
---|
140 | * 17: RAISE_CPU_EXCEPTION
|
---|
141 | * == CPUEXC1 ==
|
---|
142 | * 18: úóÔÌ`FbN
|
---|
143 | * xsns_xpn(p_excinf)
|
---|
144 | * iras_tex(TASK3, 0x0010) ... (A-2)
|
---|
145 | * iras_tex(TASK4, 0x0010) ... (A-1)
|
---|
146 | * iras_tex(TASK2, 0x0010) ... (C-2)
|
---|
147 | * iras_tex(TASK1, 0x0010) ... (C-1)
|
---|
148 | * ^[ ... (E-1)
|
---|
149 | * == TASK1^XNáO[`i4ñÚj==
|
---|
150 | * 19: úóÔÌ`FbN
|
---|
151 | * 20: ext_tsk()
|
---|
152 | * == TASK2iDæxF10j==
|
---|
153 | * 21: úóÔÌ`FbN
|
---|
154 | * 22: ena_tex()
|
---|
155 | * == TASK2^XNáO[` ==
|
---|
156 | * 23: úóÔÌ`FbN
|
---|
157 | * ^[
|
---|
158 | * == TASK2i±«j==
|
---|
159 | * 24: sus_tsk(TASK3)
|
---|
160 | * 25: eXgI¹
|
---|
161 | */
|
---|
162 |
|
---|
163 | #include <kernel.h>
|
---|
164 | #include <test_lib.h>
|
---|
165 | #include <t_syslog.h>
|
---|
166 | #include "kernel_cfg.h"
|
---|
167 | #include "test_tex2.h"
|
---|
168 |
|
---|
169 | volatile bool_t alm1_flag = false;
|
---|
170 | volatile bool_t alm2_flag = false;
|
---|
171 | volatile bool_t alm3_flag = false;
|
---|
172 |
|
---|
173 | void
|
---|
174 | tex_task1(TEXPTN texptn, intptr_t exinf)
|
---|
175 | {
|
---|
176 | ER ercd;
|
---|
177 |
|
---|
178 | switch (texptn) {
|
---|
179 | case 0x0001:
|
---|
180 | check_point(5);
|
---|
181 | check_state(false, false, TIPM_ENAALL, false, false, true);
|
---|
182 |
|
---|
183 | /*
|
---|
184 | * fBXpb`Ö~CÝDæx}XNÏXC^XNáOÂC
|
---|
185 | * CPUbN
|
---|
186 | */
|
---|
187 | check_point(6);
|
---|
188 | ercd = dis_dsp();
|
---|
189 | check_ercd(ercd, E_OK);
|
---|
190 | ercd = chg_ipm(TMAX_INTPRI);
|
---|
191 | check_ercd(ercd, E_OK);
|
---|
192 | ercd = ena_tex();
|
---|
193 | check_ercd(ercd, E_OK);
|
---|
194 | ercd = loc_cpu();
|
---|
195 | check_ercd(ercd, E_OK);
|
---|
196 | check_state(false, true, TMAX_INTPRI, true, true, false);
|
---|
197 | break;
|
---|
198 |
|
---|
199 | case 0x0002:
|
---|
200 | check_point(10);
|
---|
201 | check_state(false, false, TIPM_ENAALL, false, false, true);
|
---|
202 | break;
|
---|
203 |
|
---|
204 | case 0x0004:
|
---|
205 | check_point(15);
|
---|
206 | check_state(false, false, TIPM_ENAALL, false, false, true);
|
---|
207 | break;
|
---|
208 |
|
---|
209 | case 0x0010:
|
---|
210 | check_point(19);
|
---|
211 | check_state(false, false, TIPM_ENAALL, true, true, true);
|
---|
212 |
|
---|
213 | /*
|
---|
214 | * ^XNI¹
|
---|
215 | */
|
---|
216 | check_point(20);
|
---|
217 | ercd = ext_tsk();
|
---|
218 | check_point(0);
|
---|
219 | break;
|
---|
220 |
|
---|
221 | default:
|
---|
222 | check_point(0);
|
---|
223 | break;
|
---|
224 | }
|
---|
225 | }
|
---|
226 |
|
---|
227 | void
|
---|
228 | task1(intptr_t exinf)
|
---|
229 | {
|
---|
230 | ER ercd;
|
---|
231 | T_RTEX rtex;
|
---|
232 |
|
---|
233 | /*
|
---|
234 | * úóÔÌ`FbN
|
---|
235 | */
|
---|
236 | check_point(1);
|
---|
237 | check_state(false, false, TIPM_ENAALL, false, false, true);
|
---|
238 | ercd = ref_tex(TSK_SELF, &rtex);
|
---|
239 | check_ercd(ercd, E_OK);
|
---|
240 | check_assert((rtex.texstat & TTEX_DIS) != 0);
|
---|
241 | check_assert(rtex.pndptn == 0);
|
---|
242 |
|
---|
243 | /*
|
---|
244 | * A[nh1Ì®ìJn
|
---|
245 | */
|
---|
246 | check_point(2);
|
---|
247 | ercd = sta_alm(ALM1, 1U);
|
---|
248 | check_ercd(ercd, E_OK);
|
---|
249 |
|
---|
250 | /*
|
---|
251 | * A[nh1ÌÀsðÒÂ
|
---|
252 | */
|
---|
253 | while (!(alm1_flag));
|
---|
254 |
|
---|
255 | /*
|
---|
256 | * ^XNáOðÂ
|
---|
257 | */
|
---|
258 | check_point(4);
|
---|
259 | ercd = ena_tex();
|
---|
260 | /* ±±Å^XNáO[`ª®ì·é */
|
---|
261 | check_ercd(ercd, E_OK);
|
---|
262 |
|
---|
263 | /*
|
---|
264 | * ^XNáO©çÌ^[Éæè³ÌóÔÉßÁÄ¢é±Æð
|
---|
265 | * `FbN
|
---|
266 | */
|
---|
267 | check_point(7);
|
---|
268 | check_state(false, false, TIPM_ENAALL, false, false, false);
|
---|
269 | ercd = ref_tex(TSK_SELF, &rtex);
|
---|
270 | check_ercd(ercd, E_OK);
|
---|
271 | check_assert((rtex.texstat & TTEX_ENA) != 0);
|
---|
272 | check_assert(rtex.pndptn == 0);
|
---|
273 |
|
---|
274 | /*
|
---|
275 | * A[nh2Ì®ìJn
|
---|
276 | */
|
---|
277 | check_point(8);
|
---|
278 | ercd = sta_alm(ALM2, 1U);
|
---|
279 | check_ercd(ercd, E_OK);
|
---|
280 |
|
---|
281 | /*
|
---|
282 | * A[nh2ÌÀsðÒÂ
|
---|
283 | */
|
---|
284 | while (!(alm2_flag));
|
---|
285 |
|
---|
286 | /*
|
---|
287 | * TASK2ÆTASK3ð~ßéD
|
---|
288 | */
|
---|
289 | check_point(11);
|
---|
290 | ercd = sus_tsk(TASK2);
|
---|
291 | check_ercd(ercd, E_OK);
|
---|
292 | ercd = sus_tsk(TASK3);
|
---|
293 | check_ercd(ercd, E_OK);
|
---|
294 |
|
---|
295 | /*
|
---|
296 | * A[nh3Ì®ìJn
|
---|
297 | */
|
---|
298 | check_point(12);
|
---|
299 | ercd = sta_alm(ALM3, 10U);
|
---|
300 | check_ercd(ercd, E_OK);
|
---|
301 |
|
---|
302 | /*
|
---|
303 | * Àsx
|
---|
304 | */
|
---|
305 | check_point(13);
|
---|
306 | ercd = dly_tsk(50U);
|
---|
307 | /* A[nh3ª®ì·é */
|
---|
308 | check_ercd(ercd, E_OK);
|
---|
309 |
|
---|
310 | /*
|
---|
311 | * TASK2ÆTASK3ðÄJ·éD
|
---|
312 | */
|
---|
313 | check_point(16);
|
---|
314 | ercd = rsm_tsk(TASK2);
|
---|
315 | check_ercd(ercd, E_OK);
|
---|
316 | ercd = rsm_tsk(TASK3);
|
---|
317 | check_ercd(ercd, E_OK);
|
---|
318 |
|
---|
319 | /*
|
---|
320 | * fBXpb`Ö~
|
---|
321 | */
|
---|
322 | ercd = dis_dsp();
|
---|
323 | check_ercd(ercd, E_OK);
|
---|
324 |
|
---|
325 | /*
|
---|
326 | * CPUáO𶳹é
|
---|
327 | */
|
---|
328 | check_point(17);
|
---|
329 | RAISE_CPU_EXCEPTION;
|
---|
330 |
|
---|
331 | check_point(0);
|
---|
332 | }
|
---|
333 |
|
---|
334 | void
|
---|
335 | tex_task2(TEXPTN texptn, intptr_t exinf)
|
---|
336 | {
|
---|
337 | switch (texptn) {
|
---|
338 | case 0x0011:
|
---|
339 | check_point(23);
|
---|
340 | check_state(false, false, TIPM_ENAALL, false, false, true);
|
---|
341 | break;
|
---|
342 |
|
---|
343 | default:
|
---|
344 | check_point(0);
|
---|
345 | break;
|
---|
346 | }
|
---|
347 | }
|
---|
348 |
|
---|
349 | void
|
---|
350 | task2(intptr_t exinf)
|
---|
351 | {
|
---|
352 | ER ercd;
|
---|
353 |
|
---|
354 | /*
|
---|
355 | * úóÔÌ`FbN
|
---|
356 | */
|
---|
357 | check_point(21);
|
---|
358 | check_state(false, false, TIPM_ENAALL, false, false, true);
|
---|
359 |
|
---|
360 | /*
|
---|
361 | * ^XNáOðÂ
|
---|
362 | */
|
---|
363 | check_point(22);
|
---|
364 | ercd = ena_tex();
|
---|
365 | /* ±±Å^XNáO[`ª®ì·é */
|
---|
366 | check_ercd(ercd, E_OK);
|
---|
367 |
|
---|
368 | /*
|
---|
369 | * TASK3ð~ßéD
|
---|
370 | */
|
---|
371 | check_point(24);
|
---|
372 | ercd = sus_tsk(TASK3);
|
---|
373 | check_ercd(ercd, E_OK);
|
---|
374 |
|
---|
375 | /*
|
---|
376 | * eXgI¹
|
---|
377 | */
|
---|
378 | check_finish(25);
|
---|
379 | }
|
---|
380 |
|
---|
381 | void
|
---|
382 | task3(intptr_t exinf)
|
---|
383 | {
|
---|
384 | check_point(0);
|
---|
385 | }
|
---|
386 |
|
---|
387 | void
|
---|
388 | task4(intptr_t exinf)
|
---|
389 | {
|
---|
390 | check_point(0);
|
---|
391 | }
|
---|
392 |
|
---|
393 | void
|
---|
394 | tex_task4(TEXPTN texptn, intptr_t exinf)
|
---|
395 | {
|
---|
396 | check_point(0);
|
---|
397 | }
|
---|
398 |
|
---|
399 | void
|
---|
400 | alarm1_handler(intptr_t exinf)
|
---|
401 | {
|
---|
402 | ER ercd;
|
---|
403 |
|
---|
404 | /*
|
---|
405 | * úóÔÌ`FbN
|
---|
406 | */
|
---|
407 | check_point(3);
|
---|
408 | check_state_i(true, false, false, true, true);
|
---|
409 |
|
---|
410 | /*
|
---|
411 | * iras_texÌG[o
|
---|
412 | */
|
---|
413 | ercd = iras_tex(TASK3, 0x0001);
|
---|
414 | check_ercd(ercd, E_OBJ);
|
---|
415 | ercd = iras_tex(TASK4, 0x0001);
|
---|
416 | check_ercd(ercd, E_OBJ);
|
---|
417 |
|
---|
418 | /*
|
---|
419 | * ^XNáOðv
|
---|
420 | */
|
---|
421 | ercd = iras_tex(TASK2, 0x0001);
|
---|
422 | check_ercd(ercd, E_OK);
|
---|
423 | ercd = iras_tex(TASK1, 0x0001);
|
---|
424 | check_ercd(ercd, E_OK);
|
---|
425 |
|
---|
426 | alm1_flag = true;
|
---|
427 | }
|
---|
428 |
|
---|
429 | void
|
---|
430 | alarm2_handler(intptr_t exinf)
|
---|
431 | {
|
---|
432 | ER ercd;
|
---|
433 |
|
---|
434 | /*
|
---|
435 | * úóÔÌ`FbN
|
---|
436 | */
|
---|
437 | check_point(9);
|
---|
438 | check_state_i(true, false, false, true, false);
|
---|
439 |
|
---|
440 | /*
|
---|
441 | * ^XNáOðv
|
---|
442 | */
|
---|
443 | ercd = iras_tex(TASK1, 0x0002);
|
---|
444 | check_ercd(ercd, E_OK);
|
---|
445 |
|
---|
446 | alm2_flag = true;
|
---|
447 | }
|
---|
448 |
|
---|
449 | void
|
---|
450 | alarm3_handler(intptr_t exinf)
|
---|
451 | {
|
---|
452 | ER ercd;
|
---|
453 | ID tskid;
|
---|
454 |
|
---|
455 | check_point(14);
|
---|
456 | check_state_i(true, false, false, true, true);
|
---|
457 | ercd = iget_tid(&tskid);
|
---|
458 | check_ercd(ercd, E_OK);
|
---|
459 | check_assert(tskid == TSK_NONE);
|
---|
460 |
|
---|
461 | /*
|
---|
462 | * ^XNáOðv
|
---|
463 | */
|
---|
464 | ercd = iras_tex(TASK1, 0x0004);
|
---|
465 | check_ercd(ercd, E_OK);
|
---|
466 |
|
---|
467 | alm3_flag = true;
|
---|
468 | }
|
---|
469 |
|
---|
470 | void
|
---|
471 | cpuexc_handler(void *p_excinf)
|
---|
472 | {
|
---|
473 | ER ercd;
|
---|
474 |
|
---|
475 | /*
|
---|
476 | * úóÔÌ`FbN
|
---|
477 | */
|
---|
478 | check_point(18);
|
---|
479 | check_state_i(true, false, true, true, false);
|
---|
480 | check_assert(xsns_xpn(p_excinf) == false);
|
---|
481 |
|
---|
482 | /*
|
---|
483 | * iras_texÌG[o
|
---|
484 | */
|
---|
485 | ercd = iras_tex(TASK3, 0x0010);
|
---|
486 | check_ercd(ercd, E_OBJ);
|
---|
487 | ercd = iras_tex(TASK4, 0x0010);
|
---|
488 | check_ercd(ercd, E_OBJ);
|
---|
489 |
|
---|
490 | /*
|
---|
491 | * ^XNáOðv
|
---|
492 | */
|
---|
493 | ercd = iras_tex(TASK2, 0x0010);
|
---|
494 | check_ercd(ercd, E_OK);
|
---|
495 | ercd = iras_tex(TASK1, 0x0010);
|
---|
496 | check_ercd(ercd, E_OK);
|
---|
497 | }
|
---|