fsp_core.c
来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 273 行
C
273 行
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/kernel/src/fsp_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 * * fsp_core.c * * SYSTEM COMPONENT * * Fixed-Size Memory pool * * DESCRIPTION * * This file contains the core services for Fixed-Size Memory Pool * Component. * * SERVICES * * fsmp_Create create fixed-size memory pool * fsmp_Delete destroy fixed-size memory pool * fsmp_Allocate allocate memory block * fsmp_Free release memory block * * SCCS HISTORY * * @(#)fsp_core.c 1.4, 01/25/99, 00:32:12 * * AUTHOR * * Vadim N. Azarovsky * * CREATED * * 27-May-1998 by Vadim N. Azarovsky * * REVISION HISTORY * * NAME DATE REMARKS * **************************************************************************/</font><b><font color='DarkGreen'>#include</font></b> <a href="fsp_priv.h.FIND-INC"><font color="blue">"fsp_priv.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="ass_defs.h.FIND-INC"><font color="blue">"ass_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="mem_defs.h.FIND-INC"><font color="blue">"mem_defs.h"</font></a><font color="#6920ac">/* create fixed-size memory pool */</font><font size="+1"><i>fsmp_Pool_t</i> *<b><font color="azure1"><a name="fsmp_Create">fsmp_Create</a></font></b>( <i>crtx_Int_t</i> NrBlocks_a, <i>crtx_Int_t</i> Size_a, <i>fsmp_Attr_t</i> *pAttr_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>crtx_Int_t</i> SizeOfPCB; <i>fsmp_Pool_t</i> *pPool; <i>crtx_Byte_t</i> *pPtr; <i>fsmp_Block_t</i> *pBlock; <i>crtx_Int_t</i> i;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(NrBlocks_a>0) <font color="#6920ac">/* calculate min size of memory block */</font> <b>if</b> (Size_a<(<i>crtx_Int_t</i>)<i>sizeof</i>(<i>fsmp_Block_t</i>)) Size_a = <i>sizeof</i>(<i>fsmp_Block_t</i>); <b>else</b> Size_a = (Size_a+<i>sizeof</i>(<i>fsmp_Block_t</i>)-1) & ~(<i>sizeof</i>(<i>fsmp_Block_t</i>)-1); <font color="#6920ac">/* calcilate size of pool control block */</font> SizeOfPCB = (<i>sizeof</i>(<i>fsmp_Pool_t</i>)+<i>sizeof</i>(<i>fsmp_Block_t</i>)-1) & ~(<i>sizeof</i>(<i>fsmp_Block_t</i>)-1); <font color="#6920ac">/* Prepare attribute argument */</font> <b>if</b> (pAttr_a == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { <font color="#6920ac">/* use default attributes */</font> pAttr_a = &fsmp_AttrDefault_g; } <font color="#6920ac">/* Allocate memory for pool control block and block table */</font> pPool = (<i>fsmp_Pool_t</i>*)<a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(pAttr_a->Segment, SizeOfPCB+Size_a*NrBlocks_a, <i>sizeof</i>(<i>crtx_Uint32_t</i>)); <b>if</b> ((<i>crtx_Void_t</i>*)pPool == (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>) { <font color="#6920ac">/* memory allocation error */</font> <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> MemAllocError_Exc; }<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL > 0</font> <a href="FSMP_SET_POOL_ID.FIND-DEF">FSMP_SET_POOL_ID</a>(pPool);<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL > 0 */</font></font> pPool->BlockSize = Size_a; pPool->NrBlocks = NrBlocks_a; pPool->NrAllocated = 0; pPool->Segment = pAttr_a->Segment; <font color="#6920ac">/* first block */</font> pBlock = (<i>fsmp_Block_t</i>*)((<i>crtx_Byte_t</i>*)pPool + SizeOfPCB); <font color="#6920ac">/* next block */</font> pPtr = (<i>crtx_Byte_t</i>*)pBlock + Size_a; pPool->pFreeList = pBlock; <b>for</b> (i=1; i<NrBlocks_a; i++) { pBlock->pNext = (<i>fsmp_Block_t</i>*)pPtr; pBlock = pBlock->pNext; pPtr += Size_a; } pBlock->pNext = <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>; <font color="#6920ac">/* end of list */</font> <b>return</b> pPool;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font><font color="blue">MemAllocError_Exc:</font> <font color="#6920ac">/* memory allocation error exception */</font> <b>return</b> <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;}<font color="#6920ac">/* delete fixed-size memory pool */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="fsmp_Delete">fsmp_Delete</a></font></b>( <i>fsmp_Pool_t</i> *pPool_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>crtx_Int_t</i> SizeOfPCB;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pPool_a) <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="FSMP_CHECK_POOL_ID.FIND-DEF">FSMP_CHECK_POOL_ID</a>(pPool_a)) <font color="#6920ac">/* calcilate size of pool control block */</font> SizeOfPCB = (<i>sizeof</i>(<i>fsmp_Pool_t</i>)+<i>sizeof</i>(<i>fsmp_Block_t</i>)-1) & ~(<i>sizeof</i>(<i>fsmp_Block_t</i>)-1); <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(pPool_a->Segment, (<i>crtx_Void_t</i>*)pPool_a, SizeOfPCB + pPool_a->BlockSize * pPool_a->NrBlocks); <b>return</b>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* allocate block frem pool */</font><font size="+1"><i>crtx_Void_t</i> *<b><font color="azure1"><a name="fsmp_Allocate">fsmp_Allocate</a></font></b>( <i>fsmp_Pool_t</i> *pPool_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>crtx_Void_t</i> *pPtr;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pPool_a) <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="FSMP_CHECK_POOL_ID.FIND-DEF">FSMP_CHECK_POOL_ID</a>(pPool_a)) pPtr = (<i>void</i>*)pPool_a->pFreeList; <b>if</b> (pPool_a->pFreeList) { pPool_a->pFreeList = pPool_a->pFreeList->pNext; pPool_a->NrAllocated++; } <b>return</b> pPtr;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* return block */</font><font size="+1"><i>crtx_Status_t</i> <b><font color="azure1"><a name="fsmp_Free">fsmp_Free</a></font></b>( <i>fsmp_Pool_t</i> *pPool_a, <i>crtx_Void_t</i> *pBlock_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>fsmp_Block_t</i> *pBlock = (<i>fsmp_Block_t</i>*)pBlock_a; <i>crtx_Int_t</i> SizeOfPCB;<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL >= 1</font> <i>fsmp_Block_t</i> *pCurr;<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL >= 1 */</font></font><font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pPool_a) <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pBlock_a) <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="FSMP_CHECK_POOL_ID.FIND-DEF">FSMP_CHECK_POOL_ID</a>(pPool_a)) <font color="#6920ac">/* calcilate size of pool control block */</font> SizeOfPCB = (<i>sizeof</i>(<i>fsmp_Pool_t</i>) + (<i>sizeof</i>(<i>fsmp_Block_t</i>)-1)) & ~(<i>sizeof</i>(<i>fsmp_Block_t</i>)-1); <font color="#6920ac">/* check that block withing memory pool and has correct alignment */</font> <b>if</b> (((<i>crtx_Byte_t</i>*)pBlock_a < (<i>crtx_Byte_t</i>*)pPool_a + SizeOfPCB) || ((<i>crtx_Byte_t</i>*)pBlock_a > (<i>crtx_Byte_t</i>*)pPool_a + SizeOfPCB + pPool_a->NrBlocks*pPool_a->BlockSize) || ((<i>crtx_Uint32_t</i>)pBlock_a & (<i>sizeof</i>(<i>fsmp_Block_t</i>)-1))) { <b>return</b> <a href="FSMP_ERR_INVALID_BLOCK.FIND-DEF">FSMP_ERR_INVALID_BLOCK</a>; }<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL >= 1</font> <font color="#6920ac">/* check that block is not on free list */</font> <b>for</b> (pCurr = pPool_a->pFreeList; pCurr; pCurr=pCurr->pNext) <b>if</b> (pCurr == pBlock) <b>return</b> <a href="FSMP_ERR_BLOCK_IS_FREE.FIND-DEF">FSMP_ERR_BLOCK_IS_FREE</a>;<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL >= 1 */</font></font> pBlock->pNext = pPool_a->pFreeList; pPool_a->pFreeList = pBlock; pPool_a->NrAllocated--; <b>return</b> <a href="FSMP_SUCCESS.FIND-DEF">FSMP_SUCCESS</a>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?