Use AzureRTOS ThreadX
This commit is contained in:
224
Middlewares/ST/threadx/common/src/txe_byte_pool_create.c
Normal file
224
Middlewares/ST/threadx/common/src/txe_byte_pool_create.c
Normal file
@ -0,0 +1,224 @@
|
||||
/**************************************************************************/
|
||||
/* */
|
||||
/* Copyright (c) Microsoft Corporation. All rights reserved. */
|
||||
/* */
|
||||
/* This software is licensed under the Microsoft Software License */
|
||||
/* Terms for Microsoft Azure RTOS. Full text of the license can be */
|
||||
/* found in the LICENSE file at https://aka.ms/AzureRTOS_EULA */
|
||||
/* and in the root directory of this software. */
|
||||
/* */
|
||||
/**************************************************************************/
|
||||
|
||||
|
||||
/**************************************************************************/
|
||||
/**************************************************************************/
|
||||
/** */
|
||||
/** ThreadX Component */
|
||||
/** */
|
||||
/** Byte Pool */
|
||||
/** */
|
||||
/**************************************************************************/
|
||||
/**************************************************************************/
|
||||
|
||||
#define TX_SOURCE_CODE
|
||||
|
||||
|
||||
/* Include necessary system files. */
|
||||
|
||||
#include "tx_api.h"
|
||||
#include "tx_initialize.h"
|
||||
#include "tx_thread.h"
|
||||
#include "tx_timer.h"
|
||||
#include "tx_byte_pool.h"
|
||||
|
||||
|
||||
/**************************************************************************/
|
||||
/* */
|
||||
/* FUNCTION RELEASE */
|
||||
/* */
|
||||
/* _txe_byte_pool_create PORTABLE C */
|
||||
/* 6.1 */
|
||||
/* AUTHOR */
|
||||
/* */
|
||||
/* William E. Lamie, Microsoft Corporation */
|
||||
/* */
|
||||
/* DESCRIPTION */
|
||||
/* */
|
||||
/* This function checks for errors in the create byte pool memory */
|
||||
/* function. */
|
||||
/* */
|
||||
/* INPUT */
|
||||
/* */
|
||||
/* pool_ptr Pointer to pool control block */
|
||||
/* name_ptr Pointer to byte pool name */
|
||||
/* pool_start Address of beginning of pool area */
|
||||
/* pool_size Number of bytes in the byte pool */
|
||||
/* pool_control_block_size Size of byte pool control block */
|
||||
/* */
|
||||
/* OUTPUT */
|
||||
/* */
|
||||
/* TX_POOL_ERROR Invalid byte pool pointer */
|
||||
/* TX_PTR_ERROR Invalid pool starting address */
|
||||
/* TX_SIZE_ERROR Invalid pool size */
|
||||
/* TX_CALLER_ERROR Invalid caller of this function */
|
||||
/* status Actual completion status */
|
||||
/* */
|
||||
/* CALLS */
|
||||
/* */
|
||||
/* _tx_byte_pool_create Actual byte pool create function */
|
||||
/* _tx_thread_system_preempt_check Check for preemption */
|
||||
/* */
|
||||
/* CALLED BY */
|
||||
/* */
|
||||
/* Application Code */
|
||||
/* */
|
||||
/* RELEASE HISTORY */
|
||||
/* */
|
||||
/* DATE NAME DESCRIPTION */
|
||||
/* */
|
||||
/* 05-19-2020 William E. Lamie Initial Version 6.0 */
|
||||
/* 09-30-2020 Yuxin Zhou Modified comment(s), */
|
||||
/* resulting in version 6.1 */
|
||||
/* */
|
||||
/**************************************************************************/
|
||||
UINT _txe_byte_pool_create(TX_BYTE_POOL *pool_ptr, CHAR *name_ptr, VOID *pool_start, ULONG pool_size, UINT pool_control_block_size)
|
||||
{
|
||||
|
||||
TX_INTERRUPT_SAVE_AREA
|
||||
|
||||
UINT status;
|
||||
ULONG i;
|
||||
TX_BYTE_POOL *next_pool;
|
||||
#ifndef TX_TIMER_PROCESS_IN_ISR
|
||||
TX_THREAD *thread_ptr;
|
||||
#endif
|
||||
|
||||
|
||||
/* Default status to success. */
|
||||
status = TX_SUCCESS;
|
||||
|
||||
/* Check for an invalid byte pool pointer. */
|
||||
if (pool_ptr == TX_NULL)
|
||||
{
|
||||
|
||||
/* Byte pool pointer is invalid, return appropriate error code. */
|
||||
status = TX_POOL_ERROR;
|
||||
}
|
||||
|
||||
/* Now see if the pool control block size is valid. */
|
||||
else if (pool_control_block_size != (sizeof(TX_BYTE_POOL)))
|
||||
{
|
||||
|
||||
/* Byte pool pointer is invalid, return appropriate error code. */
|
||||
status = TX_POOL_ERROR;
|
||||
}
|
||||
else
|
||||
{
|
||||
|
||||
/* Disable interrupts. */
|
||||
TX_DISABLE
|
||||
|
||||
/* Increment the preempt disable flag. */
|
||||
_tx_thread_preempt_disable++;
|
||||
|
||||
/* Restore interrupts. */
|
||||
TX_RESTORE
|
||||
|
||||
/* Next see if it is already in the created list. */
|
||||
next_pool = _tx_byte_pool_created_ptr;
|
||||
for (i = ((ULONG) 0); i < _tx_byte_pool_created_count; i++)
|
||||
{
|
||||
|
||||
/* Determine if this byte pool matches the pool in the list. */
|
||||
if (pool_ptr == next_pool)
|
||||
{
|
||||
|
||||
break;
|
||||
}
|
||||
else
|
||||
{
|
||||
|
||||
/* Move to the next pool. */
|
||||
next_pool = next_pool -> tx_byte_pool_created_next;
|
||||
}
|
||||
}
|
||||
|
||||
/* Disable interrupts. */
|
||||
TX_DISABLE
|
||||
|
||||
/* Decrement the preempt disable flag. */
|
||||
_tx_thread_preempt_disable--;
|
||||
|
||||
/* Restore interrupts. */
|
||||
TX_RESTORE
|
||||
|
||||
/* Check for preemption. */
|
||||
_tx_thread_system_preempt_check();
|
||||
|
||||
/* At this point, check to see if there is a duplicate pool. */
|
||||
if (pool_ptr == next_pool)
|
||||
{
|
||||
|
||||
/* Pool is already created, return appropriate error code. */
|
||||
status = TX_POOL_ERROR;
|
||||
}
|
||||
|
||||
/* Check for an invalid starting address. */
|
||||
else if (pool_start == TX_NULL)
|
||||
{
|
||||
|
||||
/* Null starting address pointer, return appropriate error. */
|
||||
status = TX_PTR_ERROR;
|
||||
}
|
||||
|
||||
/* Check for invalid pool size. */
|
||||
else if (pool_size < TX_BYTE_POOL_MIN)
|
||||
{
|
||||
|
||||
/* Pool not big enough, return appropriate error. */
|
||||
status = TX_SIZE_ERROR;
|
||||
}
|
||||
else
|
||||
{
|
||||
|
||||
#ifndef TX_TIMER_PROCESS_IN_ISR
|
||||
|
||||
/* Pickup thread pointer. */
|
||||
TX_THREAD_GET_CURRENT(thread_ptr)
|
||||
|
||||
/* Check for invalid caller of this function. First check for a calling thread. */
|
||||
if (thread_ptr == &_tx_timer_thread)
|
||||
{
|
||||
|
||||
/* Invalid caller of this function, return appropriate error code. */
|
||||
status = TX_CALLER_ERROR;
|
||||
}
|
||||
#endif
|
||||
|
||||
/* Check for interrupt call. */
|
||||
if (TX_THREAD_GET_SYSTEM_STATE() != ((ULONG) 0))
|
||||
{
|
||||
|
||||
/* Now, make sure the call is from an interrupt and not initialization. */
|
||||
if (TX_THREAD_GET_SYSTEM_STATE() < TX_INITIALIZE_IN_PROGRESS)
|
||||
{
|
||||
|
||||
/* Invalid caller of this function, return appropriate error code. */
|
||||
status = TX_CALLER_ERROR;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* Determine if everything is okay. */
|
||||
if (status == TX_SUCCESS)
|
||||
{
|
||||
|
||||
/* Call actual byte pool create function. */
|
||||
status = _tx_byte_pool_create(pool_ptr, name_ptr, pool_start, pool_size);
|
||||
}
|
||||
|
||||
/* Return completion status. */
|
||||
return(status);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user