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