147 lines
3.9 KiB
C
147 lines
3.9 KiB
C
/***************************************************************************
|
|
*
|
|
* Copyright 2015-2019 BES.
|
|
* All rights reserved. All unpublished rights reserved.
|
|
*
|
|
* No part of this work may be used or reproduced in any form or by any
|
|
* means, or stored in a database or retrieval system, without prior written
|
|
* permission of BES.
|
|
*
|
|
* Use of this work is governed by a license granted by BES.
|
|
* This work contains confidential and proprietary information of
|
|
* BES. which is protected by copyright, trade secret,
|
|
* trademark and other intellectual property rights.
|
|
*
|
|
****************************************************************************/
|
|
#include "cmsis_os.h"
|
|
#include "cqueue.h"
|
|
#include "string.h"
|
|
#include "audiobuffer.h"
|
|
|
|
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
static osMutexId g_audio_queue_mutex_id = NULL;
|
|
osMutexDef(g_audio_queue_mutex);
|
|
#endif
|
|
|
|
static CQueue audio_queue;
|
|
static unsigned char audio_queue_buf[AUDIO_BUFFER_FRAME_SIZE*AUDIO_BUFFER_FRAME_NUM];
|
|
|
|
void audio_mono2stereo_16bits(uint16_t *dst_buf, uint16_t *src_buf, uint32_t src_len)
|
|
{
|
|
uint32_t i = 0;
|
|
for (i = 0; i < src_len; ++i) {
|
|
dst_buf[i*2 + 0] = dst_buf[i*2 + 1] = src_buf[i];
|
|
}
|
|
}
|
|
|
|
void audio_stereo2mono_16bits(uint8_t chnlsel, uint16_t *dst_buf, uint16_t *src_buf, uint32_t src_len)
|
|
{
|
|
uint32_t i = 0;
|
|
for (i = 0; i < src_len; i+=2) {
|
|
dst_buf[i/2] = src_buf[i + chnlsel];
|
|
}
|
|
}
|
|
|
|
void audio_buffer_init(void)
|
|
{
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
if (g_audio_queue_mutex_id == NULL)
|
|
g_audio_queue_mutex_id = osMutexCreate((osMutex(g_audio_queue_mutex)));
|
|
#endif
|
|
InitCQueue(&audio_queue, sizeof(audio_queue_buf), (unsigned char *)&audio_queue_buf);
|
|
memset(&audio_queue_buf, 0x00, sizeof(audio_queue_buf));
|
|
}
|
|
|
|
int audio_buffer_length(void)
|
|
{
|
|
int len;
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexWait(g_audio_queue_mutex_id, osWaitForever);
|
|
#endif
|
|
len = LengthOfCQueue(&audio_queue);
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexRelease(g_audio_queue_mutex_id);
|
|
#endif
|
|
return len;
|
|
}
|
|
|
|
int audio_buffer_set(uint8_t *buff, uint16_t len)
|
|
{
|
|
int status;
|
|
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexWait(g_audio_queue_mutex_id, osWaitForever);
|
|
#endif
|
|
status = EnCQueue(&audio_queue, buff, len);
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexRelease(g_audio_queue_mutex_id);
|
|
#endif
|
|
return status;
|
|
}
|
|
|
|
int audio_buffer_get(uint8_t *buff, uint16_t len)
|
|
{
|
|
uint8_t *e1 = NULL, *e2 = NULL;
|
|
unsigned int len1 = 0, len2 = 0;
|
|
int status;
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexWait(g_audio_queue_mutex_id, osWaitForever);
|
|
#endif
|
|
status = PeekCQueue(&audio_queue, len, &e1, &len1, &e2, &len2);
|
|
if (len==(len1+len2)){
|
|
memcpy(buff,e1,len1);
|
|
memcpy(buff+len1,e2,len2);
|
|
DeCQueue(&audio_queue, 0, len);
|
|
DeCQueue(&audio_queue, 0, len2);
|
|
}else{
|
|
memset(buff, 0x00, len);
|
|
status = -1;
|
|
}
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexRelease(g_audio_queue_mutex_id);
|
|
#endif
|
|
return status;
|
|
}
|
|
|
|
int audio_buffer_set_stereo2mono_16bits(uint8_t *buff, uint16_t len, uint8_t chnlsel)
|
|
{
|
|
int status;
|
|
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexWait(g_audio_queue_mutex_id, osWaitForever);
|
|
#endif
|
|
audio_stereo2mono_16bits(chnlsel, (uint16_t *)buff, (uint16_t *)buff, len>>1);
|
|
status = EnCQueue(&audio_queue, buff, len>>1);
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexRelease(g_audio_queue_mutex_id);
|
|
#endif
|
|
return status;
|
|
}
|
|
|
|
int audio_buffer_get_mono2stereo_16bits(uint8_t *buff, uint16_t len)
|
|
{
|
|
uint8_t *e1 = NULL, *e2 = NULL;
|
|
unsigned int len1 = 0, len2 = 0;
|
|
int status;
|
|
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexWait(g_audio_queue_mutex_id, osWaitForever);
|
|
#endif
|
|
status = PeekCQueue(&audio_queue, len>>1, &e1, &len1, &e2, &len2);
|
|
if (len>>1== len1+len2){
|
|
audio_mono2stereo_16bits((uint16_t *)buff, (uint16_t *)e1, len1>>1);
|
|
audio_mono2stereo_16bits((uint16_t *)(buff+(len1<<1)), (uint16_t *)e2, len2>>1);
|
|
DeCQueue(&audio_queue, 0, len1);
|
|
DeCQueue(&audio_queue, 0, len2);
|
|
status = len;
|
|
}else{
|
|
memset(buff, 0x00, len);
|
|
status = -1;
|
|
}
|
|
#ifndef _AUDIO_NO_THREAD_
|
|
osMutexRelease(g_audio_queue_mutex_id);
|
|
#endif
|
|
return status;
|
|
}
|