269 lines
8.3 KiB
C
269 lines
8.3 KiB
C
/**************************************************************************************************
|
|
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 );
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
****************************************************************************/
|