Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

sys_manage.c@ 61

Last change on this file since 61 was 61, checked in by ertl-honda, 11 years ago
ASP for EWARM のコミット．
File size: 10.6 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: sys_manage.c 2018 2010-12-31 13:43:05Z ertl-hiro $
45	*/
46
47	/*
48	* VXeóÔÇ@\
49	*/
50
51	#include "kernel_impl.h"
52	#include "check.h"
53	#include "task.h"
54
55	/*
56	* g[XO}NÌftHgè`
57	*/
58	#ifndef LOG_ROT_RDQ_ENTER
59	#define LOG_ROT_RDQ_ENTER(tskpri)
60	#endif /* LOG_ROT_RDQ_ENTER */
61
62	#ifndef LOG_ROT_RDQ_LEAVE
63	#define LOG_ROT_RDQ_LEAVE(ercd)
64	#endif /* LOG_ROT_RDQ_LEAVE */
65
66	#ifndef LOG_IROT_RDQ_ENTER
67	#define LOG_IROT_RDQ_ENTER(tskpri)
68	#endif /* LOG_IROT_RDQ_ENTER */
69
70	#ifndef LOG_IROT_RDQ_LEAVE
71	#define LOG_IROT_RDQ_LEAVE(ercd)
72	#endif /* LOG_IROT_RDQ_LEAVE */
73
74	#ifndef LOG_GET_TID_ENTER
75	#define LOG_GET_TID_ENTER(p_tskid)
76	#endif /* LOG_GET_TID_ENTER */
77
78	#ifndef LOG_GET_TID_LEAVE
79	#define LOG_GET_TID_LEAVE(ercd, tskid)
80	#endif /* LOG_GET_TID_LEAVE */
81
82	#ifndef LOG_IGET_TID_ENTER
83	#define LOG_IGET_TID_ENTER(p_tskid)
84	#endif /* LOG_IGET_TID_ENTER */
85
86	#ifndef LOG_IGET_TID_LEAVE
87	#define LOG_IGET_TID_LEAVE(ercd, tskid)
88	#endif /* LOG_IGET_TID_LEAVE */
89
90	#ifndef LOG_LOC_CPU_ENTER
91	#define LOG_LOC_CPU_ENTER()
92	#endif /* LOG_LOC_CPU_ENTER */
93
94	#ifndef LOG_LOC_CPU_LEAVE
95	#define LOG_LOC_CPU_LEAVE(ercd)
96	#endif /* LOG_LOC_CPU_LEAVE */
97
98	#ifndef LOG_ILOC_CPU_ENTER
99	#define LOG_ILOC_CPU_ENTER()
100	#endif /* LOG_ILOC_CPU_ENTER */
101
102	#ifndef LOG_ILOC_CPU_LEAVE
103	#define LOG_ILOC_CPU_LEAVE(ercd)
104	#endif /* LOG_ILOC_CPU_LEAVE */
105
106	#ifndef LOG_UNL_CPU_ENTER
107	#define LOG_UNL_CPU_ENTER()
108	#endif /* LOG_UNL_CPU_ENTER */
109
110	#ifndef LOG_UNL_CPU_LEAVE
111	#define LOG_UNL_CPU_LEAVE(ercd)
112	#endif /* LOG_UNL_CPU_LEAVE */
113
114	#ifndef LOG_IUNL_CPU_ENTER
115	#define LOG_IUNL_CPU_ENTER()
116	#endif /* LOG_IUNL_CPU_ENTER */
117
118	#ifndef LOG_IUNL_CPU_LEAVE
119	#define LOG_IUNL_CPU_LEAVE(ercd)
120	#endif /* LOG_IUNL_CPU_LEAVE */
121
122	#ifndef LOG_DIS_DSP_ENTER
123	#define LOG_DIS_DSP_ENTER()
124	#endif /* LOG_DIS_DSP_ENTER */
125
126	#ifndef LOG_DIS_DSP_LEAVE
127	#define LOG_DIS_DSP_LEAVE(ercd)
128	#endif /* LOG_DIS_DSP_LEAVE */
129
130	#ifndef LOG_ENA_DSP_ENTER
131	#define LOG_ENA_DSP_ENTER()
132	#endif /* LOG_ENA_DSP_ENTER */
133
134	#ifndef LOG_ENA_DSP_LEAVE
135	#define LOG_ENA_DSP_LEAVE(ercd)
136	#endif /* LOG_ENA_DSP_LEAVE */
137
138	#ifndef LOG_SNS_CTX_ENTER
139	#define LOG_SNS_CTX_ENTER()
140	#endif /* LOG_SNS_CTX_ENTER */
141
142	#ifndef LOG_SNS_CTX_LEAVE
143	#define LOG_SNS_CTX_LEAVE(state)
144	#endif /* LOG_SNS_CTX_LEAVE */
145
146	#ifndef LOG_SNS_LOC_ENTER
147	#define LOG_SNS_LOC_ENTER()
148	#endif /* LOG_SNS_LOC_ENTER */
149
150	#ifndef LOG_SNS_LOC_LEAVE
151	#define LOG_SNS_LOC_LEAVE(state)
152	#endif /* LOG_SNS_LOC_LEAVE */
153
154	#ifndef LOG_SNS_DSP_ENTER
155	#define LOG_SNS_DSP_ENTER()
156	#endif /* LOG_SNS_DSP_ENTER */
157
158	#ifndef LOG_SNS_DSP_LEAVE
159	#define LOG_SNS_DSP_LEAVE(state)
160	#endif /* LOG_SNS_DSP_LEAVE */
161
162	#ifndef LOG_SNS_DPN_ENTER
163	#define LOG_SNS_DPN_ENTER()
164	#endif /* LOG_SNS_DPN_ENTER */
165
166	#ifndef LOG_SNS_DPN_LEAVE
167	#define LOG_SNS_DPN_LEAVE(state)
168	#endif /* LOG_SNS_DPN_LEAVE */
169
170	#ifndef LOG_SNS_KER_ENTER
171	#define LOG_SNS_KER_ENTER()
172	#endif /* LOG_SNS_KER_ENTER */
173
174	#ifndef LOG_SNS_KER_LEAVE
175	#define LOG_SNS_KER_LEAVE(state)
176	#endif /* LOG_SNS_KER_LEAVE */
177
178	/*
179	* ^XNÌDæÊÌñ]
180	*/
181	#ifdef TOPPERS_rot_rdq
182
183	ER
184	rot_rdq(PRI tskpri)
185	{
186	uint_t pri;
187	QUEUE *p_queue;
188	ER ercd;
189
190	LOG_ROT_RDQ_ENTER(tskpri);
191	CHECK_TSKCTX_UNL();
192	CHECK_TPRI_SELF(tskpri);
193
194	t_lock_cpu();
195	pri = (tskpri == TPRI_SELF) ? p_runtsk->priority : INT_PRIORITY(tskpri);
196	p_queue = &(ready_queue[pri]);
197	if (queue_empty(p_queue)) {
198	ercd = E_OK;
199	}
200	else if ((((TCB *)(p_queue->p_next))->p_tinib->tskatr & TA_RSTR) != 0U) {
201	ercd = E_NOSPT;
202	}
203	else {
204	if (rotate_ready_queue(p_queue)) {
205	dispatch();
206	}
207	ercd = E_OK;
208	}
209	t_unlock_cpu();
210
211	error_exit:
212	LOG_ROT_RDQ_LEAVE(ercd);
213	return(ercd);
214	}
215
216	#endif /* TOPPERS_rot_rdq */
217
218	/*
219	* ^XNÌDæÊÌñ]iñ^XNReLXgpj
220	*/
221	#ifdef TOPPERS_irot_rdq
222
223	ER
224	irot_rdq(PRI tskpri)
225	{
226	QUEUE *p_queue;
227	ER ercd;
228
229	LOG_IROT_RDQ_ENTER(tskpri);
230	CHECK_INTCTX_UNL();
231	CHECK_TPRI(tskpri);
232
233	i_lock_cpu();
234	p_queue = &(ready_queue[INT_PRIORITY(tskpri)]);
235	if (queue_empty(p_queue)) {
236	ercd = E_OK;
237	}
238	else if ((((TCB *)(p_queue->p_next))->p_tinib->tskatr & TA_RSTR) != 0U) {
239	ercd = E_NOSPT;
240	}
241	else {
242	if (rotate_ready_queue(p_queue)) {
243	reqflg = true;
244	}
245	ercd = E_OK;
246	}
247	i_unlock_cpu();
248
249	error_exit:
250	LOG_IROT_RDQ_LEAVE(ercd);
251	return(ercd);
252	}
253
254	#endif /* TOPPERS_irot_rdq */
255
256	/*
257	* ÀsóÔÌ^XNIDÌQÆ
258	*/
259	#ifdef TOPPERS_get_tid
260
261	ER
262	get_tid(ID *p_tskid)
263	{
264	ER ercd;
265
266	LOG_GET_TID_ENTER(p_tskid);
267	CHECK_TSKCTX_UNL();
268
269	t_lock_cpu();
270	*p_tskid = TSKID(p_runtsk);
271	ercd = E_OK;
272	t_unlock_cpu();
273
274	error_exit:
275	LOG_GET_TID_LEAVE(ercd, *p_tskid);
276	return(ercd);
277	}
278
279	#endif /* TOPPERS_get_tid */
280
281	/*
282	* ÀsóÔÌ^XNIDÌQÆiñ^XNReLXgpj
283	*/
284	#ifdef TOPPERS_iget_tid
285
286	ER
287	iget_tid(ID *p_tskid)
288	{
289	ER ercd;
290
291	LOG_IGET_TID_ENTER(p_tskid);
292	CHECK_INTCTX_UNL();
293
294	i_lock_cpu();
295	*p_tskid = (p_runtsk == NULL) ? TSK_NONE : TSKID(p_runtsk);
296	ercd = E_OK;
297	i_unlock_cpu();
298
299	error_exit:
300	LOG_IGET_TID_LEAVE(ercd, *p_tskid);
301	return(ercd);
302	}
303
304	#endif /* TOPPERS_iget_tid */
305
306	/*
307	* CPUbNóÔÖÌÚs
308	*/
309	#ifdef TOPPERS_loc_cpu
310
311	ER
312	loc_cpu(void)
313	{
314	ER ercd;
315
316	LOG_LOC_CPU_ENTER();
317	CHECK_TSKCTX();
318
319	if (!t_sense_lock()) {
320	t_lock_cpu();
321	}
322	ercd = E_OK;
323
324	error_exit:
325	LOG_LOC_CPU_LEAVE(ercd);
326	return(ercd);
327	}
328
329	#endif /* TOPPERS_loc_cpu */
330
331	/*
332	* CPUbNóÔÖÌÚsiñ^XNReLXgpj
333	*/
334	#ifdef TOPPERS_iloc_cpu
335
336	ER
337	iloc_cpu(void)
338	{
339	ER ercd;
340
341	LOG_ILOC_CPU_ENTER();
342	CHECK_INTCTX();
343
344	if (!i_sense_lock()) {
345	i_lock_cpu();
346	}
347	ercd = E_OK;
348
349	error_exit:
350	LOG_ILOC_CPU_LEAVE(ercd);
351	return(ercd);
352	}
353
354	#endif /* TOPPERS_iloc_cpu */
355
356	/*
357	* CPUbNóÔÌð
358	*
359	* CPUbNÍCfBXpb`ªKvÆÈéT[rXR[ðÄÑo·±
360	* ÆÍÅ«È¢½ßCCPUbNóÔÌðÉfBXpb`ðN®·é
361	* KvÍÈ¢D
362	*/
363	#ifdef TOPPERS_unl_cpu
364
365	ER
366	unl_cpu(void)
367	{
368	ER ercd;
369
370	LOG_UNL_CPU_ENTER();
371	CHECK_TSKCTX();
372
373	if (t_sense_lock()) {
374	t_unlock_cpu();
375	}
376	ercd = E_OK;
377
378	error_exit:
379	LOG_UNL_CPU_LEAVE(ercd);
380	return(ercd);
381	}
382
383	#endif /* TOPPERS_unl_cpu */
384
385	/*
386	* CPUbNóÔÌðiñ^XNReLXgpj
387	*
388	* CPUbNÍCfBXpb`ªKvÆÈéT[rXR[ðÄÑo·±
389	* ÆÍÅ«È¢½ßCCPUbNóÔÌðÉfBXpb`ÌN®ðv
390	* ·éKvÍÈ¢D
391	*/
392	#ifdef TOPPERS_iunl_cpu
393
394	ER
395	iunl_cpu(void)
396	{
397	ER ercd;
398
399	LOG_IUNL_CPU_ENTER();
400	CHECK_INTCTX();
401
402	if (i_sense_lock()) {
403	i_unlock_cpu();
404	}
405	ercd = E_OK;
406
407	error_exit:
408	LOG_IUNL_CPU_LEAVE(ercd);
409	return(ercd);
410	}
411
412	#endif /* TOPPERS_iunl_cpu */
413
414	/*
415	* fBXpb`ÌÖ~
416	*/
417	#ifdef TOPPERS_dis_dsp
418
419	ER
420	dis_dsp(void)
421	{
422	ER ercd;
423
424	LOG_DIS_DSP_ENTER();
425	CHECK_TSKCTX_UNL();
426
427	t_lock_cpu();
428	disdsp = true;
429	dspflg = false;
430	ercd = E_OK;
431	t_unlock_cpu();
432
433	error_exit:
434	LOG_DIS_DSP_LEAVE(ercd);
435	return(ercd);
436	}
437
438	#endif /* TOPPERS_dis_dsp */
439
440	/*
441	* fBXpb`ÌÂ
442	*/
443	#ifdef TOPPERS_ena_dsp
444
445	ER
446	ena_dsp(void)
447	{
448	ER ercd;
449
450	LOG_ENA_DSP_ENTER();
451	CHECK_TSKCTX_UNL();
452
453	t_lock_cpu();
454	disdsp = false;
455	if (ipmflg) {
456	dspflg = true;
457	if (p_runtsk != p_schedtsk) {
458	dispatch();
459	}
460	}
461	ercd = E_OK;
462	t_unlock_cpu();
463
464	error_exit:
465	LOG_ENA_DSP_LEAVE(ercd);
466	return(ercd);
467	}
468
469	#endif /* TOPPERS_ena_dsp */
470
471	/*
472	* ReLXgÌQÆ
473	*/
474	#ifdef TOPPERS_sns_ctx
475
476	bool_t
477	sns_ctx(void)
478	{
479	bool_t state;
480
481	LOG_SNS_CTX_ENTER();
482	state = sense_context() ? true : false;
483	LOG_SNS_CTX_LEAVE(state);
484	return(state);
485	}
486
487	#endif /* TOPPERS_sns_ctx */
488
489	/*
490	* CPUbNóÔÌQÆ
491	*/
492	#ifdef TOPPERS_sns_loc
493
494	bool_t
495	sns_loc(void)
496	{
497	bool_t state;
498
499	LOG_SNS_LOC_ENTER();
500	state = x_sense_lock() ? true : false;
501	LOG_SNS_LOC_LEAVE(state);
502	return(state);
503	}
504
505	#endif /* TOPPERS_sns_loc */
506
507	/*
508	* fBXpb`Ö~óÔÌQÆ
509	*/
510	#ifdef TOPPERS_sns_dsp
511
512	bool_t
513	sns_dsp(void)
514	{
515	bool_t state;
516
517	LOG_SNS_DSP_ENTER();
518	state = disdsp;
519	LOG_SNS_DSP_LEAVE(state);
520	return(state);
521	}
522
523	#endif /* TOPPERS_sns_dsp */
524
525	/*
526	* fBXpb`Û¯óÔÌQÆ
527	*/
528	#ifdef TOPPERS_sns_dpn
529
530	bool_t
531	sns_dpn(void)
532	{
533	bool_t state;
534
535	LOG_SNS_DPN_ENTER();
536	state = (sense_context() \|\| t_sense_lock() \|\| !dspflg) ? true : false;
537	LOG_SNS_DPN_LEAVE(state);
538	return(state);
539	}
540
541	#endif /* TOPPERS_sns_dpn */
542
543	/*
544	* J[lñ®ìóÔÌQÆ
545	*/
546	#ifdef TOPPERS_sns_ker
547
548	bool_t
549	sns_ker(void)
550	{
551	bool_t state;
552
553	LOG_SNS_KER_ENTER();
554	state = kerflg ? false : true;
555	LOG_SNS_KER_LEAVE(state);
556	return(state);
557	}
558
559	#endif /* TOPPERS_sns_ker */

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

Context Navigation

source: asp_ewarm/asp-1.7.0/extension/rstr_task/kernel/sys_manage.c@ 61

Download in other formats: