123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214 |
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(APP_FIFO)
- #include "app_fifo.h"
- static __INLINE uint32_t fifo_length(app_fifo_t * p_fifo)
- {
- uint32_t tmp = p_fifo->read_pos;
- return p_fifo->write_pos - tmp;
- }
- #define FIFO_LENGTH() fifo_length(p_fifo)
- static __INLINE void fifo_put(app_fifo_t * p_fifo, uint8_t byte)
- {
- p_fifo->p_buf[p_fifo->write_pos & p_fifo->buf_size_mask] = byte;
- p_fifo->write_pos++;
- }
- static __INLINE void fifo_peek(app_fifo_t * p_fifo, uint16_t index, uint8_t * p_byte)
- {
- *p_byte = p_fifo->p_buf[(p_fifo->read_pos + index) & p_fifo->buf_size_mask];
- }
- static __INLINE void fifo_get(app_fifo_t * p_fifo, uint8_t * p_byte)
- {
- fifo_peek(p_fifo, 0, p_byte);
- p_fifo->read_pos++;
- }
- uint32_t app_fifo_init(app_fifo_t * p_fifo, uint8_t * p_buf, uint16_t buf_size)
- {
-
- if (p_buf == NULL)
- {
- return NRF_ERROR_NULL;
- }
-
- if (!IS_POWER_OF_TWO(buf_size))
- {
- return NRF_ERROR_INVALID_LENGTH;
- }
- p_fifo->p_buf = p_buf;
- p_fifo->buf_size_mask = buf_size - 1;
- p_fifo->read_pos = 0;
- p_fifo->write_pos = 0;
- return NRF_SUCCESS;
- }
- uint32_t app_fifo_put(app_fifo_t * p_fifo, uint8_t byte)
- {
- if (FIFO_LENGTH() <= p_fifo->buf_size_mask)
- {
- fifo_put(p_fifo, byte);
- return NRF_SUCCESS;
- }
- return NRF_ERROR_NO_MEM;
- }
- uint32_t app_fifo_get(app_fifo_t * p_fifo, uint8_t * p_byte)
- {
- if (FIFO_LENGTH() != 0)
- {
- fifo_get(p_fifo, p_byte);
- return NRF_SUCCESS;
- }
- return NRF_ERROR_NOT_FOUND;
- }
- uint32_t app_fifo_peek(app_fifo_t * p_fifo, uint16_t index, uint8_t * p_byte)
- {
- if (FIFO_LENGTH() > index)
- {
- fifo_peek(p_fifo, index, p_byte);
- return NRF_SUCCESS;
- }
- return NRF_ERROR_NOT_FOUND;
- }
- uint32_t app_fifo_flush(app_fifo_t * p_fifo)
- {
- p_fifo->read_pos = p_fifo->write_pos;
- return NRF_SUCCESS;
- }
- uint32_t app_fifo_read(app_fifo_t * p_fifo, uint8_t * p_byte_array, uint32_t * p_size)
- {
- VERIFY_PARAM_NOT_NULL(p_fifo);
- VERIFY_PARAM_NOT_NULL(p_size);
- const uint32_t byte_count = fifo_length(p_fifo);
- const uint32_t requested_len = (*p_size);
- uint32_t index = 0;
- uint32_t read_size = MIN(requested_len, byte_count);
- (*p_size) = byte_count;
-
- if (byte_count == 0)
- {
- return NRF_ERROR_NOT_FOUND;
- }
-
- if (p_byte_array == NULL)
- {
- return NRF_SUCCESS;
- }
-
- while (index < read_size)
- {
- fifo_get(p_fifo, &p_byte_array[index++]);
- }
- (*p_size) = read_size;
- return NRF_SUCCESS;
- }
- uint32_t app_fifo_write(app_fifo_t * p_fifo, uint8_t const * p_byte_array, uint32_t * p_size)
- {
- VERIFY_PARAM_NOT_NULL(p_fifo);
- VERIFY_PARAM_NOT_NULL(p_size);
- const uint32_t available_count = p_fifo->buf_size_mask - fifo_length(p_fifo) + 1;
- const uint32_t requested_len = (*p_size);
- uint32_t index = 0;
- uint32_t write_size = MIN(requested_len, available_count);
- (*p_size) = available_count;
-
- if (available_count == 0)
- {
- return NRF_ERROR_NO_MEM;
- }
-
- if (p_byte_array == NULL)
- {
- return NRF_SUCCESS;
- }
-
- while (index < write_size)
- {
- fifo_put(p_fifo, p_byte_array[index++]);
- }
- (*p_size) = write_size;
- return NRF_SUCCESS;
- }
- #endif
|