Context Navigation

← Previous Revision
Next Revision →
Normal
Revision Log

task_sync.c

Last change on this file was 429, checked in by coas-nagasima, 4 years ago
ASP3, TINET, mbed を更新
Property svn:eol-style set to `native` Property svn:mime-type set to `text/x-csrc;charset=UTF-8`
File size: 11.4 KB

Rev	Line
[270]	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
[429]	8	* Copyright (C) 2005-2018 by Embedded and Real-Time Systems Laboratory
[270]	9	* Graduate School of Information Science, Nagoya Univ., JAPAN
	10	*
	11	* 上記著作権者は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
	12	* ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
	13	* 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
	14	* (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
	15	* 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
	16	* スコード中に含まれていること．
	17	* (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
	18	* 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
	19	* 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
	20	* の無保証規定を掲載すること．
	21	* (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
	22	* 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
	23	* と．
	24	* (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
	25	* 作権表示，この利用条件および下記の無保証規定を掲載すること．
	26	* (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
	27	* 報告すること．
	28	* (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
	29	* 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
	30	* また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
	31	* 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
	32	* 免責すること．
	33	*
	34	* 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
	35	* よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
	36	* に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
	37	* アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
	38	* の責任を負わない．
	39	*
	40	* $Id$
	41	*/
	42
	43	/*
	44	* タスク付属同期機能
	45	*/
	46
	47	#include "kernel_impl.h"
	48	#include "check.h"
	49	#include "task.h"
	50	#include "wait.h"
	51
	52	/*
	53	* トレースログマクロのデフォルト定義
	54	*/
	55	#ifndef LOG_SLP_TSK_ENTER
	56	#define LOG_SLP_TSK_ENTER()
	57	#endif /* LOG_SLP_TSK_ENTER */
	58
	59	#ifndef LOG_SLP_TSK_LEAVE
	60	#define LOG_SLP_TSK_LEAVE(ercd)
	61	#endif /* LOG_SLP_TSK_LEAVE */
	62
	63	#ifndef LOG_TSLP_TSK_ENTER
	64	#define LOG_TSLP_TSK_ENTER(tmout)
	65	#endif /* LOG_TSLP_TSK_ENTER */
	66
	67	#ifndef LOG_TSLP_TSK_LEAVE
	68	#define LOG_TSLP_TSK_LEAVE(ercd)
	69	#endif /* LOG_TSLP_TSK_LEAVE */
	70
	71	#ifndef LOG_WUP_TSK_ENTER
	72	#define LOG_WUP_TSK_ENTER(tskid)
	73	#endif /* LOG_WUP_TSK_ENTER */
	74
	75	#ifndef LOG_WUP_TSK_LEAVE
	76	#define LOG_WUP_TSK_LEAVE(ercd)
	77	#endif /* LOG_WUP_TSK_LEAVE */
	78
	79	#ifndef LOG_CAN_WUP_ENTER
	80	#define LOG_CAN_WUP_ENTER(tskid)
	81	#endif /* LOG_CAN_WUP_ENTER */
	82
	83	#ifndef LOG_CAN_WUP_LEAVE
	84	#define LOG_CAN_WUP_LEAVE(ercd)
	85	#endif /* LOG_CAN_WUP_LEAVE */
	86
	87	#ifndef LOG_REL_WAI_ENTER
	88	#define LOG_REL_WAI_ENTER(tskid)
	89	#endif /* LOG_REL_WAI_ENTER */
	90
	91	#ifndef LOG_REL_WAI_LEAVE
	92	#define LOG_REL_WAI_LEAVE(ercd)
	93	#endif /* LOG_REL_WAI_LEAVE */
	94
	95	#ifndef LOG_SUS_TSK_ENTER
	96	#define LOG_SUS_TSK_ENTER(tskid)
	97	#endif /* LOG_SUS_TSK_ENTER */
	98
	99	#ifndef LOG_SUS_TSK_LEAVE
	100	#define LOG_SUS_TSK_LEAVE(ercd)
	101	#endif /* LOG_SUS_TSK_LEAVE */
	102
	103	#ifndef LOG_RSM_TSK_ENTER
	104	#define LOG_RSM_TSK_ENTER(tskid)
	105	#endif /* LOG_RSM_TSK_ENTER */
	106
	107	#ifndef LOG_RSM_TSK_LEAVE
	108	#define LOG_RSM_TSK_LEAVE(ercd)
	109	#endif /* LOG_RSM_TSK_LEAVE */
	110
	111	#ifndef LOG_DLY_TSK_ENTER
	112	#define LOG_DLY_TSK_ENTER(dlytim)
	113	#endif /* LOG_DLY_TSK_ENTER */
	114
	115	#ifndef LOG_DLY_TSK_LEAVE
	116	#define LOG_DLY_TSK_LEAVE(ercd)
	117	#endif /* LOG_DLY_TSK_LEAVE */
	118
	119	/*
[429]	120	* 起床待ち［NGKI1252］
[270]	121	*/
	122	#ifdef TOPPERS_slp_tsk
	123
	124	ER
	125	slp_tsk(void)
	126	{
	127	WINFO winfo;
	128	ER ercd;
	129
	130	LOG_SLP_TSK_ENTER();
[429]	131	CHECK_DISPATCH(); /［NGKI1254］/
[270]	132
	133	lock_cpu_dsp();
	134	if (p_runtsk->raster) {
[429]	135	ercd = E_RASTER; /［NGKI3455］/
[270]	136	}
	137	else if (p_runtsk->wupque) {
[429]	138	p_runtsk->wupque = false; /［NGKI1259］/
[270]	139	ercd = E_OK;
	140	}
	141	else {
[429]	142	make_wait(TS_WAITING_SLP, &winfo); /［NGKI1260］/
[270]	143	LOG_TSKSTAT(p_runtsk);
	144	dispatch();
	145	ercd = winfo.wercd;
	146	}
	147	unlock_cpu_dsp();
	148
	149	error_exit:
	150	LOG_SLP_TSK_LEAVE(ercd);
	151	return(ercd);
	152	}
	153
	154	#endif /* TOPPERS_slp_tsk */
	155
	156	/*
[429]	157	* 起床待ち（タイムアウトあり）［NGKI1253］
[270]	158	*/
	159	#ifdef TOPPERS_tslp_tsk
	160
	161	ER
	162	tslp_tsk(TMO tmout)
	163	{
	164	WINFO winfo;
	165	TMEVTB tmevtb;
	166	ER ercd;
	167
	168	LOG_TSLP_TSK_ENTER(tmout);
[429]	169	CHECK_DISPATCH(); /［NGKI1254］/
	170	CHECK_PAR(VALID_TMOUT(tmout)); /［NGKI1256］/
[270]	171
	172	lock_cpu_dsp();
	173	if (p_runtsk->raster) {
[429]	174	ercd = E_RASTER; /［NGKI3455］/
[270]	175	}
	176	else if (p_runtsk->wupque) {
[429]	177	p_runtsk->wupque = false; /［NGKI1259］/
[270]	178	ercd = E_OK;
	179	}
	180	else if (tmout == TMO_POL) {
[429]	181	ercd = E_TMOUT; /［NGKI1257］/
[270]	182	}
[429]	183	else { /［NGKI1260］/
	184	make_wait_tmout(TS_WAITING_SLP, &winfo, &tmevtb, tmout);
[270]	185	LOG_TSKSTAT(p_runtsk);
	186	dispatch();
	187	ercd = winfo.wercd;
	188	}
	189	unlock_cpu_dsp();
	190
	191	error_exit:
	192	LOG_TSLP_TSK_LEAVE(ercd);
	193	return(ercd);
	194	}
	195
	196	#endif /* TOPPERS_tslp_tsk */
	197
	198	/*
[429]	199	* タスクの起床［NGKI3531］
[270]	200	*/
	201	#ifdef TOPPERS_wup_tsk
	202
	203	ER
	204	wup_tsk(ID tskid)
	205	{
	206	TCB *p_tcb;
	207	ER ercd;
	208
	209	LOG_WUP_TSK_ENTER(tskid);
[429]	210	CHECK_UNL(); /［NGKI1265］/
[270]	211	if (tskid == TSK_SELF && !sense_context()) {
[429]	212	p_tcb = p_runtsk; /［NGKI1275］/
[270]	213	}
	214	else {
[429]	215	CHECK_ID(VALID_TSKID(tskid)); /［NGKI1267］/
[270]	216	p_tcb = get_tcb(tskid);
	217	}
	218
	219	lock_cpu();
	220	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
[429]	221	ercd = E_NOEXS; /［NGKI1268］/
[270]	222	}
	223	else if (TSTAT_DORMANT(p_tcb->tstat)) {
[429]	224	ercd = E_OBJ; /［NGKI1270］/
[270]	225	}
	226	else if (TSTAT_WAIT_SLP(p_tcb->tstat)) {
[429]	227	wait_complete(p_tcb); /［NGKI1271］/
[270]	228	if (p_runtsk != p_schedtsk) {
	229	if (!sense_context()) {
	230	dispatch();
	231	}
	232	else {
[429]	233	request_dispatch_retint();
[270]	234	}
	235	}
	236	ercd = E_OK;
	237	}
	238	else if (!(p_tcb->wupque)) {
[429]	239	p_tcb->wupque = true; /［NGKI1273］/
[270]	240	ercd = E_OK;
	241	}
	242	else {
[429]	243	ercd = E_QOVR; /［NGKI1274］/
[270]	244	}
	245	unlock_cpu();
	246
	247	error_exit:
	248	LOG_WUP_TSK_LEAVE(ercd);
	249	return(ercd);
	250	}
	251
	252	#endif /* TOPPERS_wup_tsk */
	253
	254	/*
[429]	255	* タスク起床要求のキャンセル［NGKI1276］
[270]	256	*/
	257	#ifdef TOPPERS_can_wup
	258
	259	ER_UINT
	260	can_wup(ID tskid)
	261	{
	262	TCB *p_tcb;
	263	ER_UINT ercd;
	264
	265	LOG_CAN_WUP_ENTER(tskid);
[429]	266	CHECK_TSKCTX_UNL(); /［NGKI1277］［NGKI1278］/
[270]	267	if (tskid == TSK_SELF) {
[429]	268	p_tcb = p_runtsk; /［NGKI1285］/
[270]	269	}
	270	else {
[429]	271	CHECK_ID(VALID_TSKID(tskid)); /［NGKI1280］/
[270]	272	p_tcb = get_tcb(tskid);
	273	}
	274
	275	lock_cpu();
	276	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
[429]	277	ercd = E_NOEXS; /［NGKI1281］/
[270]	278	}
	279	else if (TSTAT_DORMANT(p_tcb->tstat)) {
[429]	280	ercd = E_OBJ; /［NGKI1283］/
[270]	281	}
	282	else {
[429]	283	ercd = p_tcb->wupque ? 1 : 0; /［NGKI1284］/
	284	p_tcb->wupque = false; /［NGKI1284］/
[270]	285	}
	286	unlock_cpu();
	287
	288	error_exit:
	289	LOG_CAN_WUP_LEAVE(ercd);
	290	return(ercd);
	291	}
	292
	293	#endif /* TOPPERS_can_wup */
	294
	295	/*
[429]	296	* 待ち状態の強制解除［NGKI3532］
[270]	297	*/
	298	#ifdef TOPPERS_rel_wai
	299
	300	ER
	301	rel_wai(ID tskid)
	302	{
	303	TCB *p_tcb;
	304	ER ercd;
	305
	306	LOG_REL_WAI_ENTER(tskid);
[429]	307	CHECK_UNL(); /［NGKI1290］/
	308	CHECK_ID(VALID_TSKID(tskid)); /［NGKI1292］/
[270]	309	p_tcb = get_tcb(tskid);
	310
	311	lock_cpu();
	312	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
[429]	313	ercd = E_NOEXS; /［NGKI1293］/
[270]	314	}
	315	else if (!TSTAT_WAITING(p_tcb->tstat)) {
[429]	316	ercd = E_OBJ; /［NGKI1295］/
[270]	317	}
	318	else {
[429]	319	wait_dequeue_wobj(p_tcb); /［NGKI1296］/
[270]	320	wait_dequeue_tmevtb(p_tcb);
[429]	321	p_tcb->p_winfo->wercd = E_RLWAI; /［NGKI1297］/
[270]	322	make_non_wait(p_tcb);
	323	if (p_runtsk != p_schedtsk) {
	324	if (!sense_context()) {
	325	dispatch();
	326	}
	327	else {
[429]	328	request_dispatch_retint();
[270]	329	}
	330	}
	331	ercd = E_OK;
	332	}
	333	unlock_cpu();
	334
	335	error_exit:
	336	LOG_REL_WAI_LEAVE(ercd);
	337	return(ercd);
	338	}
	339
	340	#endif /* TOPPERS_rel_wai */
	341
	342	/*
	343	* 強制待ち状態への移行［NGKI1298］
	344	*/
	345	#ifdef TOPPERS_sus_tsk
	346
	347	ER
	348	sus_tsk(ID tskid)
	349	{
	350	TCB *p_tcb;
	351	ER ercd;
	352
	353	LOG_SUS_TSK_ENTER(tskid);
	354	CHECK_TSKCTX_UNL(); /［NGKI1299］［NGKI1300］/
	355	if (tskid == TSK_SELF) {
	356	p_tcb = p_runtsk; /［NGKI1310］/
	357	}
	358	else {
	359	CHECK_ID(VALID_TSKID(tskid)); /［NGKI1302］/
	360	p_tcb = get_tcb(tskid);
	361	}
	362
	363	lock_cpu();
	364	if (p_tcb == p_runtsk && !dspflg) { /［NGKI1311］［NGKI3604］/
	365	ercd = E_CTX;
	366	}
	367	else if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
	368	ercd = E_NOEXS; /［NGKI1303］/
	369	}
	370	else if (TSTAT_DORMANT(p_tcb->tstat)) {
	371	ercd = E_OBJ; /［NGKI1305］/
	372	}
	373	else if (p_tcb->raster) {
	374	ercd = E_RASTER; /［NGKI3605］/
	375	}
	376	else if (TSTAT_RUNNABLE(p_tcb->tstat)) {
	377	/*
	378	* 実行できる状態から強制待ち状態への遷移［NGKI1307］
	379	*/
	380	p_tcb->tstat = TS_SUSPENDED;
	381	LOG_TSKSTAT(p_tcb);
	382	make_non_runnable(p_tcb);
	383	if (p_runtsk != p_schedtsk) {
	384	dispatch();
	385	}
	386	ercd = E_OK;
	387	}
	388	else if (TSTAT_SUSPENDED(p_tcb->tstat)) {
	389	ercd = E_QOVR; /［NGKI1306］/
	390	}
	391	else {
	392	/*
	393	* 待ち状態から二重待ち状態への遷移［NGKI1308］
	394	*/
	395	p_tcb->tstat \|= TS_SUSPENDED;
	396	LOG_TSKSTAT(p_tcb);
	397	ercd = E_OK;
	398	}
	399	unlock_cpu();
	400
	401	error_exit:
	402	LOG_SUS_TSK_LEAVE(ercd);
	403	return(ercd);
	404	}
	405
	406	#endif /* TOPPERS_sus_tsk */
	407
	408	/*
[429]	409	* 強制待ち状態からの再開［NGKI1312］
[270]	410	*/
	411	#ifdef TOPPERS_rsm_tsk
	412
	413	ER
	414	rsm_tsk(ID tskid)
	415	{
	416	TCB *p_tcb;
	417	ER ercd;
	418
	419	LOG_RSM_TSK_ENTER(tskid);
[429]	420	CHECK_TSKCTX_UNL(); /［NGKI1313］［NGKI1314］/
	421	CHECK_ID(VALID_TSKID(tskid)); /［NGKI1316］/
[270]	422	p_tcb = get_tcb(tskid);
	423
	424	lock_cpu();
	425	if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
[429]	426	ercd = E_NOEXS; /［NGKI1317］/
[270]	427	}
	428	else if (!TSTAT_SUSPENDED(p_tcb->tstat)) {
[429]	429	ercd = E_OBJ; /［NGKI1319］/
[270]	430	}
[429]	431	else {
[270]	432	/*
[429]	433	* 強制待ちからの再開［NGKI1320］
[270]	434	*/
[429]	435	if (!TSTAT_WAITING(p_tcb->tstat)) {
	436	p_tcb->tstat = TS_RUNNABLE;
	437	LOG_TSKSTAT(p_tcb);
	438	make_runnable(p_tcb);
	439	if (p_runtsk != p_schedtsk) {
	440	dispatch();
	441	}
[270]	442	}
[429]	443	else {
	444	p_tcb->tstat &= ~TS_SUSPENDED;
	445	LOG_TSKSTAT(p_tcb);
	446	}
[270]	447	ercd = E_OK;
	448	}
	449	unlock_cpu();
	450
	451	error_exit:
	452	LOG_RSM_TSK_LEAVE(ercd);
	453	return(ercd);
	454	}
	455
	456	#endif /* TOPPERS_rsm_tsk */
	457
	458	/*
[429]	459	* 自タスクの遅延［NGKI1348］
[270]	460	*/
	461	#ifdef TOPPERS_dly_tsk
	462
	463	ER
	464	dly_tsk(RELTIM dlytim)
	465	{
	466	WINFO winfo;
	467	TMEVTB tmevtb;
	468	ER ercd;
	469
	470	LOG_DLY_TSK_ENTER(dlytim);
[429]	471	CHECK_DISPATCH(); /［NGKI1349］/
	472	CHECK_PAR(VALID_RELTIM(dlytim)); /［NGKI1351］/
[270]	473
	474	lock_cpu_dsp();
	475	if (p_runtsk->raster) {
[429]	476	ercd = E_RASTER; /［NGKI3456］/
[270]	477	}
	478	else {
[429]	479	p_runtsk->tstat = TS_WAITING_DLY; /［NGKI1353］/
[270]	480	make_non_runnable(p_runtsk);
	481	p_runtsk->p_winfo = &winfo;
	482	winfo.p_tmevtb = &tmevtb;
	483	tmevtb.callback = (CBACK) wait_tmout_ok;
	484	tmevtb.arg = (void *) p_runtsk;
[429]	485	tmevtb_enqueue_reltim(&tmevtb, dlytim);
[270]	486	LOG_TSKSTAT(p_runtsk);
	487	dispatch();
	488	ercd = winfo.wercd;
	489	}
	490	unlock_cpu_dsp();
	491
	492	error_exit:
	493	LOG_DLY_TSK_LEAVE(ercd);
	494	return(ercd);
	495	}
	496
	497	#endif /* TOPPERS_dly_tsk */

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

Context Navigation

source: EcnlProtoTool/trunk/asp3_dcre/kernel/task_sync.c

Download in other formats: