mm2_core.c

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

C
152
字号
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/kernel/src/mm2_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="mm2_defs.h.FIND-INC"><font color="blue">"mm2_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="mm2_priv.h.FIND-INC"><font color="blue">"mm2_priv.h"</font></a><font size="+1"><i>crtx_Bool_t</i> <b><font color="azure1"><a name="mem2_Create">mem2_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>mem2_SegmHead_t</i>  *segm;    <i>crtx_Int16_t</i> headsz;        headsz = (<i>crtx_Int16_t</i>)(<i>sizeof</i>(<i>mem2_SegmHead_t</i>)) ;    <font color="#6920ac">/* check for segment size */</font>    <a href="DMEM_ASSERT.FIND-DEF">DMEM_ASSERT</a>((<i>dmem_Size_t</i>)headsz &lt; Size_a);        <b>if</b> ((<i>dmem_Size_t</i>)headsz &gt;= Size_a) <b>return</b>(0);    <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 = (<i>mem2_SegmHead_t</i> *) Addr_a;    segm-&gt;shift = headsz;    segm-&gt;rest = Size_a - headsz;    <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="mem2_Free">mem2_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="mem2_DoAlloc">mem2_DoAlloc</a></font></b>(<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>mem2_SegmHead_t</i>  *segm;    <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));        segm = (<i>mem2_SegmHead_t</i> *) Addr_a;        <a href="rrlc_Lock.FIND-FUNC">rrlc_Lock</a>(&amp;segm-&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> *)segm)[                        segm-&gt;shift],                              Algn_a)) &amp; (Algn_a - 1);                <b>if</b> (segm-&gt;rest &gt;= Size_a+algndelt) {            Result = (<i>crtx_Void_t</i> *)&amp;((<i>crtx_Char_t</i> *)segm)[segm-&gt;shift +                                                          algndelt];            segm-&gt;rest -= Size_a+algndelt;            segm-&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> *)segm)[            segm-&gt;shift + segm-&gt;rest-Size_a],Algn_a);                <b>if</b> (segm-&gt;rest&gt;=Size_a+algndelt) {            Result=(<i>crtx_Void_t</i> *)&amp;((<i>crtx_Char_t</i> *)segm)[                segm-&gt;shift + segm-&gt;rest-Size_a - algndelt];            segm-&gt;rest -= Size_a+algndelt;        }    }        <a href="rrlc_Unlock.FIND-FUNC">rrlc_Unlock</a>(&amp;segm-&gt;lock);        <b>return</b>(Result);}<font size="+1"><i>crtx_Void_t</i> * <b><font color="azure1"><a name="mem2_Alloc">mem2_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="#mem2_DoAlloc">mem2_DoAlloc</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="mem2_AllocSt">mem2_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="#mem2_DoAlloc">mem2_DoAlloc</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="mem2_Info">mem2_Info</a></font></b>(<i>crtx_Void_t</i> *Sgadd_a,                            <i>crtx_Void_t</i> *pContext_a __attribute__((unused)),                            <i>dmem_SegmInfo_t</i> *pInfo_a){</font>    <i>mem2_SegmHead_t</i>  *segm;        segm = (<i>mem2_SegmHead_t</i> *) Sgadd_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 - (<i>sizeof</i>(<i>mem2_SegmHead_t</i>));        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 + -
显示快捷键?