mm0_core.c

来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 147 行

C
147
字号
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/kernel/src/mm0_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><b><font color='DarkGreen'>#include</font></b> <a href="mm0_priv.h.FIND-INC"><font color="blue">"mm0_priv.h"</font></a><font size="+1"><i>crtx_Bool_t</i> <b><font color="azure1"><a name="mem0_Create">mem0_Create</a></font></b>(<i>crtx_Void_t</i> *Addr_a,                        <i>dmem_Size_t</i> Size_a,                        <i>crtx_Void_t</i> *pContext_a __attribute__((unused))){</font>    <font color="#6920ac">/* descriptor of a segment consists of: */</font>    <font color="#6920ac">/* 0 - dmem_Size_t rest of free memory */</font>    <font color="#6920ac">/* 1 - dmem_Size_t, current number of byte to distribute */</font>    <i>mem0_SegmHead_t</i>  *segm;    segm = (<i>mem0_SegmHead_t</i>  *)pContext_a;    <b>if</b> (segm == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) <b>return</b>(<a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>);    <font color="#6920ac">/* check for segment address alignment */</font>    <a href="DMEM_ASSERT.FIND-DEF">DMEM_ASSERT</a>(((<i>dmem_Size_t</i>)Addr_a &amp; (~(-<a href="DMEM_MIN_ALIGN.FIND-DEF">DMEM_MIN_ALIGN</a>))) == 0);        <b>if</b> (!(((<i>dmem_Size_t</i>)Addr_a &amp; (~(-<a href="DMEM_MIN_ALIGN.FIND-DEF">DMEM_MIN_ALIGN</a>))) == 0))         <b>return</b>(<a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>);        segm-&gt;shift = 0;    segm-&gt;rest = Size_a;    <a href="rrlc_Create.FIND-FUNC">rrlc_Create</a>(&amp;segm-&gt;lock,(<i>void</i> *)0);    <b>return</b>(<a href="CRTX_TRUE.FIND-DEF">CRTX_TRUE</a>);}<font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="mem0_Free">mem0_Free</a></font></b>(<i>crtx_Void_t</i> *Segm_a  __attribute__((__unused__)),                      <i>crtx_Void_t</i> *pContext_a __attribute__((unused)),                      <i>crtx_Void_t</i> *Addr_a  __attribute__((__unused__)),                      <i>dmem_Size_t</i> Size_a  __attribute__((__unused__))){</font>    <font color="#6920ac">/* empty function */</font>    <a href="DMEM_ASSERT.FIND-DEF">DMEM_ASSERT</a>(0);    <b>return</b>;}<font color="#6920ac">/* adjust address in according to alignment */</font><font size="+1"><i>static</i> <i>crtx_Uint16_t</i> <b><font color="azure1"><a name="CalcAlgn0">CalcAlgn0</a></font></b>(<i>crtx_Void_t</i> *Addr_a, <i>crtx_Uint16_t</i> Algn_a){</font>    <i>crtx_Uint16_t</i> Resalgn;    <i>dmem_Size_t</i> longad;        longad = (<i>dmem_Size_t</i>)Addr_a;    Resalgn = (Algn_a==0) ? 0 : (<i>crtx_Uint16_t</i>)(longad &amp; (~(-(<i>long</i>)Algn_a)));        <b>return</b>(Resalgn);}<font size="+1"><i>static</i> <i>crtx_Void_t</i> * <b><font color="azure1"><a name="mem0_DoAlloc">mem0_DoAlloc</a></font></b>(<i>mem0_SegmHead_t</i> *pDesc_a,                                  <i>crtx_Void_t</i> *Addr_a,                                  <i>dmem_Size_t</i> Size_a,                                  <i>crtx_Uint16_t</i> Algn_a,                                  <i>crtx_Bool_t</i> Locate_a){</font>    <i>crtx_Void_t</i> *Result = <a href="DMEM_NULL.FIND-DEF">DMEM_NULL</a>;    <i>dmem_Size_t</i> algndelt;        <a href="DMEM_ASSERT.FIND-DEF">DMEM_ASSERT</a>((((-Algn_a)&amp;Algn_a)==Algn_a));        <a href="rrlc_Lock.FIND-FUNC">rrlc_Lock</a>(&amp;pDesc_a-&gt;lock);        <b>if</b> ( !Locate_a )    {        algndelt = ( Algn_a -                     <a href="#CalcAlgn0">CalcAlgn0</a>((<i>crtx_Void_t</i> *)&amp;((<i>crtx_Char_t</i> *)Addr_a)[                         pDesc_a-&gt;shift], Algn_a)) &amp; (Algn_a - 1);                <b>if</b> (pDesc_a-&gt;rest &gt;= Size_a+algndelt) {            Result = (<i>crtx_Void_t</i> *)&amp;((<i>crtx_Char_t</i> *)Addr_a)[pDesc_a-&gt;shift +                                                            algndelt];            pDesc_a-&gt;rest -= Size_a+algndelt;            pDesc_a-&gt;shift += Size_a+algndelt;        }    }    <b>else</b>    {        <font color="#6920ac">/* allocating of memory for large block from the end of the segment*/</font>                algndelt = <a href="#CalcAlgn0">CalcAlgn0</a>((<i>crtx_Void_t</i> *)&amp;((<i>crtx_Char_t</i> *)Addr_a)[            pDesc_a-&gt;shift + pDesc_a-&gt;rest-Size_a],Algn_a);                <b>if</b> (pDesc_a-&gt;rest&gt;=Size_a+algndelt) {            Result=(<i>crtx_Void_t</i> *)&amp;((<i>crtx_Char_t</i> *)Addr_a)[                pDesc_a-&gt;shift + pDesc_a-&gt;rest-Size_a - algndelt];            pDesc_a-&gt;rest -= Size_a+algndelt;        }    }        <a href="rrlc_Unlock.FIND-FUNC">rrlc_Unlock</a>(&amp;pDesc_a-&gt;lock);        <b>return</b>(Result);}<font size="+1"><i>crtx_Void_t</i> * <b><font color="azure1"><a name="mem0_Alloc">mem0_Alloc</a></font></b>(<i>crtx_Void_t</i> *Sgadd_a,                         <i>crtx_Void_t</i> *pContext_a __attribute__((unused)),                         <i>dmem_Size_t</i> Size_a,                         <i>crtx_Uint16_t</i> Algn_a){</font>    <b>return</b>(<a href="#mem0_DoAlloc">mem0_DoAlloc</a>((<i>mem0_SegmHead_t</i> *)pContext_a,                        Sgadd_a, Size_a, Algn_a, <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>));}<font size="+1"><i>crtx_Void_t</i> * <b><font color="azure1"><a name="mem0_AllocSt">mem0_AllocSt</a></font></b>(<i>crtx_Void_t</i> *Sgadd_a,                           <i>crtx_Void_t</i> *pContext_a __attribute__((unused)),                           <i>dmem_Size_t</i> Size_a,                           <i>crtx_Uint16_t</i> Algn_a){</font>    <b>return</b>(<a href="#mem0_DoAlloc">mem0_DoAlloc</a>((<i>mem0_SegmHead_t</i> *)pContext_a,                        Sgadd_a, Size_a, Algn_a, <a href="CRTX_TRUE.FIND-DEF">CRTX_TRUE</a>));}<font color="#6920ac">/* returns pointer on input structure info if ok and DMEM_NULL otherwise */</font><font size="+1"><i>dmem_SegmInfo_t</i> * <b><font color="azure1"><a name="mem0_Info">mem0_Info</a></font></b>(<i>crtx_Void_t</i> *Sgadd_a __attribute__((unused)),                            <i>crtx_Void_t</i> *pContext_a __attribute__((unused)),                            <i>dmem_SegmInfo_t</i> *pInfo_a){</font>    <i>mem0_SegmHead_t</i>  *segm;        segm = (<i>mem0_SegmHead_t</i> *) pContext_a;    <a href="rrlc_Lock.FIND-FUNC">rrlc_Lock</a>(&amp;segm-&gt;lock);    <b>if</b> (pInfo_a != <a href="DMEM_NULL.FIND-DEF">DMEM_NULL</a>)    {        pInfo_a-&gt;Used = segm-&gt;shift ;        pInfo_a-&gt;Max = pInfo_a-&gt;Free = segm-&gt;rest;        pInfo_a-&gt;Size = pInfo_a-&gt;Free + pInfo_a-&gt;Used;    }    <a href="rrlc_Unlock.FIND-FUNC">rrlc_Unlock</a>(&amp;segm-&gt;lock);    <b>return</b>(pInfo_a);}</pre></BODY></HTML>

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?