123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189 |
- #include <string.h>
- #include <stdint.h>
- #include <stdbool.h>
- #include "app_util.h"
- #include "nrf_atfifo.h"
- #include "nrf_atfifo_internal.h"
- #if NRF_ATFIFO_CONFIG_LOG_ENABLED
- #define NRF_LOG_LEVEL NRF_ATFIFO_CONFIG_LOG_LEVEL
- #define NRF_LOG_INIT_FILTER_LEVEL NRF_ATFIFO_CONFIG_LOG_INIT_FILTER_LEVEL
- #define NRF_LOG_INFO_COLOR NRF_ATFIFO_CONFIG_INFO_COLOR
- #define NRF_LOG_DEBUG_COLOR NRF_ATFIFO_CONFIG_DEBUG_COLOR
- #else
- #define NRF_LOG_LEVEL 0
- #endif
- #include "nrf_log.h"
- STATIC_ASSERT(sizeof(nrf_atfifo_postag_t) == sizeof(uint32_t));
- ret_code_t nrf_atfifo_init(nrf_atfifo_t * const p_fifo, void * p_buf, uint16_t buf_size, uint16_t item_size)
- {
- if (NULL == p_buf)
- {
- NRF_LOG_INST_ERROR(p_fifo->p_log, "Initialization failed. p_buf == NULL");
- return NRF_ERROR_NULL;
- }
- if (0 != (buf_size % item_size))
- {
- NRF_LOG_INST_ERROR(p_fifo->p_log, "Initialization failed. Buf_size not multiple of item_size");
- return NRF_ERROR_INVALID_LENGTH;
- }
- p_fifo->p_buf = p_buf;
- p_fifo->tail.tag = 0;
- p_fifo->head.tag = 0;
- p_fifo->buf_size = buf_size;
- p_fifo->item_size = item_size;
- NRF_LOG_INST_INFO(p_fifo->p_log, "Initialized.");
- return NRF_SUCCESS;
- }
- ret_code_t nrf_atfifo_clear(nrf_atfifo_t * const p_fifo)
- {
- bool released = nrf_atfifo_space_clear(p_fifo);
- NRF_LOG_INST_INFO(p_fifo->p_log, "Cleared result:%s", released ? "success" : "busy");
- return released ? NRF_SUCCESS : NRF_ERROR_BUSY;
- }
- ret_code_t nrf_atfifo_alloc_put(nrf_atfifo_t * const p_fifo, void const * p_var, size_t size, bool * const p_visible)
- {
- nrf_atfifo_item_put_t context;
- bool visible;
- void * p_data = nrf_atfifo_item_alloc(p_fifo, &context);
- if (NULL == p_data)
- {
- NRF_LOG_INST_WARNING(p_fifo->p_log, "Copying in element (0x%08X) failed - no space.", p_var);
- return NRF_ERROR_NO_MEM;
- }
- memcpy(p_data, p_var, size);
- visible = nrf_atfifo_item_put(p_fifo, &context);
- if (NULL != p_visible)
- {
- *p_visible = visible;
- }
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Element (0x%08X) copied in.", p_var);
- return NRF_SUCCESS;
- }
- void * nrf_atfifo_item_alloc(nrf_atfifo_t * const p_fifo, nrf_atfifo_item_put_t * p_context)
- {
- if (nrf_atfifo_wspace_req(p_fifo, &(p_context->last_tail)))
- {
- void * p_item = ((uint8_t*)(p_fifo->p_buf)) + p_context->last_tail.pos.wr;
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Allocated element (0x%08X).", p_item);
- return p_item;
- }
- NRF_LOG_INST_WARNING(p_fifo->p_log, "Allocation failed - no space.");
- return NULL;
- }
- bool nrf_atfifo_item_put(nrf_atfifo_t * const p_fifo, nrf_atfifo_item_put_t * p_context)
- {
- if ((p_context->last_tail.pos.wr) == (p_context->last_tail.pos.rd))
- {
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Put (uninterrupted)");
- nrf_atfifo_wspace_close(p_fifo);
- return true;
- }
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Put (interrupted!)");
- return false;
- }
- ret_code_t nrf_atfifo_get_free(nrf_atfifo_t * const p_fifo, void * const p_var, size_t size, bool * p_released)
- {
- nrf_atfifo_item_get_t context;
- bool released;
- void const * p_s = nrf_atfifo_item_get(p_fifo, &context);
- if (NULL == p_s)
- {
- NRF_LOG_INST_WARNING(p_fifo->p_log, "Copying out failed - no item in the FIFO.");
- return NRF_ERROR_NOT_FOUND;
- }
- memcpy(p_var, p_s, size);
- released = nrf_atfifo_item_free(p_fifo, &context);
- if (NULL != p_released)
- {
- *p_released = released;
- }
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Element (0x%08X) copied out.", p_var);
- return NRF_SUCCESS;
- }
- void * nrf_atfifo_item_get(nrf_atfifo_t * const p_fifo, nrf_atfifo_item_get_t * p_context)
- {
- if (nrf_atfifo_rspace_req(p_fifo, &(p_context->last_head)))
- {
- void * p_item = ((uint8_t*)(p_fifo->p_buf)) + p_context->last_head.pos.rd;
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Get element: 0x%08X", p_item);
- return p_item;
- }
- NRF_LOG_INST_WARNING(p_fifo->p_log, "Get failed - no item in the FIFO.");
- return NULL;
- }
- bool nrf_atfifo_item_free(nrf_atfifo_t * const p_fifo, nrf_atfifo_item_get_t * p_context)
- {
- if ((p_context->last_head.pos.wr) == (p_context->last_head.pos.rd))
- {
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Free (uninterrupted)");
- nrf_atfifo_rspace_close(p_fifo);
- return true;
- }
- NRF_LOG_INST_DEBUG(p_fifo->p_log, "Free (interrupted)");
- return false;
- }
|