128 lines
3.3 KiB
C
128 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
|
|
{
|
|
vTaskDelay(10/ portTICK_PERIOD_MS);
|
|
now_time = xTaskGetTickCount();
|
|
if (now_time >= end_time)
|
|
{
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
return (cnt);
|
|
}
|