tmr_core.c
来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 726 行 · 第 1/3 页
C
726 行
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/kernel/src/tmr_core.c</TITLE></HEAD><BODY><pre><font color="#6920ac">/*************************************************************************/</font><font color="#6920ac">/* */</font><font color="#6920ac">/* Copyright (c) 1997-1999 Australian Real Time Embedded Systems */</font><font color="#6920ac">/* */</font><font color="#6920ac">/* PROPRIETARY RIGHTS of Australian Real Time Embedded Systems */</font><font color="#6920ac">/* are involved in the subject matter of this material. All reproduction,*/</font><font color="#6920ac">/* manufacturing, use, and sales rights pertaining to this subject matter*/</font><font color="#6920ac">/* are governed by the license agreement. The recipient of this software */</font><font color="#6920ac">/* implicitly accepts the terms of the license. */</font><font color="#6920ac">/* */</font><font color="#6920ac">/*************************************************************************/</font><font color="#6920ac">/************************************************************************** * * FILE NAME * * tmr_core.c * * SYSTEM COMPONENT * * Timer Services Component * * DESCRIPTION * * This file contains the core services for Timer * Component. * * SERVICES * * timr_Create * timr_Destroy * timr_Add * timr_Remove * timr_Add63 * * SCCS HISTORY * * @(#)tmr_core.c 1.3, 04/13/99, 19:31:04 * * AUTHOR * * Victor Gorine * * CREATED * * 01-Feb-1999 by Victor Gorine * * REVISION HISTORY * * NAME DATE REMARKS * **************************************************************************/</font><b><font color='DarkGreen'>#include</font></b> <a href="crt_defs.h.FIND-INC"><font color="blue">"crt_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="tmr_defs.h.FIND-INC"><font color="blue">"tmr_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="tmr_priv.h.FIND-INC"><font color="blue">"tmr_priv.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="evn_defs.h.FIND-INC"><font color="blue">"evn_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="tsk_defs.h.FIND-INC"><font color="blue">"tsk_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="hwi_defs.h.FIND-INC"><font color="blue">"hwi_defs.h"</font></a><font color="#6920ac">/* timer component task handler */</font><font size="+1"><i>static</i> <i>crtx_Void_t</i> <a href="timr_Engine.FIND-FUNC">timr_Engine</a>( <i>crtx_Void_t</i> **pContext_a, <font color="#6920ac">/* pointer to context */</font> <i>crtx_Int_t</i> ArgC_a);</font><font color="#6920ac">/* creatre timer control block */</font><font size="+1"><i>timr_Desc_t</i> * <b><font color="azure1"><a name="timr_Create">timr_Create</a></font></b>( <i>crtx_Void_t</i> *pDesc_a, <font color="#6920ac">/* pointer on a memory preallocated by macro */</font> <font color="#6920ac">/* TIMR_STRUCT_DEFINE if a memory for timer */</font> <font color="#6920ac">/* data are allocated by application, in a */</font> <font color="#6920ac">/* case of CRTX_NULL this memory is allocated*/</font> <font color="#6920ac">/* the service */</font> <i>crtx_Int_t</i> EntrNum_a, <font color="#6920ac">/* max entries number */</font> <i>timr_Attr_t</i> *pAttr_a <font color="#6920ac">/* create attributes */</font> ){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>timr_Desc_t</i> *pDesc; <i>dmem_Size_t</i> EntriesMemSize; <i>crtx_Int_t</i> i; <i>crtx_Int_t</i> FlagsSize; <i>timr_Attr_t</i> TimrAttr; <i>task_Attr_t</i> TaskAttr;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <font color="#6920ac">/* check attributes and if some of them undefined use default values */</font> <b>if</b> (pAttr_a == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { TimrAttr = timr_AttrDefault_g; } <b>else</b> { TimrAttr = *pAttr_a; } <b>if</b> (EntrNum_a <= 0) { <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> ErrEntriesNumber_Exc; } <b>if</b> (TimrAttr.pTaskAttr == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { TaskAttr = *(<a href="ENVI_TIMR_TASK_ATTRIBUTES.FIND-DEF">ENVI_TIMR_TASK_ATTRIBUTES</a>); } <b>else</b> { TaskAttr = *(TimrAttr.pTaskAttr); } TaskAttr.Priority = TimrAttr.Priority; <b>if</b> ( TimrAttr.pTaskName != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a> ) { TaskAttr.pName = TimrAttr.pTaskName; } <b>if</b> ( TaskAttr.pName == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { TaskAttr.pName = <a href="ENVI_TIMR_TASK_NAME.FIND-DEF">ENVI_TIMR_TASK_NAME</a>; } FlagsSize = ( EntrNum_a + 32 - 1 ) / 32 ; <font color="#6920ac">/* test that memory for timr structures allocated already */</font> <b>if</b> ( pDesc_a != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { <font color="#6920ac">/* memory allocated */</font> pDesc = (<i>timr_Desc_t</i> *)pDesc_a; pDesc->MemAllocated = <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>; } <b>else</b> { <font color="#6920ac">/* allocate memory */</font> pDesc = (<i>timr_Desc_t</i> *)<a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(TimrAttr.Segment, <i>sizeof</i>(<i>timr_Desc_t</i>), <i>sizeof</i>(<i>crtx_Int_t</i>)); <b>if</b> ((<i>crtx_Void_t</i>*)pDesc == (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>) { <font color="#6920ac">/* not enough memory */</font> <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> ErrDescAlloc_Exc; } pDesc->MemAllocated = <a href="CRTX_TRUE.FIND-DEF">CRTX_TRUE</a>; pDesc->SegNum = TimrAttr.Segment; pDesc->pChangeFlags = (<i>crtx_Uint32_t</i> *) <a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(TimrAttr.Segment, FlagsSize, <i>sizeof</i>(<i>crtx_Uint32_t</i>)); EntriesMemSize = ((((<i>sizeof</i>(<i>timr_Entry_t</i>) + <i>sizeof</i>(<i>crtx_Int_t</i>) - 1) / <i>sizeof</i>(<i>crtx_Int_t</i>)) * <i>sizeof</i>(<i>crtx_Int_t</i>)) * EntrNum_a); pDesc->pEntries = (<i>timr_Entry_t</i> *) <a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(TimrAttr.Segment, EntriesMemSize, <i>sizeof</i>(<i>crtx_Uint32_t</i>)); <b>if</b> (((<i>crtx_Void_t</i>*)pDesc->pChangeFlags == (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>) || ((<i>crtx_Void_t</i>*)pDesc->pEntries == (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>) ) { <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> ErrArraysAlloc_Exc; } } pDesc->EntriesNumber = EntrNum_a; <font color="#6920ac">/* create event control block */</font> <b>if</b> (<a href="evnt_Create.FIND-FUNC">evnt_Create</a>( &pDesc->Event, 0, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> ErrCreateEvent_Exc; } <font color="#6920ac">/* init arrays */</font> <font color="#6920ac">/* create task */</font> { <i>crtx_Status_t</i> Status; pDesc->TaskId = <a href="task_Create3.FIND-FUNC">task_Create3</a>((<i>task_Entry3_t</i>)timr_Engine, TimrAttr.pTaskAttr, &Status, (<i>void</i> **)pDesc, 0); <b>if</b> (pDesc->TaskId == <a href="TASK_ILLEGAL_ID.FIND-DEF">TASK_ILLEGAL_ID</a>) { <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> ErrCreateTask_Exc; } } <font color="#6920ac">/* init structures */</font> <b>for</b> (i = 0; i < pDesc->EntriesNumber; i++ ) { pDesc->pEntries[i].CreateCounter = 0; pDesc->pEntries[i].Ready = 0; pDesc->pEntries[i].StartReady = 0; pDesc->pEntries[i].pDesc = pDesc; pDesc->pEntries[i].pNext = &pDesc->pEntries[i]; } <b>for</b> ( i = 0; i < FlagsSize; i++) { pDesc->pChangeFlags[i] = 0; } pDesc->pActive = <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>; <b>return</b>(pDesc);<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="blue">ErrCreateTask_Exc:</font> <a href="evnt_Delete.FIND-FUNC">evnt_Delete</a>(&pDesc->Event); <font color="blue">ErrCreateEvent_Exc:</font><font color="blue">ErrArraysAlloc_Exc:</font> <b>if</b> (pDesc->MemAllocated) { <b>if</b> ((<i>crtx_Void_t</i>*)pDesc->pChangeFlags != (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>) { <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(TimrAttr.Segment, pDesc->pChangeFlags, FlagsSize); } <b>if</b> ((<i>crtx_Void_t</i>*)pDesc->pEntries != (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>) { <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(TimrAttr.Segment, pDesc->pEntries, EntriesMemSize); } <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(TimrAttr.Segment, pDesc, <i>sizeof</i>(<i>timr_Desc_t</i>)); }<font color="blue">ErrDescAlloc_Exc:</font><font color="blue">ErrEntriesNumber_Exc:</font> <b>return</b>(<a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>);}<font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="timr_Destroy">timr_Destroy</a></font></b>(⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?