cxsempd1.c

来自「上传一个带源代码的嵌入式实时多任务操作系统CMX」· C语言 代码 · 共 117 行

/*********************************************************

Copyright (c) CMX Company. 1999. All rights reserved

*********************************************************/
/* version 5.30 */

#define CMXMODULE 1

#include <cxfuncs.h>	/* get cmx include header file */
#include <cxextern.h>	/* get cmx include header file */

#if (defined(CMXTRACKER) || defined(WINTRACKER))
#include <cmxtrack.h>	/* get cmx include header file */
#endif

/*
mode 0 : wait if semaphore not present 
mode 1 : do NOT wait if semaphore not present, return immediatedly
*/

byte K_I_Semaphore_Get_Common(byte sem_num, word16 timecnt, byte mode)	
{
	SEM *sem_ptr;

	if (sem_num >= MAX_SEMAPHORES)
		{
#if (defined(WINTRACKER))
		if (CMXTRACKER_ON)
			{
			cmxtracker_in3(CXSEMPD_K_ERROR,sem_num,mode);
			}
#endif
		return(K_ERROR);	/* return good status to caller */
		}
	K_I_Disable_Sched();
	sem_ptr = &sem_array[sem_num];	/* CMX semaphore handler. */
	if (sem_ptr->fwlink == NULL)
		{
#if (defined(WINTRACKER))
		if (CMXTRACKER_ON)
			{
			cmxtracker_in3(CXSEMPD_K_ERROR,sem_num,mode);
			}
#endif
		K_I_Func_Return();	/* release task block */
		return(K_ERROR);	/* return error status to caller */
		}
	if (!sem_ptr->sem_count)
		{
		if (mode)
			{
#if (defined(WINTRACKER))
			if (CMXTRACKER_ON)
				{
				cmxtracker_in2(CXSEMPD_K_SEMAPHORE_NONE,sem_num);
				}
#endif
			K_I_Func_Return();	/* release task block */
			return(K_SEMAPHORE_NONE);	/* return error that semaphore
											had not been posted to */
			}
#if (defined(WINTRACKER))
			if (CMXTRACKER_ON)
				{
				cmxtracker_in4(CXSEMPD_CALL,sem_num,timecnt);
				}
#endif
		if (sem_ptr->fwlink != (tcbpointer)sem_ptr)	/* is at least one task waiting
																		on is semaphore */
			{
			activetcb->fwlink = sem_ptr->bwlink->fwlink;
			sem_ptr->bwlink->fwlink = activetcb;
			activetcb->bwlink = sem_ptr->bwlink;
			sem_ptr->bwlink = activetcb;
			}
		else
			{
			sem_ptr->fwlink = sem_ptr->bwlink = activetcb;
			activetcb->fwlink = activetcb->bwlink = (tcbpointer)sem_ptr;
			}
		if (K_I_Time_Common(timecnt,SEMAPHORE))	/* go suspend task. */
			{
#if (defined(WINTRACKER))
			if (CMXTRACKER_ON)
				{
				cmxtracker_in1(CXSEMPD_DELAY_K_TIMEOUT);
				}
#endif
			return(K_TIMEOUT);	/* return the warning: that the time period expired */
			}
		else
			{
#if (defined(WINTRACKER))
			if (CMXTRACKER_ON)
				{
				cmxtracker_in2(CXSEMPD_K_OK1,sem_num);
				}
#endif
			return(K_OK);
			}
		}
	--sem_ptr->sem_count;
#if (defined(WINTRACKER))
	if (CMXTRACKER_ON)
		{
		if (mode)
			cmxtracker_in4(CXSEMPD_K_OK,sem_num,sem_ptr->sem_count);
		else
			cmxtracker_in2(CXSEMPD_K_OK1,sem_num);
		}
#endif
	K_I_Func_Return();
	return(K_OK);
}	/* K_I_Semaphore_Get_Common */