#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; } }