PRIVATE IX_OSAL_MBUF * ixOsalBuffPoolMbufInit (UINT32 mbufSizeAligned, UINT32 dataSizeAligned, IX_OSAL_MBUF_POOL *poolPtr) { UINT8 *dataPtr; IX_OSAL_MBUF *realMbufPtr; /* Allocate cache-aligned memory for mbuf header */ realMbufPtr = (IX_OSAL_MBUF *) IX_OSAL_CACHE_DMA_MALLOC (mbufSizeAligned); IX_OSAL_ASSERT (realMbufPtr != NULL); memset (realMbufPtr, 0, mbufSizeAligned); /* Allocate cache-aligned memory for mbuf data */ dataPtr = (UINT8 *) IX_OSAL_CACHE_DMA_MALLOC (dataSizeAligned); IX_OSAL_ASSERT (dataPtr != NULL); memset (dataPtr, 0, dataSizeAligned); /* Fill in mbuf header fields */ IX_OSAL_MBUF_MDATA (realMbufPtr) = dataPtr; IX_OSAL_MBUF_ALLOCATED_BUFF_DATA (realMbufPtr) = (UINT32)dataPtr; IX_OSAL_MBUF_MLEN (realMbufPtr) = dataSizeAligned; IX_OSAL_MBUF_ALLOCATED_BUFF_LEN (realMbufPtr) = dataSizeAligned; IX_OSAL_MBUF_NET_POOL (realMbufPtr) = (IX_OSAL_MBUF_POOL *) poolPtr; IX_OSAL_MBUF_SYS_SIGNATURE_INIT(realMbufPtr); /* update some statistical information */ poolPtr->mbufMemSize += mbufSizeAligned; poolPtr->dataMemSize += dataSizeAligned; return realMbufPtr; }
/** * @ingroup IxTimeSyncAccCodelet * * @fn ixTimeSyncAccCodeletMbufAllocate () * * @brief Allocate memory for mBuf and its associated data buffer * * @return * @li IX_OSAL_MBUF * - successfully allocated memory for mBuf * @li NULL - fail */ PRIVATE IX_OSAL_MBUF *ixTimeSyncAccCodeletMbufAllocate () { IX_OSAL_MBUF *mBufPtr; UINT8 *dataPtr; /* Allocate cache-aligned memory for mbuf header */ mBufPtr = (IX_OSAL_MBUF *) IX_OSAL_CACHE_DMA_MALLOC (sizeof (IX_OSAL_MBUF)); if (NULL == mBufPtr) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDERR, "ixTimeSyncAccCodeletMbufAllocate: failed to allocate memory for mBuf\n", 0, 0, 0, 0, 0, 0); return NULL; } /* initialize mBuf */ ixOsalMemSet (mBufPtr, 0, sizeof (IX_OSAL_MBUF)); /* Allocate cache-aligned memory for mbuf data */ dataPtr = (UINT8 *) IX_OSAL_CACHE_DMA_MALLOC (IX_TIMESYNCACC_CODELET_UDP_FRAME_LEN); if (NULL == dataPtr) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDERR, "ixTimeSyncAccCodeletMbufAllocate: failed to allocate memory for mBuf's data buffer\n", 0, 0, 0, 0, 0, 0); return NULL; } /* initialize mBuf's data buffer */ ixOsalMemSet (dataPtr, 0, IX_TIMESYNCACC_CODELET_UDP_FRAME_LEN); /* Fill in mbuf header fields */ IX_OSAL_MBUF_MDATA (mBufPtr) = dataPtr; IX_OSAL_MBUF_ALLOCATED_BUFF_DATA (mBufPtr) = (UINT32)dataPtr; IX_OSAL_MBUF_MLEN (mBufPtr) = IX_TIMESYNCACC_CODELET_UDP_FRAME_LEN; IX_OSAL_MBUF_ALLOCATED_BUFF_LEN (mBufPtr) = IX_TIMESYNCACC_CODELET_UDP_FRAME_LEN; IX_OSAL_MBUF_PKT_LEN (mBufPtr) = IX_TIMESYNCACC_CODELET_UDP_FRAME_LEN; return mBufPtr; } /* end of ixTimeSyncAccCodeletMbufAllocate function */
PUBLIC IX_OSAL_MBUF_POOL * ixOsalNoAllocPoolInit (void *poolBufPtr, void *poolDataPtr, UINT32 count, UINT32 size, const char *name) { UINT32 i, mbufSizeAligned, sizeAligned; IX_OSAL_MBUF *currentMbufPtr = NULL; IX_OSAL_MBUF *nextMbufPtr = NULL; IX_OSAL_MBUF_POOL *poolPtr = NULL; /* * check parameters */ if (poolBufPtr == NULL) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalNoAllocPoolInit(): " "ERROR - NULL poolBufPtr \n", 0, 0, 0, 0, 0, 0); return NULL; } if (count <= 0) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalNoAllocPoolInit(): " "ERROR - count must > 0 \n", 0, 0, 0, 0, 0, 0); return NULL; } if (name == NULL) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalNoAllocPoolInit(): " "ERROR - NULL name ptr \n", 0, 0, 0, 0, 0, 0); return NULL; } if (strlen (name) > IX_OSAL_MBUF_POOL_NAME_LEN) { ixOsalLog (IX_OSAL_LOG_LVL_ERROR, IX_OSAL_LOG_DEV_STDOUT, "ixOsalNoAllocPoolInit(): " "ERROR - name length should be no greater than %d \n", IX_OSAL_MBUF_POOL_NAME_LEN, 0, 0, 0, 0, 0); return NULL; } poolPtr = ixOsalPoolAlloc (); if (poolPtr == NULL) { return NULL; } /* * Adjust sizes to ensure alignment on cache line boundaries */ mbufSizeAligned = IX_OSAL_MBUF_POOL_SIZE_ALIGN (sizeof (IX_OSAL_MBUF)); /* * clear the mbuf memory area */ memset (poolBufPtr, 0, mbufSizeAligned * count); if (poolDataPtr != NULL) { /* * Adjust sizes to ensure alignment on cache line boundaries */ sizeAligned = IX_OSAL_MBUF_POOL_SIZE_ALIGN (size); /* * clear the data memory area */ memset (poolDataPtr, 0, sizeAligned * count); } else { sizeAligned = 0; } /* * initialise pool fields */ strcpy ((poolPtr)->name, name); poolPtr->dataMemPtr = poolDataPtr; poolPtr->mbufMemPtr = poolBufPtr; poolPtr->bufDataSize = sizeAligned; poolPtr->totalBufsInPool = count; poolPtr->mbufMemSize = mbufSizeAligned * count; poolPtr->dataMemSize = sizeAligned * count; currentMbufPtr = (IX_OSAL_MBUF *) poolBufPtr; poolPtr->nextFreeBuf = currentMbufPtr; for (i = 0; i < count; i++) { if (i < (count - 1)) { nextMbufPtr = (IX_OSAL_MBUF *) ((unsigned) currentMbufPtr + mbufSizeAligned); } else { /* last mbuf in chain */ nextMbufPtr = NULL; } IX_OSAL_MBUF_NEXT_BUFFER_IN_PKT_PTR (currentMbufPtr) = nextMbufPtr; IX_OSAL_MBUF_NET_POOL (currentMbufPtr) = poolPtr; IX_OSAL_MBUF_SYS_SIGNATURE_INIT(currentMbufPtr); if (poolDataPtr != NULL) { IX_OSAL_MBUF_MDATA (currentMbufPtr) = poolDataPtr; IX_OSAL_MBUF_ALLOCATED_BUFF_DATA(currentMbufPtr) = (UINT32) poolDataPtr; IX_OSAL_MBUF_MLEN (currentMbufPtr) = sizeAligned; IX_OSAL_MBUF_ALLOCATED_BUFF_LEN(currentMbufPtr) = sizeAligned; poolDataPtr = (void *) ((unsigned) poolDataPtr + sizeAligned); } currentMbufPtr = nextMbufPtr; } /* * update the number of free buffers in the pool */ poolPtr->freeBufsInPool = count; poolPtr->poolAllocType = IX_OSAL_MBUF_POOL_TYPE_USER_ALLOC; return poolPtr; }