found irext example project
This commit is contained in:
268
CC25XX/ti/BLE-CC254x/Components/osal/common/osal_bufmgr.c
Normal file
268
CC25XX/ti/BLE-CC254x/Components/osal/common/osal_bufmgr.c
Normal file
@@ -0,0 +1,268 @@
|
||||
/**************************************************************************************************
|
||||
Filename: osal_bufmgr.c
|
||||
Revised: $Date: 2009-01-29 09:58:32 -0800 (Thu, 29 Jan 2009) $
|
||||
Revision: $Revision: 18882 $
|
||||
|
||||
Description: This file contains the buffer management APIs. These APIs
|
||||
are not reentrant hence cannot be called from an interrupt
|
||||
contex.
|
||||
|
||||
|
||||
Copyright 2008-2009 Texas Instruments Incorporated. All rights reserved.
|
||||
|
||||
IMPORTANT: Your use of this Software is limited to those specific rights
|
||||
granted under the terms of a software license agreement between the user
|
||||
who downloaded the software, his/her employer (which must be your employer)
|
||||
and Texas Instruments Incorporated (the "License"). You may not use this
|
||||
Software unless you agree to abide by the terms of the License. The License
|
||||
limits your use, and you acknowledge, that the Software may not be modified,
|
||||
copied or distributed unless embedded on a Texas Instruments microcontroller
|
||||
or used solely and exclusively in conjunction with a Texas Instruments radio
|
||||
frequency transceiver, which is integrated into your product. Other than for
|
||||
the foregoing purpose, you may not use, reproduce, copy, prepare derivative
|
||||
works of, modify, distribute, perform, display or sell this Software and/or
|
||||
its documentation for any purpose.
|
||||
|
||||
YOU FURTHER ACKNOWLEDGE AND AGREE THAT THE SOFTWARE AND DOCUMENTATION ARE
|
||||
PROVIDED “AS IS” WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESS OR IMPLIED,
|
||||
INCLUDING WITHOUT LIMITATION, ANY WARRANTY OF MERCHANTABILITY, TITLE,
|
||||
NON-INFRINGEMENT AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL
|
||||
TEXAS INSTRUMENTS OR ITS LICENSORS BE LIABLE OR OBLIGATED UNDER CONTRACT,
|
||||
NEGLIGENCE, STRICT LIABILITY, CONTRIBUTION, BREACH OF WARRANTY, OR OTHER
|
||||
LEGAL EQUITABLE THEORY ANY DIRECT OR INDIRECT DAMAGES OR EXPENSES
|
||||
INCLUDING BUT NOT LIMITED TO ANY INCIDENTAL, SPECIAL, INDIRECT, PUNITIVE
|
||||
OR CONSEQUENTIAL DAMAGES, LOST PROFITS OR LOST DATA, COST OF PROCUREMENT
|
||||
OF SUBSTITUTE GOODS, TECHNOLOGY, SERVICES, OR ANY CLAIMS BY THIRD PARTIES
|
||||
(INCLUDING BUT NOT LIMITED TO ANY DEFENSE THEREOF), OR OTHER SIMILAR COSTS.
|
||||
|
||||
Should you have any questions regarding your right to use this Software,
|
||||
contact Texas Instruments Incorporated at www.TI.com.
|
||||
**************************************************************************************************/
|
||||
|
||||
|
||||
/*********************************************************************
|
||||
* INCLUDES
|
||||
*/
|
||||
#include "OSAL.h"
|
||||
#include "OnBoard.h"
|
||||
|
||||
#include "osal_bufmgr.h"
|
||||
|
||||
/*********************************************************************
|
||||
* MACROS
|
||||
*/
|
||||
// 'bd_ptr' used with these macros must be of the type 'bm_desc_t *'
|
||||
#define START_PTR( bd_ptr ) ( (bd_ptr) + 1 )
|
||||
#define END_PTR( bd_ptr ) ( (uint8 *)START_PTR( bd_ptr ) + (bd_ptr)->payload_len )
|
||||
|
||||
/*********************************************************************
|
||||
* CONSTANTS
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* TYPEDEFS
|
||||
*/
|
||||
typedef struct bm_desc
|
||||
{
|
||||
struct bm_desc *next_ptr; // pointer to next buffer descriptor
|
||||
uint16 payload_len; // length of user's buffer
|
||||
} bm_desc_t;
|
||||
|
||||
/*********************************************************************
|
||||
* GLOBAL VARIABLES
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* GLOBAL FUNCTIONS
|
||||
*/
|
||||
|
||||
/*********************************************************************
|
||||
* LOCAL VARIABLES
|
||||
*/
|
||||
// Linked list of allocated buffer descriptors
|
||||
static bm_desc_t *bm_list_ptr = NULL;
|
||||
|
||||
/*********************************************************************
|
||||
* LOCAL FUNCTIONS
|
||||
*/
|
||||
static bm_desc_t *bm_desc_from_payload ( uint8 *payload_ptr );
|
||||
|
||||
/*********************************************************************
|
||||
* @fn osal_bm_alloc
|
||||
*
|
||||
* @brief Implementation of the allocator functionality.
|
||||
*
|
||||
* WARNING: THIS FUNCTION CAN BE CALLED ONLY FROM THE BOTTOM
|
||||
* LAYER OF THE STACK (HCI FOR DUAL MODE AND LINK
|
||||
* LAYER FOR SINGLE MODE).
|
||||
*
|
||||
* @param size - number of bytes to allocate from the heap.
|
||||
*
|
||||
* @return pointer to the heap allocation; NULL if error or failure.
|
||||
*/
|
||||
void *osal_bm_alloc( uint16 size )
|
||||
{
|
||||
bm_desc_t *bd_ptr;
|
||||
|
||||
bd_ptr = osal_mem_alloc( sizeof( bm_desc_t ) + size );
|
||||
if ( bd_ptr != NULL )
|
||||
{
|
||||
// set the buffer descriptor info
|
||||
bd_ptr->payload_len = size;
|
||||
|
||||
// add item to the beginning of the list
|
||||
bd_ptr->next_ptr = bm_list_ptr;
|
||||
bm_list_ptr = bd_ptr;
|
||||
|
||||
// return start of the buffer
|
||||
return ( (void *)START_PTR( bd_ptr ) );
|
||||
}
|
||||
|
||||
return ( (void *)NULL );
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn osal_bm_free
|
||||
*
|
||||
* @brief Implementation of the de-allocator functionality.
|
||||
*
|
||||
* @param payload_ptr - pointer to the memory to free.
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
void osal_bm_free( void *payload_ptr )
|
||||
{
|
||||
bm_desc_t *loop_ptr;
|
||||
bm_desc_t *prev_ptr = NULL;
|
||||
|
||||
loop_ptr = bm_list_ptr;
|
||||
while ( loop_ptr != NULL )
|
||||
{
|
||||
if ( payload_ptr >= (void *)START_PTR( loop_ptr ) &&
|
||||
payload_ptr <= (void *)END_PTR( loop_ptr) )
|
||||
{
|
||||
// unlink item from the linked list
|
||||
if ( prev_ptr == NULL )
|
||||
{
|
||||
// it's the first item on the list
|
||||
bm_list_ptr = loop_ptr->next_ptr;
|
||||
}
|
||||
else
|
||||
{
|
||||
prev_ptr->next_ptr = loop_ptr->next_ptr;
|
||||
}
|
||||
|
||||
// free the memory
|
||||
osal_mem_free( loop_ptr );
|
||||
|
||||
// we're done here
|
||||
break;
|
||||
}
|
||||
|
||||
// move on to next item
|
||||
prev_ptr = loop_ptr;
|
||||
loop_ptr = loop_ptr->next_ptr;
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn osal_bm_adjust_header
|
||||
*
|
||||
* @brief Add or remove header space for the payload pointer. A positive
|
||||
* adjustment adds header space, and negative removes header space.
|
||||
*
|
||||
* @param payload_ptr - pointer to payload
|
||||
* @param size - +/- number of bytes to move (affecting header area)
|
||||
*
|
||||
* @return pointer to payload at the new adjusted location
|
||||
*/
|
||||
void *osal_bm_adjust_header( void *payload_ptr, int16 size )
|
||||
{
|
||||
bm_desc_t *bd_ptr;
|
||||
uint8 *new_payload_ptr;
|
||||
|
||||
bd_ptr = bm_desc_from_payload( (uint8 *)payload_ptr );
|
||||
if ( bd_ptr != NULL )
|
||||
{
|
||||
new_payload_ptr = (uint8 *)( (uint8 *)payload_ptr - size );
|
||||
|
||||
// make sure the new payload is within valid range
|
||||
if ( new_payload_ptr >= (uint8 *)START_PTR( bd_ptr ) &&
|
||||
new_payload_ptr <= (uint8 *)END_PTR( bd_ptr ) )
|
||||
{
|
||||
// return new payload pointer
|
||||
return ( (void *)new_payload_ptr );
|
||||
}
|
||||
}
|
||||
|
||||
// return original value
|
||||
return ( payload_ptr );
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn osal_bm_adjust_tail
|
||||
*
|
||||
* @brief Add or remove tail space for the payload pointer. A positive
|
||||
* adjustment adds tail space, and negative removes tail space.
|
||||
*
|
||||
* @param payload_ptr - pointer to payload
|
||||
* @param size - +/- number of bytes to move (affecting header area)
|
||||
*
|
||||
* @return pointer to payload at the new adjusted location
|
||||
*/
|
||||
void *osal_bm_adjust_tail( void *payload_ptr, int16 size )
|
||||
{
|
||||
bm_desc_t *bd_ptr;
|
||||
uint8 *new_payload_ptr;
|
||||
|
||||
bd_ptr = bm_desc_from_payload( (uint8 *)payload_ptr );
|
||||
if ( bd_ptr != NULL )
|
||||
{
|
||||
new_payload_ptr = (uint8 *)END_PTR( bd_ptr ) - size;
|
||||
|
||||
// make sure the new payload is within valid range
|
||||
if ( new_payload_ptr >= (uint8 *)START_PTR( bd_ptr ) &&
|
||||
new_payload_ptr <= (uint8 *)END_PTR( bd_ptr ) )
|
||||
{
|
||||
// return new payload pointer
|
||||
return ( (void *)new_payload_ptr );
|
||||
}
|
||||
}
|
||||
|
||||
// return original value
|
||||
return ( payload_ptr );
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn bm_desc_from_payload
|
||||
*
|
||||
* @brief Find buffer descriptor from payload pointer
|
||||
*
|
||||
* @param payload_ptr - pointer to payload
|
||||
*
|
||||
* @return pointer to buffer descriptor
|
||||
*/
|
||||
static bm_desc_t *bm_desc_from_payload ( uint8 *payload_ptr )
|
||||
{
|
||||
bm_desc_t *loop_ptr;
|
||||
|
||||
loop_ptr = bm_list_ptr;
|
||||
while ( loop_ptr != NULL )
|
||||
{
|
||||
if ( payload_ptr >= (uint8 *)START_PTR( loop_ptr ) &&
|
||||
payload_ptr <= (uint8 *)END_PTR( loop_ptr) )
|
||||
{
|
||||
// item found
|
||||
break;
|
||||
}
|
||||
|
||||
// move on to next item
|
||||
loop_ptr = loop_ptr->next_ptr;
|
||||
}
|
||||
|
||||
return ( loop_ptr );
|
||||
}
|
||||
|
||||
|
||||
/****************************************************************************
|
||||
****************************************************************************/
|
||||
Reference in New Issue
Block a user