348 lines
10 KiB
C
348 lines
10 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 "plat_addr_map.h"
|
||
|
|
#include "hal_cmu.h"
|
||
|
|
#include "hal_timer.h"
|
||
|
|
#include "hal_trace.h"
|
||
|
|
#include "hal_iomux.h"
|
||
|
|
#include "hal_dma.h"
|
||
|
|
#include "hal_key.h"
|
||
|
|
#include "hal_gpadc.h"
|
||
|
|
#include "hal_sleep.h"
|
||
|
|
#include "hal_sysfreq.h"
|
||
|
|
#include "cmsis.h"
|
||
|
|
#include "pmu.h"
|
||
|
|
#include "analog.h"
|
||
|
|
#include "string.h"
|
||
|
|
#include "hwtimer_list.h"
|
||
|
|
#include "audioflinger.h"
|
||
|
|
#if defined(ANC_APP)
|
||
|
|
#include "anc_usb_app.h"
|
||
|
|
#endif
|
||
|
|
#include "usb_audio_app.h"
|
||
|
|
#include "dualadc_audio_app.h"
|
||
|
|
#include "usb_audio_frm_defs.h"
|
||
|
|
#include "tgt_hardware.h"
|
||
|
|
#include "audio_process.h"
|
||
|
|
|
||
|
|
#ifdef RTOS
|
||
|
|
#include "cmsis_os.h"
|
||
|
|
#endif
|
||
|
|
#ifdef __PC_CMD_UART__
|
||
|
|
#include "hal_cmd.h"
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef USB_AUDIO_SPEECH
|
||
|
|
#define CODEC_BUFF_FRAME_NUM (2 * 16)
|
||
|
|
#define USB_BUFF_FRAME_NUM (CODEC_BUFF_FRAME_NUM * 2)
|
||
|
|
#else
|
||
|
|
#define CODEC_BUFF_FRAME_NUM 4
|
||
|
|
#define USB_BUFF_FRAME_NUM 8
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if (CODEC_BUFF_FRAME_NUM >= USB_BUFF_FRAME_NUM)
|
||
|
|
#error "Codec buffer frame num should be less than usb buffer frame num (on the requirement of conflict ctrl)"
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef USB_AUDIO_DYN_CFG
|
||
|
|
#define USB_AUDIO_PLAYBACK_BUFF_SIZE NON_EXP_ALIGN(MAX_FRAME_SIZE_PLAYBACK * CODEC_BUFF_FRAME_NUM, DAC_BUFF_ALIGN)
|
||
|
|
#define USB_AUDIO_CAPTURE_BUFF_SIZE NON_EXP_ALIGN(MAX_FRAME_SIZE_CAPTURE * CODEC_BUFF_FRAME_NUM, ADC_BUFF_ALIGN)
|
||
|
|
|
||
|
|
#define USB_AUDIO_RECV_BUFF_SIZE NON_EXP_ALIGN(MAX_FRAME_SIZE_RECV * USB_BUFF_FRAME_NUM, RECV_BUFF_ALIGN)
|
||
|
|
#define USB_AUDIO_SEND_BUFF_SIZE NON_EXP_ALIGN(MAX_FRAME_SIZE_SEND * USB_BUFF_FRAME_NUM, SEND_BUFF_ALIGN)
|
||
|
|
|
||
|
|
#if defined(CHIP_BEST1000)
|
||
|
|
// FIR EQ is working on 16-bit
|
||
|
|
// FIR_EQ_buffer_size = max_playback_symbol_number_in_buffer * sizeof(int16_t)
|
||
|
|
#define USB_AUDIO_FIR_EQ_BUFF_SIZE USB_AUDIO_PLAYBACK_BUFF_SIZE
|
||
|
|
#elif defined(CHIP_BEST2000)
|
||
|
|
// FIR EQ is working on 32-bit
|
||
|
|
// FIR_EQ_buffer_size = max_playback_symbol_number_in_buffer * sizeof(int32_t)
|
||
|
|
#define USB_AUDIO_FIR_EQ_BUFF_SIZE (USB_AUDIO_PLAYBACK_BUFF_SIZE*2)
|
||
|
|
#elif defined(CHIP_BEST2300) || defined(CHIP_BEST2300P)
|
||
|
|
// FIR EQ is working on 32-bit
|
||
|
|
// FIR_EQ_buffer_size = max_playback_symbol_number_in_buffer * sizeof(int32_t)
|
||
|
|
#define USB_AUDIO_FIR_EQ_BUFF_SIZE (USB_AUDIO_PLAYBACK_BUFF_SIZE*2)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#else
|
||
|
|
#define USB_AUDIO_PLAYBACK_BUFF_SIZE NON_EXP_ALIGN(FRAME_SIZE_PLAYBACK * CODEC_BUFF_FRAME_NUM, DAC_BUFF_ALIGN)
|
||
|
|
#define USB_AUDIO_CAPTURE_BUFF_SIZE NON_EXP_ALIGN(FRAME_SIZE_CAPTURE * CODEC_BUFF_FRAME_NUM, ADC_BUFF_ALIGN)
|
||
|
|
|
||
|
|
#define USB_AUDIO_RECV_BUFF_SIZE NON_EXP_ALIGN(FRAME_SIZE_RECV * USB_BUFF_FRAME_NUM, RECV_BUFF_ALIGN)
|
||
|
|
#define USB_AUDIO_SEND_BUFF_SIZE NON_EXP_ALIGN(FRAME_SIZE_SEND * USB_BUFF_FRAME_NUM, SEND_BUFF_ALIGN)
|
||
|
|
|
||
|
|
#if defined(CHIP_BEST1000)
|
||
|
|
// FIR EQ is working on 16-bit
|
||
|
|
#define USB_AUDIO_FIR_EQ_BUFF_SIZE (USB_AUDIO_PLAYBACK_BUFF_SIZE * sizeof(int16_t) / SAMPLE_SIZE_PLAYBACK)
|
||
|
|
#elif defined(CHIP_BEST2000)
|
||
|
|
// FIR EQ is working on 16-bit
|
||
|
|
#define USB_AUDIO_FIR_EQ_BUFF_SIZE (USB_AUDIO_PLAYBACK_BUFF_SIZE * sizeof(int32_t) / SAMPLE_SIZE_PLAYBACK)
|
||
|
|
#elif defined(CHIP_BEST2300) || defined(CHIP_BEST2300P)
|
||
|
|
// FIR EQ is working on 16-bit
|
||
|
|
#define USB_AUDIO_FIR_EQ_BUFF_SIZE (USB_AUDIO_PLAYBACK_BUFF_SIZE * sizeof(int32_t) / SAMPLE_SIZE_PLAYBACK)
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if (defined(CHIP_BEST1000) && (defined(ANC_APP) || defined(_DUAL_AUX_MIC_))) && (CHAN_NUM_CAPTURE == CHAN_NUM_SEND)
|
||
|
|
// Resample input buffer size should be (half_of_max_sample_num * SAMPLE_SIZE_CAPTURE * CHAN_NUM_CAPTURE).
|
||
|
|
// half_of_max_sample_num = 48000 / 1000 * CODEC_BUFF_FRAME_NUM / 2 * 48 / 44
|
||
|
|
#define RESAMPLE_INPUT_BUFF_SIZE ALIGN(48000 / 1000 * SAMPLE_SIZE_CAPTURE * CHAN_NUM_CAPTURE * CODEC_BUFF_FRAME_NUM / 2 * 48 / 44, 4)
|
||
|
|
#else
|
||
|
|
#define RESAMPLE_INPUT_BUFF_SIZE 0
|
||
|
|
#endif
|
||
|
|
// Resample history buffer size should be
|
||
|
|
// sizeof(struct RESAMPLE_CTRL_T) + ((SAMPLE_NUM + phase_coef_num) * SAMPLE_SIZE_CAPTURE * CHAN_NUM_CAPTURE)
|
||
|
|
#define RESAMPLE_HISTORY_BUFF_SIZE (50 + (256 * SAMPLE_SIZE_CAPTURE * CHAN_NUM_CAPTURE))
|
||
|
|
#define USB_AUDIO_RESAMPLE_BUFF_SIZE (RESAMPLE_INPUT_BUFF_SIZE + RESAMPLE_HISTORY_BUFF_SIZE)
|
||
|
|
|
||
|
|
#define ALIGNED4 ALIGNED(4)
|
||
|
|
|
||
|
|
#if defined(USB_AUDIO_APP) || defined(DUALADC_AUDIO_TEST)
|
||
|
|
|
||
|
|
#ifdef AUDIO_ANC_FB_MC
|
||
|
|
static uint8_t ALIGNED4 playback_buff[USB_AUDIO_PLAYBACK_BUFF_SIZE * 9];//max 48->384 or 44.1->44.1*8;
|
||
|
|
#else
|
||
|
|
static uint8_t ALIGNED4 playback_buff[USB_AUDIO_PLAYBACK_BUFF_SIZE];
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static uint8_t ALIGNED4 capture_buff[USB_AUDIO_CAPTURE_BUFF_SIZE];
|
||
|
|
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef USB_AUDIO_APP
|
||
|
|
#if defined(__HW_FIR_EQ_PROCESS__) && defined(__HW_IIR_EQ_PROCESS__)
|
||
|
|
static uint8_t ALIGNED4 eq_buff[USB_AUDIO_FIR_EQ_BUFF_SIZE+USB_AUDIO_IIR_EQ_BUFF_SIZE];
|
||
|
|
#elif defined(__HW_FIR_EQ_PROCESS__) && !defined(__HW_IIR_EQ_PROCESS__)
|
||
|
|
static uint8_t ALIGNED4 eq_buff[USB_AUDIO_FIR_EQ_BUFF_SIZE];
|
||
|
|
#elif !defined(__HW_FIR_EQ_PROCESS__) && defined(__HW_IIR_EQ_PROCESS__)
|
||
|
|
static uint8_t ALIGNED4 eq_buff[USB_AUDIO_IIR_EQ_BUFF_SIZE];
|
||
|
|
#else
|
||
|
|
static uint8_t ALIGNED4 eq_buff[0];
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef SW_CAPTURE_RESAMPLE
|
||
|
|
static uint8_t ALIGNED4 resample_buff[USB_AUDIO_RESAMPLE_BUFF_SIZE];
|
||
|
|
#else
|
||
|
|
static uint8_t ALIGNED4 resample_buff[0];
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static uint8_t ALIGNED4 recv_buff[USB_AUDIO_RECV_BUFF_SIZE];
|
||
|
|
static uint8_t ALIGNED4 send_buff[USB_AUDIO_SEND_BUFF_SIZE];
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef CFG_HW_KEY_LED_PIN
|
||
|
|
const struct HAL_IOMUX_PIN_FUNCTION_MAP pinmux_key_led[1] = {
|
||
|
|
{CFG_HW_KEY_LED_PIN, HAL_IOMUX_FUNC_AS_GPIO, HAL_IOMUX_PIN_VOLTAGE_VIO, HAL_IOMUX_PIN_NOPULL},
|
||
|
|
};
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef CFG_MIC_KEY
|
||
|
|
extern void mic_key_open (void);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static void uart_i2c_switch(void)
|
||
|
|
{
|
||
|
|
static int flag = 0;
|
||
|
|
|
||
|
|
flag ^= 1;
|
||
|
|
|
||
|
|
if (flag) {
|
||
|
|
hal_iomux_set_analog_i2c();
|
||
|
|
} else {
|
||
|
|
hal_iomux_set_uart0();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static int POSSIBLY_UNUSED key_event_process(uint32_t key_code, uint8_t key_event)
|
||
|
|
{
|
||
|
|
TRACE(3,"%s: code=0x%X, event=%u", __FUNCTION__, key_code, key_event);
|
||
|
|
|
||
|
|
#ifdef CFG_HW_KEY_LED_PIN
|
||
|
|
if (key_event == HAL_KEY_EVENT_DOWN) {
|
||
|
|
hal_gpio_pin_set(CFG_HW_KEY_LED_PIN);
|
||
|
|
} else if (key_event == HAL_KEY_EVENT_UP) {
|
||
|
|
hal_gpio_pin_clr(CFG_HW_KEY_LED_PIN);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef USB_AUDIO_APP
|
||
|
|
if (usb_audio_app_key(key_code, key_event) == 0) {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef ANC_APP
|
||
|
|
if (anc_usb_app_key(key_code, key_event) == 0) {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
if (key_event == HAL_KEY_EVENT_CLICK) {
|
||
|
|
if (key_code == HAL_KEY_CODE_FN9) {
|
||
|
|
uart_i2c_switch();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void anc_usb_open(void)
|
||
|
|
{
|
||
|
|
TRACE(1,"%s", __FUNCTION__);
|
||
|
|
|
||
|
|
#ifdef __AUDIO_RESAMPLE__
|
||
|
|
hal_cmu_audio_resample_enable();
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef USB_AUDIO_APP
|
||
|
|
struct USB_AUDIO_BUF_CFG cfg;
|
||
|
|
|
||
|
|
memset(&cfg, 0, sizeof(cfg));
|
||
|
|
cfg.play_buf = playback_buff;
|
||
|
|
#ifdef AUDIO_ANC_FB_MC
|
||
|
|
cfg.play_size = sizeof(playback_buff) / 9;
|
||
|
|
#else
|
||
|
|
cfg.play_size = sizeof(playback_buff);
|
||
|
|
#endif
|
||
|
|
cfg.cap_buf = capture_buff;
|
||
|
|
cfg.cap_size = sizeof(capture_buff);
|
||
|
|
cfg.recv_buf = recv_buff;
|
||
|
|
cfg.recv_size = sizeof(recv_buff);
|
||
|
|
cfg.send_buf = send_buff;
|
||
|
|
cfg.send_size = sizeof(send_buff);
|
||
|
|
cfg.eq_buf = eq_buff;
|
||
|
|
cfg.eq_size = sizeof(eq_buff);
|
||
|
|
cfg.resample_buf = resample_buff;
|
||
|
|
cfg.resample_size = sizeof(resample_buff);
|
||
|
|
|
||
|
|
usb_audio_app_init(&cfg);
|
||
|
|
usb_audio_app(1);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef ANC_APP
|
||
|
|
anc_usb_app_init(AUD_INPUT_PATH_MAINMIC, SAMPLE_RATE_PLAYBACK, SAMPLE_RATE_CAPTURE);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef DUALADC_AUDIO_TEST
|
||
|
|
dualadc_audio_app_init(playback_buff, USB_AUDIO_PLAYBACK_BUFF_SIZE,
|
||
|
|
capture_buff, USB_AUDIO_CAPTURE_BUFF_SIZE);
|
||
|
|
dualadc_audio_app(1);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if defined(CFG_MIC_KEY)
|
||
|
|
mic_key_open();
|
||
|
|
#endif
|
||
|
|
#ifdef BT_USB_AUDIO_DUAL_MODE
|
||
|
|
return;
|
||
|
|
#endif
|
||
|
|
// Allow sleep
|
||
|
|
hal_sysfreq_req(HAL_SYSFREQ_USER_INIT, HAL_CMU_FREQ_32K);
|
||
|
|
|
||
|
|
while (1) {
|
||
|
|
#ifdef USB_AUDIO_APP
|
||
|
|
usb_audio_app_loop();
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef ANC_APP
|
||
|
|
anc_usb_app_loop();
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef RTOS
|
||
|
|
// Let the task sleep
|
||
|
|
osDelay(20);
|
||
|
|
#else // !RTOS
|
||
|
|
|
||
|
|
#ifdef __PC_CMD_UART__
|
||
|
|
hal_cmd_run();
|
||
|
|
#endif
|
||
|
|
|
||
|
|
hal_sleep_enter_sleep();
|
||
|
|
|
||
|
|
#endif // !RTOS
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void anc_usb_close(void)
|
||
|
|
{
|
||
|
|
usb_audio_app(0);
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CFG_HW_GPADCKEY
|
||
|
|
void gpadc_key_handler(uint16_t irq_val, HAL_GPADC_MV_T volt)
|
||
|
|
{
|
||
|
|
static uint16_t stable_cnt = 0;
|
||
|
|
static uint16_t click_cnt = 0;
|
||
|
|
static uint32_t click_time;
|
||
|
|
uint32_t time;
|
||
|
|
enum HAL_KEY_EVENT_T event;
|
||
|
|
bool send_event = false;
|
||
|
|
|
||
|
|
time = hal_sys_timer_get();
|
||
|
|
|
||
|
|
if (volt < 100) {
|
||
|
|
stable_cnt++;
|
||
|
|
//TRACE(5,"adc_key down: volt=%u stable=%u click_cnt=%u click_time=%u time=%u", volt, stable_cnt, click_cnt, click_time, time);
|
||
|
|
} else {
|
||
|
|
if (stable_cnt > 1) {
|
||
|
|
//TRACE(5,"adc_key up: volt=%u stable=%u click_cnt=%u click_time=%u time=%u", volt, stable_cnt, click_cnt, click_time, time);
|
||
|
|
if (click_cnt == 0 || (time - click_time) < MS_TO_TICKS(500)) {
|
||
|
|
click_time = time;
|
||
|
|
click_cnt++;
|
||
|
|
if (click_cnt >= 3) {
|
||
|
|
send_event = true;
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
send_event = true;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
stable_cnt = 0;
|
||
|
|
|
||
|
|
if (click_cnt > 0 && (time - click_time) >= MS_TO_TICKS(500)) {
|
||
|
|
send_event = true;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (send_event) {
|
||
|
|
//TRACE(5,"adc_key click: volt=%u stable=%u click_cnt=%u click_time=%u time=%u", volt, stable_cnt, click_cnt, click_time, time);
|
||
|
|
if (click_cnt == 1) {
|
||
|
|
event = HAL_KEY_EVENT_CLICK;
|
||
|
|
} else if (click_cnt == 2) {
|
||
|
|
event = HAL_KEY_EVENT_DOUBLECLICK;
|
||
|
|
} else {
|
||
|
|
event = HAL_KEY_EVENT_TRIPLECLICK;
|
||
|
|
}
|
||
|
|
key_event_process(CFG_HW_GPADCKEY, event);
|
||
|
|
click_cnt = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
// GDB can set a breakpoint on the main function only if it is
|
||
|
|
// declared as below, when linking with STD libraries.
|
||
|
|
int btusbaudio_entry(void)
|
||
|
|
{
|
||
|
|
anc_usb_open();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void btusbaudio_exit(void)
|
||
|
|
{
|
||
|
|
anc_usb_close();
|
||
|
|
}
|
||
|
|
|
||
|
|
|