|
|
@@ -226,7 +226,7 @@ static float i2s_apll_get_fi2s(int bits_per_sample, int sdm0, int sdm1, int sdm2
|
|
|
* @param[out] sdm2 The sdm 2
|
|
|
* @param[out] odir The odir
|
|
|
*
|
|
|
- * @return ESP_FAIL or ESP_OK
|
|
|
+ * @return ESP_ERR_INVALID_ARG or ESP_OK
|
|
|
*/
|
|
|
|
|
|
static esp_err_t i2s_apll_calculate_fi2s(int rate, int bits_per_sample, int *sdm0, int *sdm1, int *sdm2, int *odir)
|
|
|
@@ -303,7 +303,7 @@ esp_err_t i2s_set_clk(i2s_port_t i2s_num, uint32_t rate, i2s_bits_per_sample_t b
|
|
|
|
|
|
if (p_i2s_obj[i2s_num] == NULL) {
|
|
|
ESP_LOGE(I2S_TAG, "Not initialized yet");
|
|
|
- return ESP_FAIL;
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
p_i2s_obj[i2s_num]->sample_rate = rate;
|
|
|
double clkmdiv = (double)I2S_BASE_CLK / (rate * factor);
|
|
|
@@ -541,21 +541,26 @@ static esp_err_t i2s_destroy_dma_queue(i2s_port_t i2s_num, i2s_dma_t *dma)
|
|
|
int bux_idx;
|
|
|
if (p_i2s_obj[i2s_num] == NULL) {
|
|
|
ESP_LOGE(I2S_TAG, "Not initialized yet");
|
|
|
- return ESP_FAIL;
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
if (dma == NULL) {
|
|
|
- return ESP_FAIL;
|
|
|
+ ESP_LOGE(I2S_TAG, "dma is NULL");
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
for (bux_idx = 0; bux_idx < p_i2s_obj[i2s_num]->dma_buf_count; bux_idx++) {
|
|
|
- if (dma->desc && dma->desc[bux_idx])
|
|
|
+ if (dma->desc && dma->desc[bux_idx]) {
|
|
|
free(dma->desc[bux_idx]);
|
|
|
- if (dma->buf && dma->buf[bux_idx])
|
|
|
+ }
|
|
|
+ if (dma->buf && dma->buf[bux_idx]) {
|
|
|
free(dma->buf[bux_idx]);
|
|
|
+ }
|
|
|
}
|
|
|
- if (dma->buf)
|
|
|
+ if (dma->buf) {
|
|
|
free(dma->buf);
|
|
|
- if (dma->desc)
|
|
|
+ }
|
|
|
+ if (dma->desc) {
|
|
|
free(dma->desc);
|
|
|
+ }
|
|
|
vQueueDelete(dma->queue);
|
|
|
vSemaphoreDelete(dma->mux);
|
|
|
free(dma);
|
|
|
@@ -999,10 +1004,11 @@ esp_err_t i2s_zero_dma_buffer(i2s_port_t i2s_num)
|
|
|
}
|
|
|
}
|
|
|
if (p_i2s_obj[i2s_num]->tx && p_i2s_obj[i2s_num]->tx->buf != NULL && p_i2s_obj[i2s_num]->tx->buf_size != 0) {
|
|
|
- int bytes_left = (p_i2s_obj[i2s_num]->tx->buf_size - p_i2s_obj[i2s_num]->tx->rw_pos) % 4;
|
|
|
+ int bytes_left = 0;
|
|
|
+ bytes_left = (p_i2s_obj[i2s_num]->tx->buf_size - p_i2s_obj[i2s_num]->tx->rw_pos) % 4;
|
|
|
if (bytes_left) {
|
|
|
- int zero_bytes = 0;
|
|
|
- i2s_write_bytes(i2s_num, (const char *)&zero_bytes, bytes_left, portMAX_DELAY);
|
|
|
+ size_t zero_bytes = 0, bytes_written;
|
|
|
+ i2s_write(i2s_num, (void *)&zero_bytes, bytes_left, &bytes_written, portMAX_DELAY);
|
|
|
}
|
|
|
for (int i = 0; i < p_i2s_obj[i2s_num]->dma_buf_count; i++) {
|
|
|
memset(p_i2s_obj[i2s_num]->tx->buf[i], 0, p_i2s_obj[i2s_num]->tx->buf_size);
|
|
|
@@ -1113,14 +1119,28 @@ esp_err_t i2s_driver_uninstall(i2s_port_t i2s_num)
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-int i2s_write_bytes(i2s_port_t i2s_num, const char *src, size_t size, TickType_t ticks_to_wait)
|
|
|
+int i2s_write_bytes(i2s_port_t i2s_num, const void *src, size_t size, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
- char *data_ptr;
|
|
|
- int bytes_can_write, bytes_writen = 0;
|
|
|
- I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_FAIL);
|
|
|
- I2S_CHECK((size < I2S_MAX_BUFFER_SIZE), "size is too large", ESP_FAIL);
|
|
|
- I2S_CHECK((p_i2s_obj[i2s_num]->tx), "tx NULL", ESP_FAIL);
|
|
|
+ size_t bytes_written = 0;
|
|
|
+ int res = 0;
|
|
|
+ res = i2s_write(i2s_num, src, size, &bytes_written, ticks_to_wait);
|
|
|
+ if (res != ESP_OK) {
|
|
|
+ return ESP_FAIL;
|
|
|
+ } else {
|
|
|
+ return bytes_written;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t i2s_write(i2s_port_t i2s_num, const void *src, size_t size, size_t *bytes_written, TickType_t ticks_to_wait)
|
|
|
+{
|
|
|
+ char *data_ptr, *src_byte;
|
|
|
+ int bytes_can_write;
|
|
|
+ *bytes_written = 0;
|
|
|
+ I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((size < I2S_MAX_BUFFER_SIZE), "size is too large", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((p_i2s_obj[i2s_num]->tx), "tx NULL", ESP_ERR_INVALID_ARG);
|
|
|
xSemaphoreTake(p_i2s_obj[i2s_num]->tx->mux, (portTickType)portMAX_DELAY);
|
|
|
+ src_byte = (char *)src;
|
|
|
while (size > 0) {
|
|
|
if (p_i2s_obj[i2s_num]->tx->rw_pos == p_i2s_obj[i2s_num]->tx->buf_size || p_i2s_obj[i2s_num]->tx->curr_ptr == NULL) {
|
|
|
if (xQueueReceive(p_i2s_obj[i2s_num]->tx->queue, &p_i2s_obj[i2s_num]->tx->curr_ptr, ticks_to_wait) == pdFALSE) {
|
|
|
@@ -1135,14 +1155,14 @@ int i2s_write_bytes(i2s_port_t i2s_num, const char *src, size_t size, TickType_t
|
|
|
if (bytes_can_write > size) {
|
|
|
bytes_can_write = size;
|
|
|
}
|
|
|
- memcpy(data_ptr, src, bytes_can_write);
|
|
|
+ memcpy(data_ptr, src_byte, bytes_can_write);
|
|
|
size -= bytes_can_write;
|
|
|
- src += bytes_can_write;
|
|
|
+ src_byte += bytes_can_write;
|
|
|
p_i2s_obj[i2s_num]->tx->rw_pos += bytes_can_write;
|
|
|
- bytes_writen += bytes_can_write;
|
|
|
+ (*bytes_written) += bytes_can_write;
|
|
|
}
|
|
|
xSemaphoreGive(p_i2s_obj[i2s_num]->tx->mux);
|
|
|
- return bytes_writen;
|
|
|
+ return ESP_OK;
|
|
|
}
|
|
|
|
|
|
esp_err_t i2s_adc_enable(i2s_port_t i2s_num)
|
|
|
@@ -1166,33 +1186,37 @@ esp_err_t i2s_adc_disable(i2s_port_t i2s_num)
|
|
|
return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-int i2s_write_expand(i2s_port_t i2s_num, const char *src, int size, int src_bits, int aim_bits, TickType_t ticks_to_wait)
|
|
|
+esp_err_t i2s_write_expand(i2s_port_t i2s_num, const void *src, size_t size, size_t src_bits, size_t aim_bits, size_t *bytes_written, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
char *data_ptr;
|
|
|
- int bytes_can_write, bytes_writen = 0, tail;
|
|
|
- I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_FAIL);
|
|
|
- I2S_CHECK((size > 0), "size must greater than zero", ESP_FAIL);
|
|
|
- I2S_CHECK((aim_bits * size < I2S_MAX_BUFFER_SIZE), "size is too large", ESP_FAIL);
|
|
|
- I2S_CHECK((aim_bits >= src_bits), "aim_bits musn't less than src_bits", ESP_FAIL);
|
|
|
- I2S_CHECK((p_i2s_obj[i2s_num]->tx), "tx NULL", ESP_FAIL);
|
|
|
+ int bytes_can_write, tail;
|
|
|
+ int src_bytes, aim_bytes, zero_bytes;
|
|
|
+ *bytes_written = 0;
|
|
|
+ I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((size > 0), "size must greater than zero", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((aim_bits * size < I2S_MAX_BUFFER_SIZE), "size is too large", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((aim_bits >= src_bits), "aim_bits musn't less than src_bits", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((p_i2s_obj[i2s_num]->tx), "tx NULL", ESP_ERR_INVALID_ARG);
|
|
|
if (src_bits < I2S_BITS_PER_SAMPLE_8BIT || aim_bits < I2S_BITS_PER_SAMPLE_8BIT) {
|
|
|
ESP_LOGE(I2S_TAG,"bits musn't be less than 8, src_bits %d aim_bits %d", src_bits, aim_bits);
|
|
|
- return ESP_FAIL;
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
if (src_bits > I2S_BITS_PER_SAMPLE_32BIT || aim_bits > I2S_BITS_PER_SAMPLE_32BIT) {
|
|
|
ESP_LOGE(I2S_TAG,"bits musn't be greater than 32, src_bits %d aim_bits %d", src_bits, aim_bits);
|
|
|
- return ESP_FAIL;
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
if ((src_bits == I2S_BITS_PER_SAMPLE_16BIT || src_bits == I2S_BITS_PER_SAMPLE_32BIT) && (size % 2 != 0)) {
|
|
|
ESP_LOGE(I2S_TAG,"size must be a even number while src_bits is even, src_bits %d size %d", src_bits, size);
|
|
|
- return ESP_FAIL;
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
if (src_bits == I2S_BITS_PER_SAMPLE_24BIT && (size % 3 != 0)) {
|
|
|
ESP_LOGE(I2S_TAG,"size must be a multiple of 3 while src_bits is 24, size %d", size);
|
|
|
- return ESP_FAIL;
|
|
|
+ return ESP_ERR_INVALID_ARG;
|
|
|
}
|
|
|
- int src_bytes = src_bits / 8, aim_bytes = aim_bits / 8;
|
|
|
- int zero_bytes = aim_bytes - src_bytes;
|
|
|
+
|
|
|
+ src_bytes = src_bits / 8;
|
|
|
+ aim_bytes = aim_bits / 8;
|
|
|
+ zero_bytes = aim_bytes - src_bytes;
|
|
|
xSemaphoreTake(p_i2s_obj[i2s_num]->tx->mux, (portTickType)portMAX_DELAY);
|
|
|
size = size * aim_bytes / src_bytes;
|
|
|
ESP_LOGD(I2S_TAG,"aim_bytes %d src_bytes %d size %d", aim_bytes, src_bytes, size);
|
|
|
@@ -1215,23 +1239,37 @@ int i2s_write_expand(i2s_port_t i2s_num, const char *src, int size, int src_bits
|
|
|
memset(data_ptr, 0, bytes_can_write);
|
|
|
for (int j = 0; j < bytes_can_write; j += (aim_bytes - zero_bytes)) {
|
|
|
j += zero_bytes;
|
|
|
- memcpy(&data_ptr[j], &src[bytes_writen], aim_bytes - zero_bytes);
|
|
|
- bytes_writen += (aim_bytes - zero_bytes);
|
|
|
+ memcpy(&data_ptr[j], (const char *)(src + *bytes_written), aim_bytes - zero_bytes);
|
|
|
+ (*bytes_written) += (aim_bytes - zero_bytes);
|
|
|
}
|
|
|
size -= bytes_can_write;
|
|
|
p_i2s_obj[i2s_num]->tx->rw_pos += bytes_can_write;
|
|
|
}
|
|
|
xSemaphoreGive(p_i2s_obj[i2s_num]->tx->mux);
|
|
|
- return bytes_writen;
|
|
|
+ return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-int i2s_read_bytes(i2s_port_t i2s_num, char* dest, size_t size, TickType_t ticks_to_wait)
|
|
|
+int i2s_read_bytes(i2s_port_t i2s_num, void *dest, size_t size, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
- char *data_ptr;
|
|
|
- int bytes_can_read, byte_read = 0;
|
|
|
- I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_FAIL);
|
|
|
- I2S_CHECK((size < I2S_MAX_BUFFER_SIZE), "size is too large", ESP_FAIL);
|
|
|
- I2S_CHECK((p_i2s_obj[i2s_num]->rx), "rx NULL", ESP_FAIL);
|
|
|
+ size_t bytes_read = 0;
|
|
|
+ int res = 0;
|
|
|
+ res = i2s_read(i2s_num, dest, size, &bytes_read, ticks_to_wait);
|
|
|
+ if (res != ESP_OK) {
|
|
|
+ return ESP_FAIL;
|
|
|
+ } else {
|
|
|
+ return bytes_read;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+esp_err_t i2s_read(i2s_port_t i2s_num, void *dest, size_t size, size_t *bytes_read, TickType_t ticks_to_wait)
|
|
|
+{
|
|
|
+ char *data_ptr, *dest_byte;
|
|
|
+ int bytes_can_read;
|
|
|
+ *bytes_read = 0;
|
|
|
+ dest_byte = (char *)dest;
|
|
|
+ I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((size < I2S_MAX_BUFFER_SIZE), "size is too large", ESP_ERR_INVALID_ARG);
|
|
|
+ I2S_CHECK((p_i2s_obj[i2s_num]->rx), "rx NULL", ESP_ERR_INVALID_ARG);
|
|
|
xSemaphoreTake(p_i2s_obj[i2s_num]->rx->mux, (portTickType)portMAX_DELAY);
|
|
|
while (size > 0) {
|
|
|
if (p_i2s_obj[i2s_num]->rx->rw_pos == p_i2s_obj[i2s_num]->rx->buf_size || p_i2s_obj[i2s_num]->rx->curr_ptr == NULL) {
|
|
|
@@ -1246,62 +1284,40 @@ int i2s_read_bytes(i2s_port_t i2s_num, char* dest, size_t size, TickType_t ticks
|
|
|
if (bytes_can_read > size) {
|
|
|
bytes_can_read = size;
|
|
|
}
|
|
|
- memcpy(dest, data_ptr, bytes_can_read);
|
|
|
+ memcpy(dest_byte, data_ptr, bytes_can_read);
|
|
|
size -= bytes_can_read;
|
|
|
- dest += bytes_can_read;
|
|
|
+ dest_byte += bytes_can_read;
|
|
|
p_i2s_obj[i2s_num]->rx->rw_pos += bytes_can_read;
|
|
|
- byte_read += bytes_can_read;
|
|
|
+ (*bytes_read) += bytes_can_read;
|
|
|
}
|
|
|
xSemaphoreGive(p_i2s_obj[i2s_num]->rx->mux);
|
|
|
- return byte_read;
|
|
|
+ return ESP_OK;
|
|
|
}
|
|
|
|
|
|
-int i2s_push_sample(i2s_port_t i2s_num, const char *sample, TickType_t ticks_to_wait)
|
|
|
+int i2s_push_sample(i2s_port_t i2s_num, const void *sample, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
- int i, bytes_to_push = 0;
|
|
|
- char *data_ptr;
|
|
|
+ size_t bytes_push = 0;
|
|
|
+ int res = 0;
|
|
|
I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_FAIL);
|
|
|
- if (p_i2s_obj[i2s_num]->tx->rw_pos == p_i2s_obj[i2s_num]->tx->buf_size || p_i2s_obj[i2s_num]->tx->curr_ptr == NULL) {
|
|
|
- if (xQueueReceive(p_i2s_obj[i2s_num]->tx->queue, &p_i2s_obj[i2s_num]->tx->curr_ptr, ticks_to_wait) == pdFALSE) {
|
|
|
- return bytes_to_push;
|
|
|
- }
|
|
|
- ESP_LOGD(I2S_TAG, "rw_pos: %d, buf_size: %d, curr_ptr: %d", p_i2s_obj[i2s_num]->tx->rw_pos, p_i2s_obj[i2s_num]->tx->buf_size, (int)p_i2s_obj[i2s_num]->tx->curr_ptr);
|
|
|
- p_i2s_obj[i2s_num]->tx->rw_pos = 0;
|
|
|
- }
|
|
|
- data_ptr = (char*)p_i2s_obj[i2s_num]->tx->curr_ptr;
|
|
|
- data_ptr += p_i2s_obj[i2s_num]->tx->rw_pos;
|
|
|
- for (i = 0; i < p_i2s_obj[i2s_num]->bytes_per_sample * p_i2s_obj[i2s_num]->channel_num; i++) {
|
|
|
- *data_ptr++ = *sample++;
|
|
|
- bytes_to_push ++;
|
|
|
+ res = i2s_write(i2s_num, sample, p_i2s_obj[i2s_num]->bytes_per_sample, &bytes_push, ticks_to_wait);
|
|
|
+ if (res != ESP_OK) {
|
|
|
+ return ESP_FAIL;
|
|
|
+ } else {
|
|
|
+ return bytes_push;
|
|
|
}
|
|
|
- p_i2s_obj[i2s_num]->tx->rw_pos += bytes_to_push;
|
|
|
- return bytes_to_push;
|
|
|
}
|
|
|
|
|
|
-int i2s_pop_sample(i2s_port_t i2s_num, char *sample, TickType_t ticks_to_wait)
|
|
|
+int i2s_pop_sample(i2s_port_t i2s_num, void *sample, TickType_t ticks_to_wait)
|
|
|
{
|
|
|
- int i, bytes_to_pop = 0;
|
|
|
- char *data_ptr;
|
|
|
+ size_t bytes_pop = 0;
|
|
|
+ int res = 0;
|
|
|
I2S_CHECK((i2s_num < I2S_NUM_MAX), "i2s_num error", ESP_FAIL);
|
|
|
- if (p_i2s_obj[i2s_num]->rx->rw_pos == p_i2s_obj[i2s_num]->rx->buf_size || p_i2s_obj[i2s_num]->rx->curr_ptr == NULL) {
|
|
|
- if (xQueueReceive(p_i2s_obj[i2s_num]->rx->queue, &p_i2s_obj[i2s_num]->rx->curr_ptr, ticks_to_wait) == pdFALSE) {
|
|
|
- return bytes_to_pop;
|
|
|
- }
|
|
|
- p_i2s_obj[i2s_num]->rx->rw_pos = 0;
|
|
|
- }
|
|
|
- data_ptr = (char*)p_i2s_obj[i2s_num]->rx->curr_ptr;
|
|
|
- data_ptr += p_i2s_obj[i2s_num]->rx->rw_pos;
|
|
|
- for (i = 0; i < p_i2s_obj[i2s_num]->bytes_per_sample; i++) {
|
|
|
- *sample++ = *data_ptr++;
|
|
|
- bytes_to_pop++;
|
|
|
- }
|
|
|
- if (p_i2s_obj[i2s_num]->channel_num == 2) {
|
|
|
- for (i = 0; i < p_i2s_obj[i2s_num]->bytes_per_sample; i++) {
|
|
|
- *sample++ = *data_ptr++;
|
|
|
- bytes_to_pop++;
|
|
|
- }
|
|
|
+ res = i2s_read(i2s_num, sample, p_i2s_obj[i2s_num]->bytes_per_sample, &bytes_pop, ticks_to_wait);
|
|
|
+ if (res != ESP_OK) {
|
|
|
+ return ESP_FAIL;
|
|
|
+ } else {
|
|
|
+ return bytes_pop;
|
|
|
}
|
|
|
-
|
|
|
- p_i2s_obj[i2s_num]->rx->rw_pos += p_i2s_obj[i2s_num]->bytes_per_sample * p_i2s_obj[i2s_num]->channel_num;
|
|
|
- return bytes_to_pop;
|
|
|
}
|
|
|
+
|
|
|
+
|