Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: asp3_wo_tecs/trunk/extension/subprio/kernel/sys_manage.c@ 302

Last change on this file since 302 was 302, checked in by ertl-honda, 7 years ago
TECSレスのASP3の開発のため以下のtrunkからコピー http://dev.toppers.jp/svn/asp3/branches/WO_TECS-3.C.0
File size: 10.4 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-2015 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 470 2015-12-30 09:50:36Z 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_GET_TID_ENTER
79	#define LOG_GET_TID_ENTER(p_tskid)
80	#endif /* LOG_GET_TID_ENTER */
81
82	#ifndef LOG_GET_TID_LEAVE
83	#define LOG_GET_TID_LEAVE(ercd, p_tskid)
84	#endif /* LOG_GET_TID_LEAVE */
85
86	#ifndef LOG_GET_LOD_ENTER
87	#define LOG_GET_LOD_ENTER(tskpri, p_load)
88	#endif /* LOG_GET_LOD_ENTER */
89
90	#ifndef LOG_GET_LOD_LEAVE
91	#define LOG_GET_LOD_LEAVE(ercd, p_load)
92	#endif /* LOG_GET_LOD_LEAVE */
93
94	#ifndef LOG_GET_NTH_ENTER
95	#define LOG_GET_NTH_ENTER(tskpri, nth, p_tskid)
96	#endif /* LOG_GET_NTH_ENTER */
97
98	#ifndef LOG_GET_NTH_LEAVE
99	#define LOG_GET_NTH_LEAVE(ercd, p_tskid)
100	#endif /* LOG_GET_NTH_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_UNL_CPU_ENTER
111	#define LOG_UNL_CPU_ENTER()
112	#endif /* LOG_UNL_CPU_ENTER */
113
114	#ifndef LOG_UNL_CPU_LEAVE
115	#define LOG_UNL_CPU_LEAVE(ercd)
116	#endif /* LOG_UNL_CPU_LEAVE */
117
118	#ifndef LOG_DIS_DSP_ENTER
119	#define LOG_DIS_DSP_ENTER()
120	#endif /* LOG_DIS_DSP_ENTER */
121
122	#ifndef LOG_DIS_DSP_LEAVE
123	#define LOG_DIS_DSP_LEAVE(ercd)
124	#endif /* LOG_DIS_DSP_LEAVE */
125
126	#ifndef LOG_ENA_DSP_ENTER
127	#define LOG_ENA_DSP_ENTER()
128	#endif /* LOG_ENA_DSP_ENTER */
129
130	#ifndef LOG_ENA_DSP_LEAVE
131	#define LOG_ENA_DSP_LEAVE(ercd)
132	#endif /* LOG_ENA_DSP_LEAVE */
133
134	#ifndef LOG_SNS_CTX_ENTER
135	#define LOG_SNS_CTX_ENTER()
136	#endif /* LOG_SNS_CTX_ENTER */
137
138	#ifndef LOG_SNS_CTX_LEAVE
139	#define LOG_SNS_CTX_LEAVE(state)
140	#endif /* LOG_SNS_CTX_LEAVE */
141
142	#ifndef LOG_SNS_LOC_ENTER
143	#define LOG_SNS_LOC_ENTER()
144	#endif /* LOG_SNS_LOC_ENTER */
145
146	#ifndef LOG_SNS_LOC_LEAVE
147	#define LOG_SNS_LOC_LEAVE(state)
148	#endif /* LOG_SNS_LOC_LEAVE */
149
150	#ifndef LOG_SNS_DSP_ENTER
151	#define LOG_SNS_DSP_ENTER()
152	#endif /* LOG_SNS_DSP_ENTER */
153
154	#ifndef LOG_SNS_DSP_LEAVE
155	#define LOG_SNS_DSP_LEAVE(state)
156	#endif /* LOG_SNS_DSP_LEAVE */
157
158	#ifndef LOG_SNS_DPN_ENTER
159	#define LOG_SNS_DPN_ENTER()
160	#endif /* LOG_SNS_DPN_ENTER */
161
162	#ifndef LOG_SNS_DPN_LEAVE
163	#define LOG_SNS_DPN_LEAVE(state)
164	#endif /* LOG_SNS_DPN_LEAVE */
165
166	#ifndef LOG_SNS_KER_ENTER
167	#define LOG_SNS_KER_ENTER()
168	#endif /* LOG_SNS_KER_ENTER */
169
170	#ifndef LOG_SNS_KER_LEAVE
171	#define LOG_SNS_KER_LEAVE(state)
172	#endif /* LOG_SNS_KER_LEAVE */
173
174	/*
175	* ã¿ã¹ã¯ã®åªå
176	é ä½ã®åè»¢
177	*/
178	#ifdef TOPPERS_rot_rdq
179
180	ER
181	rot_rdq(PRI tskpri)
182	{
183	uint_t pri;
184	ER ercd;
185
186	LOG_ROT_RDQ_ENTER(tskpri);
187	CHECK_UNL();
188	if (tskpri == TPRI_SELF && !sense_context()) {
189	pri = p_runtsk->bpriority;
190	}
191	else {
192	CHECK_PAR(VALID_TPRI(tskpri));
193	pri = INT_PRIORITY(tskpri);
194	}
195	CHECK_ILUSE((subprio_primap & PRIMAP_BIT(pri)) == 0U);
196
197	lock_cpu();
198	rotate_ready_queue(&(ready_queue[pri]));
199	if (p_runtsk != p_schedtsk) {
200	if (!sense_context()) {
201	dispatch();
202	}
203	else {
204	request_dispatch();
205	}
206	}
207	ercd = E_OK;
208	unlock_cpu();
209
210	error_exit:
211	LOG_ROT_RDQ_LEAVE(ercd);
212	return(ercd);
213	}
214
215	#endif /* TOPPERS_rot_rdq */
216
217	/*
218	* å®è¡ç¶æ
219	ã®ã¿ã¹ã¯IDã®åç
220	§
221	*/
222	#ifdef TOPPERS_get_tid
223
224	ER
225	get_tid(ID *p_tskid)
226	{
227	ER ercd;
228
229	LOG_GET_TID_ENTER(p_tskid);
230	CHECK_UNL();
231
232	lock_cpu();
233	*p_tskid = (p_runtsk == NULL) ? TSK_NONE : TSKID(p_runtsk);
234	ercd = E_OK;
235	unlock_cpu();
236
237	error_exit:
238	LOG_GET_TID_LEAVE(ercd, p_tskid);
239	return(ercd);
240	}
241
242	#endif /* TOPPERS_get_tid */
243
244	/*
245	* å®è¡ã§ããã¿ã¹ã¯ã®æ°ã®åç
246	§
247	*/
248	#ifdef TOPPERS_get_lod
249
250	ER
251	get_lod(PRI tskpri, uint_t *p_load)
252	{
253	uint_t pri, load;
254	QUEUE p_queue, p_entry;
255	ER ercd;
256
257	LOG_GET_LOD_ENTER(p_tskid, p_load);
258	CHECK_TSKCTX_UNL();
259	if (tskpri == TPRI_SELF) {
260	pri = p_runtsk->bpriority;
261	}
262	else {
263	CHECK_PAR(VALID_TPRI(tskpri));
264	pri = INT_PRIORITY(tskpri);
265	}
266	p_queue = &(ready_queue[pri]);
267
268	lock_cpu();
269	load = 0U;
270	for (p_entry = p_queue->p_next; p_entry != p_queue;
271	p_entry = p_entry->p_next) {
272	load += 1U;
273	}
274	*p_load = load;
275	ercd = E_OK;
276	unlock_cpu();
277
278	error_exit:
279	LOG_GET_LOD_LEAVE(ercd, p_load);
280	return(ercd);
281	}
282
283	#endif /* TOPPERS_get_lod */
284
285	/*
286	* æå®ããåªå
287	é ä½ã®ã¿ã¹ã¯IDã®åç
288	§
289	*/
290	#ifdef TOPPERS_get_nth
291
292	ER
293	get_nth(PRI tskpri, uint_t nth, ID *p_tskid)
294	{
295	uint_t pri;
296	QUEUE p_queue, p_entry;
297	ID tskid;
298	ER ercd;
299
300	LOG_GET_NTH_ENTER(p_tskid, nth, p_tskid);
301	CHECK_TSKCTX_UNL();
302	if (tskpri == TPRI_SELF) {
303	pri = p_runtsk->bpriority;
304	}
305	else {
306	CHECK_PAR(VALID_TPRI(tskpri));
307	pri = INT_PRIORITY(tskpri);
308	}
309	p_queue = &(ready_queue[pri]);
310
311	lock_cpu();
312	tskid = TSK_NONE;
313	for (p_entry = p_queue->p_next; p_entry != p_queue;
314	p_entry = p_entry->p_next) {
315	if (nth == 0U) {
316	tskid = TSKID((TCB *) p_entry);
317	break;
318	}
319	nth -= 1U;
320	}
321	*p_tskid = tskid;
322	ercd = E_OK;
323	unlock_cpu();
324
325	error_exit:
326	LOG_GET_NTH_LEAVE(ercd, p_tskid);
327	return(ercd);
328	}
329
330	#endif /* TOPPERS_get_nth */
331
332	/*
333	* CPUããã¯ç¶æ
334	ã¸ã®é·ç§»
335	*/
336	#ifdef TOPPERS_loc_cpu
337
338	ER
339	loc_cpu(void)
340	{
341	ER ercd;
342
343	LOG_LOC_CPU_ENTER();
344
345	if (!sense_lock()) {
346	lock_cpu();
347	}
348	ercd = E_OK;
349
350	LOG_LOC_CPU_LEAVE(ercd);
351	return(ercd);
352	}
353
354	#endif /* TOPPERS_loc_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
376	if (sense_lock()) {
377	unlock_cpu();
378	}
379	ercd = E_OK;
380
381	LOG_UNL_CPU_LEAVE(ercd);
382	return(ercd);
383	}
384
385	#endif /* TOPPERS_unl_cpu */
386
387	/*
388	* ãã£ã¹ãããã®ç¦æ¢
389	*/
390	#ifdef TOPPERS_dis_dsp
391
392	ER
393	dis_dsp(void)
394	{
395	ER ercd;
396
397	LOG_DIS_DSP_ENTER();
398	CHECK_TSKCTX_UNL();
399
400	lock_cpu();
401	enadsp = false;
402	dspflg = false;
403	ercd = E_OK;
404	unlock_cpu();
405
406	error_exit:
407	LOG_DIS_DSP_LEAVE(ercd);
408	return(ercd);
409	}
410
411	#endif /* TOPPERS_dis_dsp */
412
413	/*
414	* ãã£ã¹ãããã®è¨±å¯
415	*/
416	#ifdef TOPPERS_ena_dsp
417
418	ER
419	ena_dsp(void)
420	{
421	ER ercd;
422
423	LOG_ENA_DSP_ENTER();
424	CHECK_TSKCTX_UNL();
425
426	lock_cpu();
427	enadsp = true;
428	if (t_get_ipm() == TIPM_ENAALL) {
429	dspflg = true;
430	p_schedtsk = search_schedtsk();
431	if (p_runtsk->raster && p_runtsk->enater) {
432	task_terminate(p_runtsk);
433	exit_and_dispatch();
434	ercd = E_SYS;
435	}
436	else {
437	if (p_runtsk != p_schedtsk) {
438	dispatch();
439	}
440	ercd = E_OK;
441	}
442	}
443	else {
444	ercd = E_OK;
445	}
446	unlock_cpu();
447
448	error_exit:
449	LOG_ENA_DSP_LEAVE(ercd);
450	return(ercd);
451	}
452
453	#endif /* TOPPERS_ena_dsp */
454
455	/*
456	* ã³ã³ããã¹ãã®åç
457	§
458	*/
459	#ifdef TOPPERS_sns_ctx
460
461	bool_t
462	sns_ctx(void)
463	{
464	bool_t state;
465
466	LOG_SNS_CTX_ENTER();
467	state = sense_context() ? true : false;
468	LOG_SNS_CTX_LEAVE(state);
469	return(state);
470	}
471
472	#endif /* TOPPERS_sns_ctx */
473
474	/*
475	* CPUããã¯ç¶æ
476	ã®åç
477	§
478	*/
479	#ifdef TOPPERS_sns_loc
480
481	bool_t
482	sns_loc(void)
483	{
484	bool_t state;
485
486	LOG_SNS_LOC_ENTER();
487	state = sense_lock() ? true : false;
488	LOG_SNS_LOC_LEAVE(state);
489	return(state);
490	}
491
492	#endif /* TOPPERS_sns_loc */
493
494	/*
495	* ãã£ã¹ãããç¦æ¢ç¶æ
496	ã®åç
497	§
498	*/
499	#ifdef TOPPERS_sns_dsp
500
501	bool_t
502	sns_dsp(void)
503	{
504	bool_t state;
505
506	LOG_SNS_DSP_ENTER();
507	state = !enadsp;
508	LOG_SNS_DSP_LEAVE(state);
509	return(state);
510	}
511
512	#endif /* TOPPERS_sns_dsp */
513
514	/*
515	* ãã£ã¹ãããä¿çç¶æ
516	ã®åç
517	§
518	*/
519	#ifdef TOPPERS_sns_dpn
520
521	bool_t
522	sns_dpn(void)
523	{
524	bool_t state;
525
526	LOG_SNS_DPN_ENTER();
527	state = (sense_context() \|\| sense_lock() \|\| !dspflg) ? true : false;
528	LOG_SNS_DPN_LEAVE(state);
529	return(state);
530	}
531
532	#endif /* TOPPERS_sns_dpn */
533
534	/*
535	* ã«ã¼ãã«éåä½ç¶æ
536	ã®åç
537	§
538	*/
539	#ifdef TOPPERS_sns_ker
540
541	bool_t
542	sns_ker(void)
543	{
544	bool_t state;
545
546	LOG_SNS_KER_ENTER();
547	state = kerflg ? false : true;
548	LOG_SNS_KER_LEAVE(state);
549	return(state);
550	}
551
552	#endif /* TOPPERS_sns_ker */

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

Download in other formats: