Eric Ebert
CoOS Demonstrator adapted to mbed Hardware.
Diff: mm.c
- Revision:
- 0:57690853989a
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/mm.c Fri Dec 03 19:45:30 2010 +0000
@@ -0,0 +1,275 @@
+/**
+ *******************************************************************************
+ * @file mm.c
+ * @version V1.1.3
+ * @date 2010.04.26
+ * @brief memory management implementation code of CooCox CoOS kernel.
+ *******************************************************************************
+ * @copy
+ *
+ * INTERNAL FILE,DON'T PUBLIC.
+ *
+ * <h2><center>© COPYRIGHT 2009 CooCox </center></h2>
+ *******************************************************************************
+ */
+
+
+/*---------------------------- Include ---------------------------------------*/
+#include <coocox.h>
+
+
+#if CFG_MM_EN > 0
+/*---------------------------- Variable Define -------------------------------*/
+MM MemoryTbl[CFG_MAX_MM] = {{0}};/*!< Table which save memory control block. */
+U32 MemoryIDVessel = 0; /*!< Memory ID container. */
+
+/**
+ *******************************************************************************
+ * @brief Create a memory partition
+ * @param[in] memBuf Specify memory partition head address.
+ * @param[in] blockSize Specify memory block size.
+ * @param[in] blockNum Specify memory block number.
+ * @param[out] None
+ * @retval E_CREATE_FAIL Create memory partition fail.
+ * @retval others Create memory partition successful.
+ *
+ * @par Description
+ * @details This function is called to create a memory partition.
+ *******************************************************************************
+ */
+OS_MMID CoCreateMemPartition(U8* memBuf,U32 blockSize,U32 blockNum)
+{
+ U8 i,j;
+ U8 *memory;
+ P_MemBlk memBlk;
+ memory = memBuf;
+
+#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */
+ if(memBuf == 0)
+ {
+ return E_CREATE_FAIL;
+ }
+ if(blockSize == 0)
+ {
+ return E_CREATE_FAIL;
+ }
+ if((blockSize&0x3) != 0)
+ {
+ return E_CREATE_FAIL;
+ }
+ if(blockNum<=1)
+ {
+ return E_CREATE_FAIL;
+ }
+#endif
+
+ OsSchedLock(); /* Lock schedule */
+ for(i = 0; i < CFG_MAX_MM; i++)
+ {
+ if((MemoryIDVessel & (1 << i)) == 0) /* Is free memory ID? */
+ {
+ MemoryIDVessel |= (1<<i); /* Yes,assign ID to this memory block */
+ OsSchedUnlock(); /* Unlock schedule */
+ MemoryTbl[i].memAddr = memory;/* Initialize memory control block*/
+ MemoryTbl[i].freeBlock = memory;
+ MemoryTbl[i].blockSize = blockSize;
+ MemoryTbl[i].blockNum = blockNum;
+ memBlk = (P_MemBlk)memory; /* Bulid list in this memory block*/
+ for(j=0;j<blockNum-1;j++)
+ {
+ memory = memory+blockSize;
+ memBlk->nextBlock = (P_MemBlk)memory;
+ memBlk = memBlk->nextBlock;
+ }
+ memBlk->nextBlock = 0;
+ return i; /* Return memory block ID */
+ }
+ }
+ OsSchedUnlock(); /* Unlock schedule */
+ return E_CREATE_FAIL; /* Error return */
+}
+
+
+/**
+ *******************************************************************************
+ * @brief Delete a memory partition
+ * @param[in] mmID Specify memory partition that want to delete.
+ * @param[out] None
+ * @retval E_INVALID_ID The memory partition id passed was invalid,delete fail.
+ * @retval E_OK Delete successful.
+ *
+ * @par Description
+ * @details This function is called to Delete a memory partition.
+ *******************************************************************************
+ */
+StatusType CoDelMemoryPartition(OS_MMID mmID)
+{
+ P_MM memCtl;
+#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */
+ if(mmID >= CFG_MAX_MM)
+ {
+ return E_INVALID_ID;
+ }
+ if( ((1<<mmID)&MemoryIDVessel) == 0)
+ {
+ return E_INVALID_ID;
+ }
+#endif
+ OsSchedLock(); /* Lock schedule */
+ memCtl = &MemoryTbl[mmID]; /* Release memory control block */
+ MemoryIDVessel &= ~(1<<mmID);
+ OsSchedUnlock(); /* Unlock schedule */
+
+ memCtl->memAddr = 0;
+ memCtl->freeBlock = 0;
+ memCtl->blockSize = 0;
+ memCtl->blockNum = 0;
+ return E_OK; /* Return OK */
+}
+
+
+/**
+ *******************************************************************************
+ * @brief Get free block number in a memory partition
+ * @param[in] mmID Specify memory partition.
+ *
+ * @param[out] E_INVALID_ID Invalid ID was passed and get counter failure.
+ * @param[out] E_OK Get current counter successful.
+ * @retval fbNum The number of free block.
+ *
+ * @par Description
+ * @details This function is called to get free block number in a memory
+ * partition.
+ *******************************************************************************
+ */
+U32 CoGetFreeBlockNum(OS_MMID mmID,StatusType* perr)
+{
+ U32 fbNum;
+ P_MM memCtl;
+ P_MemBlk memBlk;
+#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */
+ if(mmID >= CFG_MAX_MM)
+ {
+ *perr = E_INVALID_ID;
+ return 0;
+ }
+ if( ((1<<mmID)&MemoryIDVessel) == 0)
+ {
+ *perr = E_INVALID_ID; /* Invalid memory id,return 0 */
+ return 0;
+ }
+#endif
+ memCtl = &MemoryTbl[mmID];
+ OsSchedLock(); /* Lock schedule */
+ memBlk = (P_MemBlk)(memCtl->freeBlock);/* Get the free item in memory list*/
+ fbNum = 0;
+ while(memBlk != 0) /* Get counter of free item */
+ {
+ fbNum++;
+ memBlk = memBlk->nextBlock; /* Get next free iterm */
+ }
+ OsSchedUnlock(); /* Unlock schedul */
+ *perr = E_OK;
+ return fbNum; /* Return the counter of free item */
+}
+
+
+/**
+ *******************************************************************************
+ * @brief Get a memory buffer from memory partition
+ * @param[in] mmID Specify memory partition that want to assign buffer.
+ * @param[out] None
+ * @retval 0 Assign buffer fail.
+ * @retval others Assign buffer successful,and return the buffer pointer.
+ *
+ * @par Description
+ * @details This function is called to Delete a memory partition.
+ *******************************************************************************
+ */
+void* CoGetMemoryBuffer(OS_MMID mmID)
+{
+ P_MM memCtl;
+ P_MemBlk memBlk;
+#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */
+ if(mmID >= CFG_MAX_MM)
+ {
+ return 0;
+ }
+ if( ((1<<mmID)&MemoryIDVessel) == 0)
+ {
+ return 0;
+ }
+#endif
+ memCtl = &MemoryTbl[mmID];
+ OsSchedLock(); /* Lock schedule */
+ if(memCtl->freeBlock == 0 ) /* Is there no free item in memory list */
+ {
+ OsSchedUnlock(); /* Unlock schedule */
+ return 0; /* Yes,error return */
+ }
+ memBlk = (P_MemBlk)memCtl->freeBlock; /* Get free memory block */
+ memCtl->freeBlock = (U8*)memBlk->nextBlock; /* Reset the first free item */
+ OsSchedUnlock(); /* Unlock schedule */
+ return memBlk; /* Return free memory block address */
+}
+
+
+
+/**
+ *******************************************************************************
+ * @brief Free a memory buffer to memory partition
+ * @param[in] mmID Specify memory partition.
+ * @param[in] buf Specify memory buffer that want to free.
+ * @param[out] None
+ * @retval E_INVALID_ID The memory partition id passed was invalid.
+ * @retval E_INVALID_PARAMETER The parameter passed was invalid.
+ * @retval E_OK Free successful.
+ *
+ * @par Description
+ * @details This function is called to Delete a memory partition.
+ *******************************************************************************
+ */
+StatusType CoFreeMemoryBuffer(OS_MMID mmID,void* buf)
+{
+ P_MM memCtl;
+ P_MemBlk memBlk;
+#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */
+ if(mmID >= CFG_MAX_MM)
+ {
+ return E_INVALID_ID;
+ }
+ if( ((1<<mmID)&MemoryIDVessel) == 0)
+ {
+ return E_INVALID_ID;
+ }
+ if(buf == 0)
+ {
+ return E_INVALID_PARAMETER;
+ }
+#endif
+
+ memCtl = &MemoryTbl[mmID];
+#if CFG_PAR_CHECKOUT_EN >0 /* Check validity of parameter */
+ if((U32)buf < (U32)(memCtl->memAddr))
+ {
+ return E_INVALID_PARAMETER;
+ }
+ if((U32)buf > (U32)(memCtl->memAddr + memCtl->blockSize*memCtl->blockNum))
+ {
+ return E_INVALID_PARAMETER;
+ }
+ if(((U32)buf - (U32)(memCtl->memAddr))%(memCtl->blockSize) != 0)
+ {
+ return E_INVALID_PARAMETER;
+ }
+#endif
+ memBlk = (P_MemBlk)buf; /* Reset the first free item */
+ OsSchedLock();
+ memBlk->nextBlock = (P_MemBlk)memCtl->freeBlock;
+ memCtl->freeBlock = (U8 *) buf;
+ OsSchedUnlock();
+ return E_OK; /* Return OK */
+}
+
+#endif
+