esp32c3-usb_serial/components/stream_processor/stream.c

92 lines
2.3 KiB
C

#include "stream.h"
stream_data_t esp_data_interface;
SemaphoreHandle_t xSemaphore_frameStream_W;
SemaphoreHandle_t xSemaphore_frameStream_R;
uint32_t stream_init(uint32_t max_size)
{
xSemaphore_frameStream_W = xSemaphoreCreateMutex();// 创建互斥型信号量。
xSemaphore_frameStream_R = xSemaphoreCreateMutex();// 创建互斥型信号量。
esp_data_interface.max_size = max_size;
esp_data_interface.buffer = malloc(max_size);
if(esp_data_interface.buffer == NULL)
{
return 0;
}
esp_data_interface.write = esp_data_interface.read = 0;
return max_size;
}
void frameStreamWrite(uint8_t *buf, uint32_t length)
{
uint32_t i;
uint8_t *p;
xSemaphoreTake( xSemaphore_frameStream_W, portMAX_DELAY );//获得资源的使用权
p = &esp_data_interface.buffer[0];
for (i = 0; i < length; i++)
{
*(p + (esp_data_interface.write)) = buf[i];
esp_data_interface.write = (esp_data_interface.write + 1) % ((esp_data_interface.max_size));
}
xSemaphoreGive( xSemaphore_frameStream_W );//释放
}
void frameStreamRead(uint8_t *buf, uint32_t length)
{
uint32_t i;
uint8_t *p;
xSemaphoreTake( xSemaphore_frameStream_R, portMAX_DELAY );//获得资源的使用权
p = &esp_data_interface.buffer[0];
for (i = 0; i < length; i++)
{
buf[i] = *(p + (esp_data_interface.read));
esp_data_interface.read = (esp_data_interface.read + 1) % ((esp_data_interface.max_size));
}
xSemaphoreGive( xSemaphore_frameStream_R );//释放
}
uint32_t frameStreamRead_Get_index()
{
return esp_data_interface.read;
}
uint32_t frameStreamRecLen()//已使用缓存字节数
{
uint32_t v;
v = esp_data_interface.write + (esp_data_interface.max_size) - esp_data_interface.read;
while (v >= (esp_data_interface.max_size))
{
v -= (esp_data_interface.max_size);
}
return (v);
}
uint32_t frameStreamRecEmptyLen()//剩余空间
{
uint32_t v;
v = esp_data_interface.read + (esp_data_interface.max_size) - esp_data_interface.write;
while (v > (esp_data_interface.max_size))
{
v -= (esp_data_interface.max_size);
}
return (v);
}
uint8_t ISframeStreamEmpty()
{
if(esp_data_interface.read == esp_data_interface.write)
{
return ESP_OK;
}else{
return ESP_FAIL;
}
}