Path: blob/main/sys/contrib/ncsw/Peripherals/BM/bm_pool.c
48378 views
/******************************************************************************12� 1995-2003, 2004, 2005-2011 Freescale Semiconductor, Inc.3All rights reserved.45This is proprietary source code of Freescale Semiconductor Inc.,6and its use is subject to the NetComm Device Drivers EULA.7The copyright notice above does not evidence any actual or intended8publication of such source code.910ALTERNATIVELY, redistribution and use in source and binary forms, with11or without modification, are permitted provided that the following12conditions are met:13* Redistributions of source code must retain the above copyright14notice, this list of conditions and the following disclaimer.15* Redistributions in binary form must reproduce the above copyright16notice, this list of conditions and the following disclaimer in the17documentation and/or other materials provided with the distribution.18* Neither the name of Freescale Semiconductor nor the19names of its contributors may be used to endorse or promote products20derived from this software without specific prior written permission.2122THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY23EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED24WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE25DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY26DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES27(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;28LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND29ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT30(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS31SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.32*3334**************************************************************************/35/******************************************************************************36@File bm.c3738@Description BM39*//***************************************************************************/40#include "error_ext.h"41#include "std_ext.h"42#include "string_ext.h"43#include "mem_ext.h"44#include "core_ext.h"4546#include "bm.h"474849#define __ERR_MODULE__ MODULE_BM505152/****************************************/53/* static functions */54/****************************************/5556/* (De)Registration of depletion notification callbacks */57static void depletion_link(t_BmPool *p_BmPool)58{59t_BmPortal *p_Portal = (t_BmPortal *)p_BmPool->h_BmPortal;6061NCSW_PLOCK(p_Portal);62p_Portal->depletionPoolsTable[p_BmPool->bpid] = p_BmPool;63bm_isr_bscn_mask(p_Portal->p_BmPortalLow, (uint8_t)p_BmPool->bpid, 1);64PUNLOCK(p_Portal);65}6667static void depletion_unlink(t_BmPool *p_BmPool)68{69t_BmPortal *p_Portal = (t_BmPortal *)p_BmPool->h_BmPortal;7071NCSW_PLOCK(p_Portal);72p_Portal->depletionPoolsTable[p_BmPool->bpid] = NULL;73bm_isr_bscn_mask(p_Portal->p_BmPortalLow, (uint8_t)p_BmPool->bpid, 0);74PUNLOCK(p_Portal);75}7677static t_Error BmPoolRelease(t_BmPool *p_BmPool,78t_Handle h_BmPortal,79struct bm_buffer *bufs,80uint8_t num,81uint32_t flags)82{83ASSERT_COND(num && (num <= 8));84if (p_BmPool->flags & BMAN_POOL_FLAG_NO_RELEASE)85return ERROR_CODE(E_INVALID_VALUE);8687/* Without stockpile, this API is a pass-through to the h/w operation */88if (!(p_BmPool->flags & BMAN_POOL_FLAG_STOCKPILE))89return BmPortalRelease(h_BmPortal, p_BmPool->bpid, bufs, num, flags);9091/* This needs some explanation. Adding the given buffers may take the92* stockpile over the threshold, but in fact the stockpile may already93* *be* over the threshold if a previous release-to-hw attempt had94* failed. So we have 3 cases to cover;95* 1. we add to the stockpile and don't hit the threshold,96* 2. we add to the stockpile, hit the threshold and release-to-hw,97* 3. we have to release-to-hw before adding to the stockpile98* (not enough room in the stockpile for case 2).99* Our constraints on thresholds guarantee that in case 3, there must be100* at least 8 bufs already in the stockpile, so all release-to-hw ops101* are for 8 bufs. Despite all this, the API must indicate whether the102* given buffers were taken off the caller's hands, irrespective of103* whether a release-to-hw was attempted. */104while (num)105{106/* Add buffers to stockpile if they fit */107if ((p_BmPool->spFill + num) <= p_BmPool->spMaxBufs)108{109memcpy(PTR_MOVE(p_BmPool->sp, sizeof(struct bm_buffer) * (p_BmPool->spFill)),110bufs,111sizeof(struct bm_buffer) * num);112p_BmPool->spFill += num;113num = 0; /* --> will return success no matter what */114}115else116/* Do hw op if hitting the high-water threshold */117{118t_Error ret = BmPortalRelease(h_BmPortal,119p_BmPool->bpid,120(struct bm_buffer *)PTR_MOVE(p_BmPool->sp, sizeof(struct bm_buffer) * (p_BmPool->spFill - p_BmPool->spBufsCmd)),121p_BmPool->spBufsCmd,122flags);123if (ret)124return (num ? ret : E_OK);125p_BmPool->spFill -= p_BmPool->spBufsCmd;126}127}128129return E_OK;130}131132static int BmPoolAcquire(t_BmPool *p_BmPool,t_Handle h_BmPortal,133struct bm_buffer *bufs, uint8_t num, uint32_t flags)134{135ASSERT_COND(IN_RANGE(1, num, 8));136if (p_BmPool->flags & BMAN_POOL_FLAG_ONLY_RELEASE)137return 0;138139/* Without stockpile, this API is a pass-through to the h/w operation */140if (!(p_BmPool->flags & BMAN_POOL_FLAG_STOCKPILE))141return BmPortalAcquire(h_BmPortal, p_BmPool->bpid, bufs, num);142/* Only need a h/w op if we'll hit the low-water thresh */143if (!(flags & BMAN_ACQUIRE_FLAG_STOCKPILE) &&144((p_BmPool->spFill - num) < p_BmPool->spMinBufs))145{146p_BmPool->spFill += BmPortalAcquire(h_BmPortal,147p_BmPool->bpid,148(struct bm_buffer *)PTR_MOVE(p_BmPool->sp, sizeof(struct bm_buffer) * (p_BmPool->spFill)),149p_BmPool->spBufsCmd);150}151else if (p_BmPool->spFill < num)152return 0;153if (!p_BmPool->spFill)154return 0;155memcpy(bufs,156PTR_MOVE(p_BmPool->sp, sizeof(struct bm_buffer) * (p_BmPool->spFill - num)),157sizeof(struct bm_buffer) * num);158p_BmPool->spFill -= num;159return num;160}161162static t_Error BmPoolFree(t_BmPool *p_BmPool, bool discardBuffers)163{164t_Handle h_BufContext;165void *p_Data;166167ASSERT_COND(p_BmPool);168169if (!p_BmPool->shadowMode)170{171if (p_BmPool->flags & BMAN_POOL_FLAG_DEPLETION)172{173depletion_unlink(p_BmPool);174BmUnSetPoolThresholds(p_BmPool->h_Bm, p_BmPool->bpid);175}176while (TRUE)177{178p_Data = BM_POOL_GetBuf(p_BmPool, p_BmPool->h_BmPortal);179if (!p_Data)180break;181h_BufContext = BM_POOL_GetBufferContext(p_BmPool, p_Data);182if (!discardBuffers)183p_BmPool->bufferPoolInfo.f_PutBuf(p_BmPool->bufferPoolInfo.h_BufferPool, p_Data, h_BufContext);184}185BmBpidPut(p_BmPool->h_Bm, p_BmPool->bpid);186}187188if (p_BmPool->sp)189XX_Free(p_BmPool->sp);190191XX_Free(p_BmPool);192193return E_OK;194}195196/****************************************/197/* API Init unit functions */198/****************************************/199200t_Handle BM_POOL_Config(t_BmPoolParam *p_BmPoolParam)201{202t_BmPool *p_BmPool;203204SANITY_CHECK_RETURN_VALUE(p_BmPoolParam, E_INVALID_HANDLE, NULL);205SANITY_CHECK_RETURN_VALUE(p_BmPoolParam->h_Bm, E_INVALID_HANDLE, NULL);206SANITY_CHECK_RETURN_VALUE((p_BmPoolParam->shadowMode ||207(p_BmPoolParam->bufferPoolInfo.h_BufferPool &&208p_BmPoolParam->bufferPoolInfo.f_GetBuf &&209p_BmPoolParam->bufferPoolInfo.f_PutBuf &&210p_BmPoolParam->bufferPoolInfo.bufferSize)), E_INVALID_STATE, NULL);211212p_BmPool = (t_BmPool*)XX_Malloc(sizeof(t_BmPool));213if (!p_BmPool)214{215REPORT_ERROR(MAJOR, E_NO_MEMORY, ("BM Pool obj!!!"));216return NULL;217}218memset(p_BmPool, 0, sizeof(t_BmPool));219220p_BmPool->p_BmPoolDriverParams = (t_BmPoolDriverParams *)XX_Malloc(sizeof(t_BmPoolDriverParams));221if (!p_BmPool->p_BmPoolDriverParams)222{223XX_Free(p_BmPool);224REPORT_ERROR(MAJOR, E_NO_MEMORY, ("Bm Pool driver parameters"));225return NULL;226}227memset(p_BmPool->p_BmPoolDriverParams, 0, sizeof(t_BmPoolDriverParams));228229p_BmPool->h_Bm = p_BmPoolParam->h_Bm;230p_BmPool->h_BmPortal = p_BmPoolParam->h_BmPortal;231p_BmPool->h_App = p_BmPoolParam->h_App;232p_BmPool->numOfBuffers = p_BmPoolParam->numOfBuffers;233p_BmPool->shadowMode = p_BmPoolParam->shadowMode;234235if (!p_BmPool->h_BmPortal)236{237p_BmPool->h_BmPortal = BmGetPortalHandle(p_BmPool->h_Bm);238SANITY_CHECK_RETURN_VALUE(p_BmPool->h_BmPortal, E_INVALID_HANDLE, NULL);239}240241memcpy(&p_BmPool->bufferPoolInfo, &p_BmPoolParam->bufferPoolInfo, sizeof(t_BufferPoolInfo));242if (!p_BmPool->bufferPoolInfo.f_PhysToVirt)243p_BmPool->bufferPoolInfo.f_PhysToVirt = XX_PhysToVirt;244if (!p_BmPool->bufferPoolInfo.f_VirtToPhys)245p_BmPool->bufferPoolInfo.f_VirtToPhys = XX_VirtToPhys;246247p_BmPool->p_BmPoolDriverParams->dynamicBpid = DEFAULT_dynamicBpid;248p_BmPool->p_BmPoolDriverParams->useDepletion = DEFAULT_useDepletion;249p_BmPool->p_BmPoolDriverParams->useStockpile = DEFAULT_useStockpile;250251if (p_BmPool->shadowMode)252{253p_BmPool->numOfBuffers = 0;254BM_POOL_ConfigBpid(p_BmPool, p_BmPoolParam->bpid);255}256257return p_BmPool;258}259260t_Error BM_POOL_Init(t_Handle h_BmPool)261{262t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;263t_Error err;264265SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);266SANITY_CHECK_RETURN_ERROR(p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE);267268p_BmPool->flags |= (p_BmPool->p_BmPoolDriverParams->dynamicBpid)?BMAN_POOL_FLAG_DYNAMIC_BPID:0;269p_BmPool->flags |= (p_BmPool->p_BmPoolDriverParams->useStockpile)?BMAN_POOL_FLAG_STOCKPILE:0;270p_BmPool->flags |= ((!p_BmPool->shadowMode) &&271(p_BmPool->p_BmPoolDriverParams->useDepletion))?BMAN_POOL_FLAG_DEPLETION:0;272273if (p_BmPool->flags & BMAN_POOL_FLAG_DYNAMIC_BPID)274{275if((p_BmPool->bpid = (uint8_t)BmBpidGet(p_BmPool->h_Bm, FALSE, (uint32_t)0)) == (uint8_t)ILLEGAL_BASE)276{277BM_POOL_Free(p_BmPool);278RETURN_ERROR(CRITICAL, E_INVALID_STATE, ("can't allocate new dynamic pool id"));279}280}281else282{283if (BmBpidGet(p_BmPool->h_Bm, TRUE, (uint32_t)p_BmPool->bpid) == (uint32_t)ILLEGAL_BASE)284{285BM_POOL_Free(p_BmPool);286RETURN_ERROR(CRITICAL, E_INVALID_STATE, ("can't force pool id %d", p_BmPool->bpid));287}288}289if (p_BmPool->flags & BMAN_POOL_FLAG_DEPLETION)290{291if(BmSetPoolThresholds(p_BmPool->h_Bm, p_BmPool->bpid, p_BmPool->p_BmPoolDriverParams->depletionThresholds))292{293BM_POOL_Free(p_BmPool);294RETURN_ERROR(MAJOR, E_INVALID_STATE, ("can't set thresh for pool bpid %d",p_BmPool->bpid));295}296297depletion_link(p_BmPool);298}299300if (p_BmPool->flags & BMAN_POOL_FLAG_STOCKPILE)301{302p_BmPool->sp = (struct bm_buffer *)XX_Malloc(sizeof(struct bm_buffer) * p_BmPool->spMaxBufs);303if (!p_BmPool->sp)304{305BM_POOL_Free(p_BmPool);306RETURN_ERROR(MAJOR, E_NO_MEMORY, ("Bm Pool Stockpile"));307}308memset(p_BmPool->sp, 0, sizeof(struct bm_buffer) * p_BmPool->spMaxBufs);309}310311XX_Free(p_BmPool->p_BmPoolDriverParams);312p_BmPool->p_BmPoolDriverParams = NULL;313314/*******************/315/* Create buffers */316/*******************/317if ((err = BM_POOL_FillBufs (p_BmPool, p_BmPool->h_BmPortal, p_BmPool->numOfBuffers)) != E_OK)318{319BM_POOL_Free(p_BmPool);320RETURN_ERROR(MAJOR, err, NO_MSG);321}322323return E_OK;324}325326t_Error BM_POOL_Free(t_Handle h_BmPool)327{328SANITY_CHECK_RETURN_ERROR(h_BmPool, E_INVALID_HANDLE);329330return BmPoolFree(h_BmPool, FALSE);331}332333t_Error BM_POOL_ConfigBpid(t_Handle h_BmPool, uint8_t bpid)334{335t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;336337SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);338SANITY_CHECK_RETURN_ERROR(p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE);339SANITY_CHECK_RETURN_ERROR(bpid < BM_MAX_NUM_OF_POOLS, E_INVALID_VALUE);340341p_BmPool->p_BmPoolDriverParams->dynamicBpid = FALSE;342p_BmPool->bpid = bpid;343344return E_OK;345}346347348t_Error BM_POOL_ConfigDepletion(t_Handle h_BmPool, t_BmDepletionCallback *f_Depletion, uint32_t *p_Thresholds)349{350t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;351352SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);353SANITY_CHECK_RETURN_ERROR(p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE);354SANITY_CHECK_RETURN_ERROR(f_Depletion, E_INVALID_HANDLE);355356p_BmPool->p_BmPoolDriverParams->useDepletion = TRUE;357p_BmPool->f_Depletion = f_Depletion;358memcpy(&p_BmPool->p_BmPoolDriverParams->depletionThresholds,359p_Thresholds,360sizeof(p_BmPool->p_BmPoolDriverParams->depletionThresholds));361362return E_OK;363}364365t_Error BM_POOL_ConfigStockpile(t_Handle h_BmPool, uint16_t maxBuffers, uint16_t minBuffers)366{367t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;368369SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);370SANITY_CHECK_RETURN_ERROR(p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE);371SANITY_CHECK_RETURN_ERROR(maxBuffers, E_INVALID_STATE);372SANITY_CHECK_RETURN_ERROR(maxBuffers >= minBuffers, E_INVALID_STATE);373SANITY_CHECK_RETURN_ERROR((p_BmPool->shadowMode ||374((maxBuffers * 2) <= p_BmPool->numOfBuffers)),375E_INVALID_STATE);376377p_BmPool->p_BmPoolDriverParams->useStockpile = TRUE;378p_BmPool->spMaxBufs = maxBuffers;379p_BmPool->spMinBufs = minBuffers;380p_BmPool->spBufsCmd = DEFAULT_numOfBufsPerCmd;381382SANITY_CHECK_RETURN_ERROR((p_BmPool->spMaxBufs >=383(p_BmPool->spMinBufs + p_BmPool->spBufsCmd)),384E_INVALID_STATE);385386return E_OK;387}388389t_Error BM_POOL_ConfigBuffContextMode(t_Handle h_BmPool, bool en)390{391t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;392393SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);394SANITY_CHECK_RETURN_ERROR(p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE);395396p_BmPool->noBuffCtxt = !en;397398return E_OK;399}400401void * BM_POOL_GetBuf(t_Handle h_BmPool, t_Handle h_BmPortal)402{403t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;404struct bm_buffer bufs[1];405uint8_t retBufsNum;406uint64_t physAddr;407uint32_t flags = 0;408409SANITY_CHECK_RETURN_VALUE(p_BmPool, E_INVALID_HANDLE, NULL);410SANITY_CHECK_RETURN_VALUE(!p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE, NULL);411SANITY_CHECK_RETURN_VALUE(p_BmPool->bufferPoolInfo.f_PhysToVirt, E_INVALID_STATE, NULL);412413if (!h_BmPortal)414{415if (p_BmPool->h_BmPortal)416h_BmPortal = p_BmPool->h_BmPortal;417else418{419SANITY_CHECK_RETURN_VALUE(p_BmPool->h_Bm, E_INVALID_HANDLE, NULL);420h_BmPortal = BmGetPortalHandle(p_BmPool->h_Bm);421SANITY_CHECK_RETURN_VALUE(h_BmPortal, E_INVALID_HANDLE, NULL);422}423}424425retBufsNum = (uint8_t)BmPoolAcquire(p_BmPool, h_BmPortal, bufs, 1, flags);426if (!retBufsNum)427{428REPORT_ERROR(TRACE, E_NOT_AVAILABLE, ("buffer"));429return NULL;430}431physAddr = (uint64_t)bufs[0].lo;432physAddr |= (uint64_t)(((uint64_t)bufs[0].hi << 32) & 0x000000ff00000000LL);433DBG(TRACE,("Get Buffer : poolId %d, address 0x%016llx",434p_BmPool->bpid,435p_BmPool->bufferPoolInfo.f_PhysToVirt((physAddress_t)physAddr)));436437return p_BmPool->bufferPoolInfo.f_PhysToVirt((physAddress_t)physAddr);438}439440t_Error BM_POOL_PutBuf(t_Handle h_BmPool, t_Handle h_BmPortal, void *p_Buff)441{442t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;443uint64_t physAddress;444struct bm_buffer bufs[1];445446SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);447SANITY_CHECK_RETURN_ERROR(!p_BmPool->p_BmPoolDriverParams, E_INVALID_STATE);448SANITY_CHECK_RETURN_ERROR(p_Buff, E_NULL_POINTER);449450physAddress = (uint64_t)(XX_VirtToPhys(p_Buff));451452bufs[0].bpid = p_BmPool->bpid;453bufs[0].hi = (uint8_t)((physAddress & 0x000000ff00000000LL) >> 32);454bufs[0].lo = (uint32_t)(physAddress & 0xffffffff);455456DBG(TRACE,("Put Buffer : poolId %d, address 0x%016llx, phys 0x%016llx",457p_BmPool->bpid, (uint64_t)PTR_TO_UINT(p_Buff), physAddress));458459if (!h_BmPortal)460{461if (p_BmPool->h_BmPortal)462h_BmPortal = p_BmPool->h_BmPortal;463else464{465SANITY_CHECK_RETURN_ERROR(p_BmPool->h_Bm, E_INVALID_HANDLE);466h_BmPortal = BmGetPortalHandle(p_BmPool->h_Bm);467SANITY_CHECK_RETURN_ERROR(h_BmPortal, E_INVALID_HANDLE);468}469}470471return BmPoolRelease(p_BmPool, h_BmPortal, bufs, 1, BMAN_RELEASE_FLAG_WAIT);472}473474t_Error BM_POOL_FillBufs(t_Handle h_BmPool, t_Handle h_BmPortal, uint32_t numBufs)475{476t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;477478SANITY_CHECK_RETURN_ERROR(p_BmPool, E_INVALID_HANDLE);479SANITY_CHECK_RETURN_ERROR(!p_BmPool->p_BmPoolDriverParams, E_INVALID_STATE);480481if (!h_BmPortal)482{483if (p_BmPool->h_BmPortal)484h_BmPortal = p_BmPool->h_BmPortal;485else486{487SANITY_CHECK_RETURN_ERROR(p_BmPool->h_Bm, E_INVALID_HANDLE);488h_BmPortal = BmGetPortalHandle(p_BmPool->h_Bm);489SANITY_CHECK_RETURN_ERROR(h_BmPortal, E_INVALID_HANDLE);490}491}492493while (numBufs--)494{495uint8_t *p_Data;496t_Error res;497t_Handle h_BufContext;498499p_Data = p_BmPool->bufferPoolInfo.f_GetBuf(p_BmPool->bufferPoolInfo.h_BufferPool, &h_BufContext);500if(!p_Data)501RETURN_ERROR(MAJOR, E_INVALID_STATE, ("run-out of buffers for bpid %d",p_BmPool->bpid));502503if (!p_BmPool->noBuffCtxt)504*(t_Handle *)(p_Data - sizeof(t_Handle)) = h_BufContext;505506if ((res = BM_POOL_PutBuf(p_BmPool, h_BmPortal, p_Data)) != E_OK)507RETURN_ERROR(CRITICAL, res, ("Seeding reserved buffer pool failed"));508}509510return E_OK;511}512513uint8_t BM_POOL_GetId(t_Handle h_BmPool)514{515t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;516517SANITY_CHECK_RETURN_VALUE(p_BmPool, E_INVALID_HANDLE, 0);518SANITY_CHECK_RETURN_VALUE(!p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE, 0);519520return p_BmPool->bpid;521}522523uint16_t BM_POOL_GetBufferSize(t_Handle h_BmPool)524{525t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;526527SANITY_CHECK_RETURN_VALUE(p_BmPool, E_INVALID_HANDLE, 0);528SANITY_CHECK_RETURN_VALUE(!p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE, 0);529530return p_BmPool->bufferPoolInfo.bufferSize;531}532533t_Handle BM_POOL_GetBufferContext(t_Handle h_BmPool, void *p_Buff)534{535t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;536537SANITY_CHECK_RETURN_VALUE(p_BmPool, E_INVALID_HANDLE, NULL);538SANITY_CHECK_RETURN_VALUE(!p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE, NULL);539SANITY_CHECK_RETURN_VALUE(p_Buff, E_NULL_POINTER, NULL);540541if (p_BmPool->noBuffCtxt)542return NULL;543544return *(t_Handle *)PTR_MOVE(p_Buff, -(sizeof(t_Handle)));545}546547uint32_t BM_POOL_GetCounter(t_Handle h_BmPool, e_BmPoolCounters counter)548{549t_BmPool *p_BmPool = (t_BmPool *)h_BmPool;550551SANITY_CHECK_RETURN_VALUE(p_BmPool, E_INVALID_HANDLE, 0);552SANITY_CHECK_RETURN_VALUE(!p_BmPool->p_BmPoolDriverParams, E_INVALID_HANDLE, 0);553554switch(counter)555{556case(e_BM_POOL_COUNTERS_CONTENT):557return BmGetCounter(p_BmPool->h_Bm, e_BM_IM_COUNTERS_POOL_CONTENT, p_BmPool->bpid);558case(e_BM_POOL_COUNTERS_SW_DEPLETION):559return (p_BmPool->swDepletionCount +=560BmGetCounter(p_BmPool->h_Bm, e_BM_IM_COUNTERS_POOL_SW_DEPLETION, p_BmPool->bpid));561case(e_BM_POOL_COUNTERS_HW_DEPLETION):562return (p_BmPool->hwDepletionCount +=563BmGetCounter(p_BmPool->h_Bm, e_BM_IM_COUNTERS_POOL_HW_DEPLETION, p_BmPool->bpid));564default:565break;566}567568/* should never get here */569ASSERT_COND(FALSE);570571return 0;572}573574575