92 lines
2.3 KiB
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;
|
|
}
|
|
} |