esp32c3-usb_serial/components/stream_processor/stream.c

129 lines
3.3 KiB
C

#include "stream.h"
static SemaphoreHandle_t xSemaphore_frameStream_W;
static SemaphoreHandle_t xSemaphore_frameStream_R;
uint32_t stream_init(stream_data_t* esp_data_interface,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(stream_data_t* esp_data_interface,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(stream_data_t* esp_data_interface,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(stream_data_t* esp_data_interface)
{
return esp_data_interface->read;
}
uint32_t frameStreamRecLen(stream_data_t* esp_data_interface)//已使用缓存字节数
{
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(stream_data_t* esp_data_interface)//剩余空间
{
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(stream_data_t* esp_data_interface)
{
if(esp_data_interface->read == esp_data_interface->write)
{
return ESP_OK;
}else{
return ESP_FAIL;
}
}
uint32_t WaitPrnBufBytes(stream_data_t* esp_data_interface,uint32_t len, uint32_t timeout, uint8_t *buffer)
{
TickType_t now_time;
TickType_t end_time;
uint32_t cnt;
uint8_t ch;
cnt = 0;
end_time = xTaskGetTickCount() + timeout;
while(cnt < len)
{
if (ISframeStreamEmpty(esp_data_interface) != ESP_OK)
{
end_time = xTaskGetTickCount() + timeout;
frameStreamRead(esp_data_interface,&ch,1);
*buffer++ = ch;
*buffer = 0;
++cnt;
if (cnt == len)
{
break;
}
}
else
{
now_time = xTaskGetTickCount();
if (now_time >= end_time)
{
break;
}
vTaskDelay(1000/ portTICK_PERIOD_MS);
}
}
return (cnt);
}