#include "sensor_fifo.h"static __INLINE uint32_t fifo_length(sensor_t * p_fifo){  uint32_t tmp = p_fifo->read_pos;  return p_fifo->write_pos - tmp;}#define FIFO_LENGTH fifo_length(p_fifo)  uint32_t sensor_init(sensor_t * p_fifo, int16_t * p_buf, uint16_t buf_size){        if (p_buf == NULL)    {        return 0;    }    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 1;}uint32_t sensor_put(sensor_t * p_fifo, int16_t byte){    if (FIFO_LENGTH <= p_fifo->buf_size_mask)    {        p_fifo->p_buf[p_fifo->write_pos & p_fifo->buf_size_mask] = byte;        p_fifo->write_pos++;        return 1;    }    return 0;}uint32_t sensor_get(sensor_t * p_fifo, int16_t * p_byte){    if (FIFO_LENGTH != 0)    {        *p_byte = p_fifo->p_buf[p_fifo->read_pos & p_fifo->buf_size_mask];        p_fifo->read_pos++;        return 1;    }    return 0;}uint32_t sensor_flush(sensor_t * p_fifo){    p_fifo->read_pos = p_fifo->write_pos;    return 1;}

#ifndef SENSOR_FIFO_H__#define SENSOR_FIFO_H__#include <stdint.h>#include <stdlib.h>typedef struct{    int16_t *          p_buf;               uint16_t           buf_size_mask;       volatile uint32_t  read_pos;            volatile uint32_t  write_pos;       } sensor_fifo_t;uint32_t sensor_fifo_init(sensor_fifo_t * p_fifo, uint8_t * p_buf, uint16_t buf_size);uint32_t sensor_fifo_get(sensor_fifo_t * p_fifo, uint8_t * p_byte);uint32_t sensor_fifo_flush(sensor_fifo_t * p_fifo);#endif