Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: UsbWattMeter/trunk/asp_dcre/kernel/task_sync.c@ 165

Last change on this file since 165 was 164, checked in by coas-nagasima, 8 years ago
TOPPERS/ECNLサンプルアプリ「USB充電器電力計」を追加
Property svn:eol-style set to `native` Property svn:keywords set to `Id` Property svn:mime-type set to `text/x-csrc`
File size: 10.2 KB

Line
1	/*
2	* TOPPERS/ASP Kernel
3	* Toyohashi Open Platform for Embedded Real-Time Systems/
4	* Advanced Standard Profile Kernel
5	*
6	* Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7	* Toyohashi Univ. of Technology, JAPAN
8	* Copyright (C) 2005-2010 by Embedded and Real-Time Systems Laboratory
9	* Graduate School of Information Science, Nagoya Univ., JAPAN
10	*
11	* ãLì ÒÍCÈºÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
12	* Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»Eü
13	* ÏEÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
14	* (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
15	* \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[
16	* XR[hÉÜÜêÄ¢é±ÆD
17	* (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
18	* pÅ«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
19	gip
20	* Ò}j
21	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºL
22	* Ì³ÛØKèðfÚ·é±ÆD
23	* (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
24	* pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
25	* ÆD
26	* (a) ÄzzÉº¤hL
27	gipÒ}j
28	AÈÇjÉCãLÌ
29	* ì \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
30	* (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
31	* ñ·é±ÆD
32	* (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹
33	* Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
34	* Ü½C{\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©Èé
35	* RÉîÃ¿©çàCãLì Ò¨æÑTOPPERSvWFNgð
36	* ÆÓ·é±ÆD
37	*
38	* {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
39	* æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
40	* ÉÎ·éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEF
41	* AÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»
42	* ÌÓCðíÈ¢D
43	*
44	* @(#) $Id: task_sync.c 164 2016-03-07 11:33:50Z coas-nagasima $
45	*/
46
47	/*
48	* ^XNt®¯ú@\
49	*/
50
51	#include "kernel_impl.h"
52	#include "check.h"
53	#include "task.h"
54	#include "wait.h"
55
56	/*
57	* g[XO}NÌftHgè`
58	*/
59	#ifndef LOG_SLP_TSK_ENTER
60	#define LOG_SLP_TSK_ENTER()
61	#endif /* LOG_SLP_TSK_ENTER */
62
63	#ifndef LOG_SLP_TSK_LEAVE
64	#define LOG_SLP_TSK_LEAVE(ercd)
65	#endif /* LOG_SLP_TSK_LEAVE */
66
67	#ifndef LOG_TSLP_TSK_ENTER
68	#define LOG_TSLP_TSK_ENTER(tmout)
69	#endif /* LOG_TSLP_TSK_ENTER */
70
71	#ifndef LOG_TSLP_TSK_LEAVE
72	#define LOG_TSLP_TSK_LEAVE(ercd)
73	#endif /* LOG_TSLP_TSK_LEAVE */
74
75	#ifndef LOG_WUP_TSK_ENTER
76	#define LOG_WUP_TSK_ENTER(tskid)
77	#endif /* LOG_WUP_TSK_ENTER */
78
79	#ifndef LOG_WUP_TSK_LEAVE
80	#define LOG_WUP_TSK_LEAVE(ercd)
81	#endif /* LOG_WUP_TSK_LEAVE */
82
83	#ifndef LOG_IWUP_TSK_ENTER
84	#define LOG_IWUP_TSK_ENTER(tskid)
85	#endif /* LOG_IWUP_TSK_ENTER */
86
87	#ifndef LOG_IWUP_TSK_LEAVE
88	#define LOG_IWUP_TSK_LEAVE(ercd)
89	#endif /* LOG_IWUP_TSK_LEAVE */
90
91	#ifndef LOG_CAN_WUP_ENTER
92	#define LOG_CAN_WUP_ENTER(tskid)
93	#endif /* LOG_CAN_WUP_ENTER */
94
95	#ifndef LOG_CAN_WUP_LEAVE
96	#define LOG_CAN_WUP_LEAVE(ercd)
97	#endif /* LOG_CAN_WUP_LEAVE */
98
99	#ifndef LOG_REL_WAI_ENTER
100	#define LOG_REL_WAI_ENTER(tskid)
101	#endif /* LOG_REL_WAI_ENTER */
102
103	#ifndef LOG_REL_WAI_LEAVE
104	#define LOG_REL_WAI_LEAVE(ercd)
105	#endif /* LOG_REL_WAI_LEAVE */
106
107	#ifndef LOG_IREL_WAI_ENTER
108	#define LOG_IREL_WAI_ENTER(tskid)
109	#endif /* LOG_IREL_WAI_ENTER */
110
111	#ifndef LOG_IREL_WAI_LEAVE
112	#define LOG_IREL_WAI_LEAVE(ercd)
113	#endif /* LOG_IREL_WAI_LEAVE */
114
115	#ifndef LOG_SUS_TSK_ENTER
116	#define LOG_SUS_TSK_ENTER(tskid)
117	#endif /* LOG_SUS_TSK_ENTER */
118
119	#ifndef LOG_SUS_TSK_LEAVE
120	#define LOG_SUS_TSK_LEAVE(ercd)
121	#endif /* LOG_SUS_TSK_LEAVE */
122
123	#ifndef LOG_RSM_TSK_ENTER
124	#define LOG_RSM_TSK_ENTER(tskid)
125	#endif /* LOG_RSM_TSK_ENTER */
126
127	#ifndef LOG_RSM_TSK_LEAVE
128	#define LOG_RSM_TSK_LEAVE(ercd)
129	#endif /* LOG_RSM_TSK_LEAVE */
130
131	#ifndef LOG_DLY_TSK_ENTER
132	#define LOG_DLY_TSK_ENTER(dlytim)
133	#endif /* LOG_DLY_TSK_ENTER */
134
135	#ifndef LOG_DLY_TSK_LEAVE
136	#define LOG_DLY_TSK_LEAVE(ercd)
137	#endif /* LOG_DLY_TSK_LEAVE */
138
139	/*
140	* N°Ò¿
141	*/
142	#ifdef TOPPERS_slp_tsk
143
144	ER
145	slp_tsk(void)
146	{
147	WINFO winfo;
148	ER ercd;
149
150	LOG_SLP_TSK_ENTER();
151	CHECK_DISPATCH();
152
153	t_lock_cpu();
154	if (p_runtsk->wupque) {
155	p_runtsk->wupque = false;
156	ercd = E_OK;
157	}
158	else {
159	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_SLP);
160	make_wait(&winfo);
161	LOG_TSKSTAT(p_runtsk);
162	dispatch();
163	ercd = winfo.wercd;
164	}
165	t_unlock_cpu();
166
167	error_exit:
168	LOG_SLP_TSK_LEAVE(ercd);
169	return(ercd);
170	}
171
172	#endif /* TOPPERS_slp_tsk */
173
174	/*
175	* N°Ò¿i^CAEg èj
176	*/
177	#ifdef TOPPERS_tslp_tsk
178
179	ER
180	tslp_tsk(TMO tmout)
181	{
182	WINFO winfo;
183	TMEVTB tmevtb;
184	ER ercd;
185
186	LOG_TSLP_TSK_ENTER(tmout);
187	CHECK_DISPATCH();
188	CHECK_TMOUT(tmout);
189
190	t_lock_cpu();
191	if (p_runtsk->wupque) {
192	p_runtsk->wupque = false;
193	ercd = E_OK;
194	}
195	else if (tmout == TMO_POL) {
196	ercd = E_TMOUT;
197	}
198	else {
199	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_SLP);
200	make_wait_tmout(&winfo, &tmevtb, tmout);
201	LOG_TSKSTAT(p_runtsk);
202	dispatch();
203	ercd = winfo.wercd;
204	}
205	t_unlock_cpu();
206
207	error_exit:
208	LOG_TSLP_TSK_LEAVE(ercd);
209	return(ercd);
210	}
211
212	#endif /* TOPPERS_tslp_tsk */
213
214	/*
215	* ^XNÌN°
216	*/
217	#ifdef TOPPERS_wup_tsk
218
219	ER
220	wup_tsk(ID tskid)
221	{
222	TCB *p_tcb;
223	ER ercd;
224
225	LOG_WUP_TSK_ENTER(tskid);
226	CHECK_TSKCTX_UNL();
227	CHECK_TSKID_SELF(tskid);
228	p_tcb = get_tcb_self(tskid);
229
230	t_lock_cpu();
231	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
232	ercd = E_NOEXS;
233	}
234	else if (TSTAT_DORMANT(p_tcb->tstat)) {
235	ercd = E_OBJ;
236	}
237	else if (TSTAT_WAIT_SLP(p_tcb->tstat)) {
238	if (wait_complete(p_tcb)) {
239	dispatch();
240	}
241	ercd = E_OK;
242	}
243	else if (!(p_tcb->wupque)) {
244	p_tcb->wupque = true;
245	ercd = E_OK;
246	}
247	else {
248	ercd = E_QOVR;
249	}
250	t_unlock_cpu();
251
252	error_exit:
253	LOG_WUP_TSK_LEAVE(ercd);
254	return(ercd);
255	}
256
257	#endif /* TOPPERS_wup_tsk */
258
259	/*
260	* ^XNÌN°iñ^XNReLXgpj
261	*/
262	#ifdef TOPPERS_iwup_tsk
263
264	ER
265	iwup_tsk(ID tskid)
266	{
267	TCB *p_tcb;
268	ER ercd;
269
270	LOG_IWUP_TSK_ENTER(tskid);
271	CHECK_INTCTX_UNL();
272	CHECK_TSKID(tskid);
273	p_tcb = get_tcb(tskid);
274
275	i_lock_cpu();
276	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
277	ercd = E_NOEXS;
278	}
279	else if (TSTAT_DORMANT(p_tcb->tstat)) {
280	ercd = E_OBJ;
281	}
282	else if (TSTAT_WAIT_SLP(p_tcb->tstat)) {
283	if (wait_complete(p_tcb)) {
284	reqflg = true;
285	}
286	ercd = E_OK;
287	}
288	else if (!(p_tcb->wupque)) {
289	p_tcb->wupque = true;
290	ercd = E_OK;
291	}
292	else {
293	ercd = E_QOVR;
294	}
295	i_unlock_cpu();
296
297	error_exit:
298	LOG_IWUP_TSK_LEAVE(ercd);
299	return(ercd);
300	}
301
302	#endif /* TOPPERS_iwup_tsk */
303
304	/*
305	* ^XNN°vÌLZ
306	*/
307	#ifdef TOPPERS_can_wup
308
309	ER_UINT
310	can_wup(ID tskid)
311	{
312	TCB *p_tcb;
313	ER_UINT ercd;
314
315	LOG_CAN_WUP_ENTER(tskid);
316	CHECK_TSKCTX_UNL();
317	CHECK_TSKID_SELF(tskid);
318	p_tcb = get_tcb_self(tskid);
319
320	t_lock_cpu();
321	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
322	ercd = E_NOEXS;
323	}
324	else if (TSTAT_DORMANT(p_tcb->tstat)) {
325	ercd = E_OBJ;
326	}
327	else {
328	ercd = p_tcb->wupque ? 1 : 0;
329	p_tcb->wupque = false;
330	}
331	t_unlock_cpu();
332
333	error_exit:
334	LOG_CAN_WUP_LEAVE(ercd);
335	return(ercd);
336	}
337
338	#endif /* TOPPERS_can_wup */
339
340	/*
341	* Ò¿óÔÌ§ð
342	*/
343	#ifdef TOPPERS_rel_wai
344
345	ER
346	rel_wai(ID tskid)
347	{
348	TCB *p_tcb;
349	ER ercd;
350
351	LOG_REL_WAI_ENTER(tskid);
352	CHECK_TSKCTX_UNL();
353	CHECK_TSKID(tskid);
354	p_tcb = get_tcb(tskid);
355
356	t_lock_cpu();
357	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
358	ercd = E_NOEXS;
359	}
360	else if (!TSTAT_WAITING(p_tcb->tstat)) {
361	ercd = E_OBJ;
362	}
363	else {
364	if (wait_release(p_tcb)) {
365	dispatch();
366	}
367	ercd = E_OK;
368	}
369	t_unlock_cpu();
370
371	error_exit:
372	LOG_REL_WAI_LEAVE(ercd);
373	return(ercd);
374	}
375
376	#endif /* TOPPERS_rel_wai */
377
378	/*
379	* Ò¿óÔÌ§ðiñ^XNReLXgpj
380	*/
381	#ifdef TOPPERS_irel_wai
382
383	ER
384	irel_wai(ID tskid)
385	{
386	TCB *p_tcb;
387	ER ercd;
388
389	LOG_IREL_WAI_ENTER(tskid);
390	CHECK_INTCTX_UNL();
391	CHECK_TSKID(tskid);
392	p_tcb = get_tcb(tskid);
393
394	i_lock_cpu();
395	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
396	ercd = E_NOEXS;
397	}
398	else if (!TSTAT_WAITING(p_tcb->tstat)) {
399	ercd = E_OBJ;
400	}
401	else {
402	if (wait_release(p_tcb)) {
403	reqflg = true;
404	}
405	ercd = E_OK;
406	}
407	i_unlock_cpu();
408
409	error_exit:
410	LOG_IREL_WAI_LEAVE(ercd);
411	return(ercd);
412	}
413
414	#endif /* TOPPERS_irel_wai */
415
416	/*
417	* §Ò¿óÔÖÌÚs
418	*/
419	#ifdef TOPPERS_sus_tsk
420
421	ER
422	sus_tsk(ID tskid)
423	{
424	TCB *p_tcb;
425	ER ercd;
426
427	LOG_SUS_TSK_ENTER(tskid);
428	CHECK_TSKCTX_UNL();
429	CHECK_TSKID_SELF(tskid);
430	p_tcb = get_tcb_self(tskid);
431
432	t_lock_cpu();
433	if (p_tcb == p_runtsk && !dspflg) {
434	ercd = E_CTX;
435	}
436	else if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
437	ercd = E_NOEXS;
438	}
439	else if (TSTAT_DORMANT(p_tcb->tstat)) {
440	ercd = E_OBJ;
441	}
442	else if (TSTAT_RUNNABLE(p_tcb->tstat)) {
443	/*
444	* ÀsÅ«éóÔ©ç§Ò¿óÔÖÌJÚ
445	*/
446	p_tcb->tstat = TS_SUSPENDED;
447	LOG_TSKSTAT(p_tcb);
448	if (make_non_runnable(p_tcb)) {
449	dispatch();
450	}
451	ercd = E_OK;
452	}
453	else if (TSTAT_SUSPENDED(p_tcb->tstat)) {
454	ercd = E_QOVR;
455	}
456	else {
457	/*
458	* Ò¿óÔ©çñdÒ¿óÔÖÌJÚ
459	*/
460	p_tcb->tstat \|= TS_SUSPENDED;
461	LOG_TSKSTAT(p_tcb);
462	ercd = E_OK;
463	}
464	t_unlock_cpu();
465
466	error_exit:
467	LOG_SUS_TSK_LEAVE(ercd);
468	return(ercd);
469	}
470
471	#endif /* TOPPERS_sus_tsk */
472
473	/*
474	* §Ò¿óÔ©çÌÄJ
475	*/
476	#ifdef TOPPERS_rsm_tsk
477
478	ER
479	rsm_tsk(ID tskid)
480	{
481	TCB *p_tcb;
482	ER ercd;
483
484	LOG_RSM_TSK_ENTER(tskid);
485	CHECK_TSKCTX_UNL();
486	CHECK_TSKID(tskid);
487	p_tcb = get_tcb(tskid);
488
489	t_lock_cpu();
490	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
491	ercd = E_NOEXS;
492	}
493	else if (!TSTAT_SUSPENDED(p_tcb->tstat)) {
494	ercd = E_OBJ;
495	}
496	else if (!TSTAT_WAITING(p_tcb->tstat)) {
497	/*
498	* §Ò¿óÔ©çÀsÅ«éóÔÖÌJÚ
499	*/
500	p_tcb->tstat = TS_RUNNABLE;
501	LOG_TSKSTAT(p_tcb);
502	if (make_runnable(p_tcb)) {
503	dispatch();
504	}
505	ercd = E_OK;
506	}
507	else {
508	/*
509	* ñdÒ¿óÔ©çÒ¿óÔÖÌJÚ
510	*/
511	p_tcb->tstat &= ~TS_SUSPENDED;
512	LOG_TSKSTAT(p_tcb);
513	ercd = E_OK;
514	}
515	t_unlock_cpu();
516
517	error_exit:
518	LOG_RSM_TSK_LEAVE(ercd);
519	return(ercd);
520	}
521
522	#endif /* TOPPERS_rsm_tsk */
523
524	/*
525	* ©^XNÌx
526	*/
527	#ifdef TOPPERS_dly_tsk
528
529	ER
530	dly_tsk(RELTIM dlytim)
531	{
532	WINFO winfo;
533	TMEVTB tmevtb;
534	ER ercd;
535
536	LOG_DLY_TSK_ENTER(dlytim);
537	CHECK_DISPATCH();
538	CHECK_PAR(dlytim <= TMAX_RELTIM);
539
540	t_lock_cpu();
541	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_DLY);
542	(void) make_non_runnable(p_runtsk);
543	p_runtsk->p_winfo = &winfo;
544	winfo.p_tmevtb = &tmevtb;
545	tmevtb_enqueue(&tmevtb, dlytim, (CBACK) wait_tmout_ok, (void *) p_runtsk);
546	LOG_TSKSTAT(p_runtsk);
547	dispatch();
548	ercd = winfo.wercd;
549	t_unlock_cpu();
550
551	error_exit:
552	LOG_DLY_TSK_LEAVE(ercd);
553	return(ercd);
554	}
555
556	#endif /* TOPPERS_dly_tsk */

Note: See TracBrowser for help on using the repository browser.

Download in other formats: