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