Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

sys_manage.c@ 136

Last change on this file since 136 was 136, checked in by ertl-honda, 8 years ago
ライブラリとOS及びベーシックなサンプルの追加．
File size: 10.7 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	* ä¸è¨èä½æ¨©è
12	ã¯ï¼ä»¥ä¸ã®(1)ï½(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
13	* ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ãä½¿ç¨ã»è¤è£½ã»æ¹
14	* å¤ã»åé
15	å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
16	* (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
17	* æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
18	* ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
19	* (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
20	* ç¨ã§ããå½¢ã§åé
21	å¸ããå ´åã«ã¯ï¼åé
22	å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
23	* è
24	ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
25	* ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
26	* (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
27	* ç¨ã§ããªãå½¢ã§åé
28	å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
29	* ã¨ï¼
30	* (a) åé
31	å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
32	ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
33	* ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
34	* (b) åé
35	å¸ã®å½¢æ
36	ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
37	* å ±åãããã¨ï¼
38	* (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
39	* å®³ãããï¼ä¸è¨èä½æ¨©è
40	ããã³TOPPERSããã¸ã§ã¯ããå
41	è²¬ãããã¨ï¼
42	* ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãç
43	* ç±ã«åºã¥ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
44	ããã³TOPPERSããã¸ã§ã¯ãã
45	* å
46	è²¬ãããã¨ï¼
47	*
48	* æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
49	ã
50	* ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç
51	* ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§
52	* ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæå®³ã«é¢ãã¦ãï¼ã
53	* ã®è²¬ä»»ãè² ããªãï¼
54	*
55	* @(#) $Id: sys_manage.c 2008 2010-12-31 12:41:42Z ertl-hiro $
56	*/
57
58	/*
59	* ã·ã¹ãã ç¶æ
60	ç®¡çæ©è½
61	*/
62
63	#include "kernel_impl.h"
64	#include "check.h"
65	#include "task.h"
66
67	/*
68	* ãã¬ã¼ã¹ãã°ãã¯ãã®ããã©ã«ãå®ç¾©
69	*/
70	#ifndef LOG_ROT_RDQ_ENTER
71	#define LOG_ROT_RDQ_ENTER(tskpri)
72	#endif /* LOG_ROT_RDQ_ENTER */
73
74	#ifndef LOG_ROT_RDQ_LEAVE
75	#define LOG_ROT_RDQ_LEAVE(ercd)
76	#endif /* LOG_ROT_RDQ_LEAVE */
77
78	#ifndef LOG_IROT_RDQ_ENTER
79	#define LOG_IROT_RDQ_ENTER(tskpri)
80	#endif /* LOG_IROT_RDQ_ENTER */
81
82	#ifndef LOG_IROT_RDQ_LEAVE
83	#define LOG_IROT_RDQ_LEAVE(ercd)
84	#endif /* LOG_IROT_RDQ_LEAVE */
85
86	#ifndef LOG_GET_TID_ENTER
87	#define LOG_GET_TID_ENTER(p_tskid)
88	#endif /* LOG_GET_TID_ENTER */
89
90	#ifndef LOG_GET_TID_LEAVE
91	#define LOG_GET_TID_LEAVE(ercd, tskid)
92	#endif /* LOG_GET_TID_LEAVE */
93
94	#ifndef LOG_IGET_TID_ENTER
95	#define LOG_IGET_TID_ENTER(p_tskid)
96	#endif /* LOG_IGET_TID_ENTER */
97
98	#ifndef LOG_IGET_TID_LEAVE
99	#define LOG_IGET_TID_LEAVE(ercd, tskid)
100	#endif /* LOG_IGET_TID_LEAVE */
101
102	#ifndef LOG_LOC_CPU_ENTER
103	#define LOG_LOC_CPU_ENTER()
104	#endif /* LOG_LOC_CPU_ENTER */
105
106	#ifndef LOG_LOC_CPU_LEAVE
107	#define LOG_LOC_CPU_LEAVE(ercd)
108	#endif /* LOG_LOC_CPU_LEAVE */
109
110	#ifndef LOG_ILOC_CPU_ENTER
111	#define LOG_ILOC_CPU_ENTER()
112	#endif /* LOG_ILOC_CPU_ENTER */
113
114	#ifndef LOG_ILOC_CPU_LEAVE
115	#define LOG_ILOC_CPU_LEAVE(ercd)
116	#endif /* LOG_ILOC_CPU_LEAVE */
117
118	#ifndef LOG_UNL_CPU_ENTER
119	#define LOG_UNL_CPU_ENTER()
120	#endif /* LOG_UNL_CPU_ENTER */
121
122	#ifndef LOG_UNL_CPU_LEAVE
123	#define LOG_UNL_CPU_LEAVE(ercd)
124	#endif /* LOG_UNL_CPU_LEAVE */
125
126	#ifndef LOG_IUNL_CPU_ENTER
127	#define LOG_IUNL_CPU_ENTER()
128	#endif /* LOG_IUNL_CPU_ENTER */
129
130	#ifndef LOG_IUNL_CPU_LEAVE
131	#define LOG_IUNL_CPU_LEAVE(ercd)
132	#endif /* LOG_IUNL_CPU_LEAVE */
133
134	#ifndef LOG_DIS_DSP_ENTER
135	#define LOG_DIS_DSP_ENTER()
136	#endif /* LOG_DIS_DSP_ENTER */
137
138	#ifndef LOG_DIS_DSP_LEAVE
139	#define LOG_DIS_DSP_LEAVE(ercd)
140	#endif /* LOG_DIS_DSP_LEAVE */
141
142	#ifndef LOG_ENA_DSP_ENTER
143	#define LOG_ENA_DSP_ENTER()
144	#endif /* LOG_ENA_DSP_ENTER */
145
146	#ifndef LOG_ENA_DSP_LEAVE
147	#define LOG_ENA_DSP_LEAVE(ercd)
148	#endif /* LOG_ENA_DSP_LEAVE */
149
150	#ifndef LOG_SNS_CTX_ENTER
151	#define LOG_SNS_CTX_ENTER()
152	#endif /* LOG_SNS_CTX_ENTER */
153
154	#ifndef LOG_SNS_CTX_LEAVE
155	#define LOG_SNS_CTX_LEAVE(state)
156	#endif /* LOG_SNS_CTX_LEAVE */
157
158	#ifndef LOG_SNS_LOC_ENTER
159	#define LOG_SNS_LOC_ENTER()
160	#endif /* LOG_SNS_LOC_ENTER */
161
162	#ifndef LOG_SNS_LOC_LEAVE
163	#define LOG_SNS_LOC_LEAVE(state)
164	#endif /* LOG_SNS_LOC_LEAVE */
165
166	#ifndef LOG_SNS_DSP_ENTER
167	#define LOG_SNS_DSP_ENTER()
168	#endif /* LOG_SNS_DSP_ENTER */
169
170	#ifndef LOG_SNS_DSP_LEAVE
171	#define LOG_SNS_DSP_LEAVE(state)
172	#endif /* LOG_SNS_DSP_LEAVE */
173
174	#ifndef LOG_SNS_DPN_ENTER
175	#define LOG_SNS_DPN_ENTER()
176	#endif /* LOG_SNS_DPN_ENTER */
177
178	#ifndef LOG_SNS_DPN_LEAVE
179	#define LOG_SNS_DPN_LEAVE(state)
180	#endif /* LOG_SNS_DPN_LEAVE */
181
182	#ifndef LOG_SNS_KER_ENTER
183	#define LOG_SNS_KER_ENTER()
184	#endif /* LOG_SNS_KER_ENTER */
185
186	#ifndef LOG_SNS_KER_LEAVE
187	#define LOG_SNS_KER_LEAVE(state)
188	#endif /* LOG_SNS_KER_LEAVE */
189
190	/*
191	* ã¿ã¹ã¯ã®åªå
192	é ä½ã®åè»¢
193	*/
194	#ifdef TOPPERS_rot_rdq
195
196	ER
197	rot_rdq(PRI tskpri)
198	{
199	uint_t pri;
200	ER ercd;
201
202	LOG_ROT_RDQ_ENTER(tskpri);
203	CHECK_TSKCTX_UNL();
204	CHECK_TPRI_SELF(tskpri);
205
206	t_lock_cpu();
207	pri = (tskpri == TPRI_SELF) ? p_runtsk->priority : INT_PRIORITY(tskpri);
208	if (rotate_ready_queue(pri)) {
209	dispatch();
210	}
211	ercd = E_OK;
212	t_unlock_cpu();
213
214	error_exit:
215	LOG_ROT_RDQ_LEAVE(ercd);
216	return(ercd);
217	}
218
219	#endif /* TOPPERS_rot_rdq */
220
221	/*
222	* ã¿ã¹ã¯ã®åªå
223	é ä½ã®åè»¢ï¼éã¿ã¹ã¯ã³ã³ããã¹ãç¨ï¼
224	*/
225	#ifdef TOPPERS_irot_rdq
226
227	ER
228	irot_rdq(PRI tskpri)
229	{
230	ER ercd;
231
232	LOG_IROT_RDQ_ENTER(tskpri);
233	CHECK_INTCTX_UNL();
234	CHECK_TPRI(tskpri);
235
236	i_lock_cpu();
237	if (rotate_ready_queue(INT_PRIORITY(tskpri))) {
238	reqflg = true;
239	}
240	ercd = E_OK;
241	i_unlock_cpu();
242
243	error_exit:
244	LOG_IROT_RDQ_LEAVE(ercd);
245	return(ercd);
246	}
247
248	#endif /* TOPPERS_irot_rdq */
249
250	/*
251	* å®è¡ç¶æ
252	ã®ã¿ã¹ã¯IDã®åç
253	§
254	*/
255	#ifdef TOPPERS_get_tid
256
257	ER
258	get_tid(ID *p_tskid)
259	{
260	ER ercd;
261
262	LOG_GET_TID_ENTER(p_tskid);
263	CHECK_TSKCTX_UNL();
264
265	t_lock_cpu();
266	*p_tskid = TSKID(p_runtsk);
267	ercd = E_OK;
268	t_unlock_cpu();
269
270	error_exit:
271	LOG_GET_TID_LEAVE(ercd, *p_tskid);
272	return(ercd);
273	}
274
275	#endif /* TOPPERS_get_tid */
276
277	/*
278	* å®è¡ç¶æ
279	ã®ã¿ã¹ã¯IDã®åç
280	§ï¼éã¿ã¹ã¯ã³ã³ããã¹ãç¨ï¼
281	*/
282	#ifdef TOPPERS_iget_tid
283
284	ER
285	iget_tid(ID *p_tskid)
286	{
287	ER ercd;
288
289	LOG_IGET_TID_ENTER(p_tskid);
290	CHECK_INTCTX_UNL();
291
292	i_lock_cpu();
293	*p_tskid = (p_runtsk == NULL) ? TSK_NONE : TSKID(p_runtsk);
294	ercd = E_OK;
295	i_unlock_cpu();
296
297	error_exit:
298	LOG_IGET_TID_LEAVE(ercd, *p_tskid);
299	return(ercd);
300	}
301
302	#endif /* TOPPERS_iget_tid */
303
304	/*
305	* CPUããã¯ç¶æ
306	ã¸ã®ç§»è¡
307	*/
308	#ifdef TOPPERS_loc_cpu
309
310	ER
311	loc_cpu(void)
312	{
313	ER ercd;
314
315	LOG_LOC_CPU_ENTER();
316	CHECK_TSKCTX();
317
318	if (!t_sense_lock()) {
319	t_lock_cpu();
320	}
321	ercd = E_OK;
322
323	error_exit:
324	LOG_LOC_CPU_LEAVE(ercd);
325	return(ercd);
326	}
327
328	#endif /* TOPPERS_loc_cpu */
329
330	/*
331	* CPUããã¯ç¶æ
332	ã¸ã®ç§»è¡ï¼éã¿ã¹ã¯ã³ã³ããã¹ãç¨ï¼
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	* CPUããã¯ç¶æ
358	ã®è§£é¤
359	*
360	* CPUããã¯ä¸ã¯ï¼ãã£ã¹ããããå¿
361	è¦ã¨ãªããµã¼ãã¹ã³ã¼ã«ãå¼ã³åºãã
362	* ã¨ã¯ã§ããªãããï¼CPUããã¯ç¶æ
363	ã®è§£é¤æã«ãã£ã¹ãããã£ãèµ·åãã
364	* å¿
365	è¦ã¯ãªãï¼
366	*/
367	#ifdef TOPPERS_unl_cpu
368
369	ER
370	unl_cpu(void)
371	{
372	ER ercd;
373
374	LOG_UNL_CPU_ENTER();
375	CHECK_TSKCTX();
376
377	if (t_sense_lock()) {
378	t_unlock_cpu();
379	}
380	ercd = E_OK;
381
382	error_exit:
383	LOG_UNL_CPU_LEAVE(ercd);
384	return(ercd);
385	}
386
387	#endif /* TOPPERS_unl_cpu */
388
389	/*
390	* CPUããã¯ç¶æ
391	ã®è§£é¤ï¼éã¿ã¹ã¯ã³ã³ããã¹ãç¨ï¼
392	*
393	* CPUããã¯ä¸ã¯ï¼ãã£ã¹ããããå¿
394	è¦ã¨ãªããµã¼ãã¹ã³ã¼ã«ãå¼ã³åºãã
395	* ã¨ã¯ã§ããªãããï¼CPUããã¯ç¶æ
396	ã®è§£é¤æã«ãã£ã¹ãããã£ã®èµ·åãè¦
397	* æ±ããå¿
398	è¦ã¯ãªãï¼
399	*/
400	#ifdef TOPPERS_iunl_cpu
401
402	ER
403	iunl_cpu(void)
404	{
405	ER ercd;
406
407	LOG_IUNL_CPU_ENTER();
408	CHECK_INTCTX();
409
410	if (i_sense_lock()) {
411	i_unlock_cpu();
412	}
413	ercd = E_OK;
414
415	error_exit:
416	LOG_IUNL_CPU_LEAVE(ercd);
417	return(ercd);
418	}
419
420	#endif /* TOPPERS_iunl_cpu */
421
422	/*
423	* ãã£ã¹ãããã®ç¦æ¢
424	*/
425	#ifdef TOPPERS_dis_dsp
426
427	ER
428	dis_dsp(void)
429	{
430	ER ercd;
431
432	LOG_DIS_DSP_ENTER();
433	CHECK_TSKCTX_UNL();
434
435	t_lock_cpu();
436	disdsp = true;
437	dspflg = false;
438	ercd = E_OK;
439	t_unlock_cpu();
440
441	error_exit:
442	LOG_DIS_DSP_LEAVE(ercd);
443	return(ercd);
444	}
445
446	#endif /* TOPPERS_dis_dsp */
447
448	/*
449	* ãã£ã¹ãããã®è¨±å¯
450	*/
451	#ifdef TOPPERS_ena_dsp
452
453	ER
454	ena_dsp(void)
455	{
456	ER ercd;
457
458	LOG_ENA_DSP_ENTER();
459	CHECK_TSKCTX_UNL();
460
461	t_lock_cpu();
462	disdsp = false;
463	if (ipmflg) {
464	dspflg = true;
465	if (p_runtsk != p_schedtsk) {
466	dispatch();
467	}
468	}
469	ercd = E_OK;
470	t_unlock_cpu();
471
472	error_exit:
473	LOG_ENA_DSP_LEAVE(ercd);
474	return(ercd);
475	}
476
477	#endif /* TOPPERS_ena_dsp */
478
479	/*
480	* ã³ã³ããã¹ãã®åç
481	§
482	*/
483	#ifdef TOPPERS_sns_ctx
484
485	bool_t
486	sns_ctx(void)
487	{
488	bool_t state;
489
490	LOG_SNS_CTX_ENTER();
491	state = sense_context() ? true : false;
492	LOG_SNS_CTX_LEAVE(state);
493	return(state);
494	}
495
496	#endif /* TOPPERS_sns_ctx */
497
498	/*
499	* CPUããã¯ç¶æ
500	ã®åç
501	§
502	*/
503	#ifdef TOPPERS_sns_loc
504
505	bool_t
506	sns_loc(void)
507	{
508	bool_t state;
509
510	LOG_SNS_LOC_ENTER();
511	state = x_sense_lock() ? true : false;
512	LOG_SNS_LOC_LEAVE(state);
513	return(state);
514	}
515
516	#endif /* TOPPERS_sns_loc */
517
518	/*
519	* ãã£ã¹ãããç¦æ¢ç¶æ
520	ã®åç
521	§
522	*/
523	#ifdef TOPPERS_sns_dsp
524
525	bool_t
526	sns_dsp(void)
527	{
528	bool_t state;
529
530	LOG_SNS_DSP_ENTER();
531	state = disdsp;
532	LOG_SNS_DSP_LEAVE(state);
533	return(state);
534	}
535
536	#endif /* TOPPERS_sns_dsp */
537
538	/*
539	* ãã£ã¹ãããä¿çç¶æ
540	ã®åç
541	§
542	*/
543	#ifdef TOPPERS_sns_dpn
544
545	bool_t
546	sns_dpn(void)
547	{
548	bool_t state;
549
550	LOG_SNS_DPN_ENTER();
551	state = (sense_context() \|\| t_sense_lock() \|\| !dspflg) ? true : false;
552	LOG_SNS_DPN_LEAVE(state);
553	return(state);
554	}
555
556	#endif /* TOPPERS_sns_dpn */
557
558	/*
559	* ã«ã¼ãã«éåä½ç¶æ
560	ã®åç
561	§
562	*/
563	#ifdef TOPPERS_sns_ker
564
565	bool_t
566	sns_ker(void)
567	{
568	bool_t state;
569
570	LOG_SNS_KER_ENTER();
571	state = kerflg ? false : true;
572	LOG_SNS_KER_LEAVE(state);
573	return(state);
574	}
575
576	#endif /* TOPPERS_sns_ker */

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

Context Navigation

source: rtos_arduino/trunk/asp_1.9.2/kernel/sys_manage.c@ 136

Download in other formats: