madp_que.c

iTRON4.0最新操作系统

/* ------------------------------------------------------------------------ */
/*  Hyper Operating System V4  μITRON4.0慌屯 Real-Time OS                  */
/*  μカ〖ネル キュ〖拎侯                                                   */
/*                                                                          */
/*                                  Copyright (C) 1998-2006 by Project HOS  */
/*                                  http://sourceforge.jp/projects/hos/     */
/* ------------------------------------------------------------------------ */


#include "mknl.h"



/* タスク庭黎刨界で纳裁 */
void mknl_adp_que(
		T_MKNL_QUE *que,	/* 纳裁するキュ〖 */
		T_MKNL_TCB *mtcb)	/* 纳裁するタスク */
{
	T_MKNL_TCB *mtcb_next;
	T_MKNL_TCB *mtcb_prev;
	
	mtcb->que = que;
	if ( que->head == NULL )
	{
		/* キュ〖にタスクが痰ければ黎片に肋年 */
		que->head  = mtcb;
		mtcb->next = mtcb;
		mtcb->prev = mtcb;
	}
	else
	{
		/* 赁掐疤弥をキュ〖を黎片から浮瑚 */
		mtcb_next = que->head;
		do {
			/* 极尸より你庭黎のタスクがあれば赁掐疤弥浮叫窗位 */
			if ( mtcb_next->tskpri > mtcb->tskpri )
			{
				if ( mtcb_next == que->head )	/* 赁掐疤弥が黎片なら */
				{
					mtcb_prev = mtcb_next->prev;
					que->head = mtcb;
				}
				break;
			}

			/* 肌に渴む */
			mtcb_prev = mtcb_next;
			mtcb_next = mtcb_next->next;
		} while ( mtcb_next != que->head );
		
		/* タスクをキュ〖に赁掐 */
		mtcb->next      = mtcb_next;
		mtcb->prev      = mtcb_prev;
		mtcb_next->prev = mtcb;
		mtcb_prev->next = mtcb;
	}
}


/* ------------------------------------------------------------------------ */
/*  Copyright (C) 1998-2006 by Project HOS                                  */
/* ------------------------------------------------------------------------ */