353 lines
11 KiB
C
353 lines
11 KiB
C
/*
|
|
****************************************************************
|
|
* Hearing Aid Low Power
|
|
* 检测数据能量的函数
|
|
* File : audi_hearing_aid_lp.c
|
|
* By :
|
|
* Notes :
|
|
****************************************************************
|
|
*/
|
|
|
|
#include "asm/includes.h"
|
|
#include "media/includes.h"
|
|
#include "system/includes.h"
|
|
#include "app_main.h"
|
|
#include "audio_config.h"
|
|
#include "app_action.h"
|
|
#include "audio_hearing_aid_lp.h"
|
|
|
|
extern struct audio_dac_hdl dac_hdl;
|
|
extern struct audio_adc_hdl adc_hdl;
|
|
|
|
#ifndef TCFG_AUDIO_DHA_MIC_SAMPLE_RATE
|
|
#define TCFG_AUDIO_DHA_MIC_SAMPLE_RATE 32000
|
|
#endif
|
|
|
|
//*********************************************************************************//
|
|
// mic能量检测处理配置 //
|
|
//*********************************************************************************//
|
|
//是否开启mic 能量检测
|
|
#define MIC_ENERGY_DETECT 1
|
|
|
|
//判断多少ms没有能量就进入低功耗
|
|
#define MIC_SNIFF_TIME 2 * 60 * 1000
|
|
//#define MIC_SNIFF_TIME 5 * 1000
|
|
|
|
//进入低功耗后每隔多少ms计算一次能量
|
|
#define MIC_CHECK_INTER 1 * 1000
|
|
|
|
//低功耗状态下能量检测计算多少ms的能量
|
|
#define MIC_ENERGY_TIME 20
|
|
|
|
//进入低功耗的能量值,小于此能量值进入低功耗
|
|
#define enter_sniff_energy 50
|
|
|
|
//退出低功耗的能量值,大于退出低功耗 //从低功耗出来时adc 能量值会比较高，需要比较高的阈值
|
|
#define exit_sniff_energy 170
|
|
|
|
//跳过刚上电的多少次中断数据
|
|
#define adc_isr_ignore_cnt 8
|
|
|
|
//是否打开mic 能量的调试打印
|
|
#define ENERGY_DEBUG_EN 0
|
|
|
|
static u8 enter_sleep = 0;
|
|
|
|
#if ENERGY_DEBUG_EN
|
|
static u32 debug_size = 4096 * 2;
|
|
/* static s16 debug_buf[4096 * 2]; */
|
|
static u32 debug_p = 0;
|
|
static u32 zero_cnt = 0;
|
|
static u32 no_zero_cnt = 0;
|
|
static u8 debug_flag = 0;
|
|
#endif
|
|
|
|
struct hearing_aid_energy_detect {
|
|
u32 exit_sniff_points; //一次检测的点数
|
|
u32 abs_total_0; //mic0 的能量
|
|
u32 abs_total_1; //mic1 的能量
|
|
u32 points_count; //点数
|
|
u32 energy_detect_flag;//是否开始计算能量的标志
|
|
u32 enter_sniff_points; //多少个点的能量低于阈值进低功耗
|
|
u32 exit_sniff_timer; //检测能量值定时器
|
|
u16 dac_start_timer; //检测能量值定时器
|
|
u16 dac_stop_timer; //检测能量值定时器
|
|
u8 dac_start_flag; //dac 开启或关闭的标志位
|
|
u8 isr_ignore_cnt; //跳过刚上电的多少次中断数据
|
|
u8 adc_ch_num; //打开多少个mic通道
|
|
struct adc_mic_ch mic_ch;
|
|
s16 *adc_dma_buf;
|
|
struct audio_adc_output_hdl adc_output;
|
|
u8 dac_open;
|
|
void (*hw_open)(void);
|
|
void (*hw_close)(void);
|
|
};
|
|
|
|
static struct hearing_aid_energy_detect *mic_aid = NULL;
|
|
|
|
void exit_sniff_start(void) //定时能量检测,能量检测的时候mic能不能正常工作
|
|
{
|
|
#if ENERGY_DEBUG_EN
|
|
printf("enter low_power_deal.c %d\n", __LINE__);
|
|
#endif
|
|
|
|
mic_aid->energy_detect_flag = 1; //开始能量计算
|
|
mic_aid->isr_ignore_cnt = adc_isr_ignore_cnt;
|
|
|
|
#if 1 //重新打开mic
|
|
extern void hearing_aid_energy_demo_open(u8 mic_idx, u8 gain, u16 sr, u8 mic_2_dac);
|
|
hearing_aid_energy_demo_open(TCFG_AD2DA_LOW_LATENCY_MIC_CHANNEL, 12, TCFG_AUDIO_DHA_MIC_SAMPLE_RATE, 0);
|
|
/* audio_adc_mic_aid_open(mic_aid->mic_idx, mic_aid->gain, mic_aid->sr, 0); */
|
|
#else
|
|
SFR(JL_ADDA->DAA_CON0, 16, 1, 1); // VBG_EN_11v
|
|
SFR(JL_ADDA->ADA_CON0, 17, 1, 0); // CTADCA_S2_RSTB
|
|
os_time_dly(50);
|
|
SFR(JL_ADDA->ADA_CON0, 17, 1, 1); // CTADCA_S2_RSTB
|
|
SFR(JL_ADDA->DAA_CON0, 12, 1, 1); //AUDIO_IBIAS_EN_11V
|
|
#endif
|
|
|
|
enter_sleep = 0; //退出低功耗
|
|
sys_timer_del(mic_aid->exit_sniff_timer);
|
|
}
|
|
|
|
|
|
void dac_start_timer(void) //启动dac
|
|
{
|
|
#if ENERGY_DEBUG_EN
|
|
printf("enter low_power_deal.c%d\n", __LINE__);
|
|
#endif
|
|
|
|
extern void hearing_aid_energy_demo_close(void);
|
|
hearing_aid_energy_demo_close();
|
|
|
|
printf("enter low_power_deal.c%d\n", __LINE__);
|
|
|
|
if (mic_aid->hw_open) {
|
|
mic_aid->hw_open();
|
|
}
|
|
/* sound_pcm_dev_start(NULL, 16000, 10); */
|
|
enter_sleep = 0; //退出低功耗
|
|
/* mic_aid->adc_2_dac = 1; */
|
|
mic_aid->dac_start_flag = 1 ;
|
|
sys_timer_del(mic_aid->dac_start_timer);
|
|
}
|
|
|
|
|
|
void dac_stop_timer(void) //关闭dac
|
|
{
|
|
#if ENERGY_DEBUG_EN
|
|
printf("enter low_power_deal.c%d\n", __LINE__);
|
|
#endif
|
|
|
|
|
|
extern void hearing_aid_energy_demo_close(void);
|
|
hearing_aid_energy_demo_close();
|
|
|
|
if (mic_aid->hw_close) {
|
|
|
|
printf("enter low_power_deal.c%d,%p\n", __LINE__, mic_aid->hw_close);
|
|
mic_aid->hw_close();
|
|
}
|
|
/* audio_adc_del_output_handler(&adc_hdl, &mic_aid->adc_output); */
|
|
/* audio_adc_mic_close(&mic_aid->mic_ch); */
|
|
mic_aid->adc_ch_num = 0; //mic_aid 被关了
|
|
//将变量清0，开始新一轮计算
|
|
mic_aid->abs_total_0 = 0;
|
|
mic_aid->abs_total_1 = 0;
|
|
mic_aid->points_count = 0;
|
|
mic_aid->energy_detect_flag = 0;
|
|
|
|
enter_sleep = 1; //进入低功耗
|
|
/* mic_aid->adc_2_dac = 0; */
|
|
mic_aid->dac_start_flag = 0 ;
|
|
sys_timer_del(mic_aid->dac_stop_timer);
|
|
|
|
printf("enter low_power_deal.c%d\n", __LINE__);
|
|
}
|
|
|
|
|
|
void audio_hearing_aid_lp_open(u8 ch_num, void (*hw_open)(void), void (*hw_close)(void)) //对多少个通道做数据处理
|
|
{
|
|
if (!mic_aid) {
|
|
printf("enter low_power_deal.c%d\n", __LINE__);
|
|
mic_aid = zalloc(sizeof(struct hearing_aid_energy_detect));
|
|
}
|
|
|
|
#if 0
|
|
else {
|
|
/* memset(mic_aid,0,sizeof(struct hearing_aid_energy_detect)); */
|
|
}
|
|
#endif
|
|
mic_aid->exit_sniff_points = MIC_ENERGY_TIME * (TCFG_AUDIO_DHA_MIC_SAMPLE_RATE / 1000); //进入低功耗后一次检测的点数
|
|
mic_aid->enter_sniff_points = MIC_SNIFF_TIME * (TCFG_AUDIO_DHA_MIC_SAMPLE_RATE / 1000); //多少个点的能量低于阈值进低功耗
|
|
mic_aid->adc_ch_num = ch_num;
|
|
mic_aid-> hw_open = hw_open; //正常工作打开硬件的函数(关mic，关dac)
|
|
mic_aid-> hw_close = hw_close; //进入低功耗关硬件的函数(开mic，开dac)
|
|
mic_aid->abs_total_0 = 0;
|
|
mic_aid->abs_total_1 = 0;
|
|
mic_aid->points_count = 0;
|
|
enter_sleep = 0;
|
|
|
|
}
|
|
|
|
void audio_hearing_aid_lp_close(void)
|
|
{
|
|
if (mic_aid) {
|
|
free(mic_aid);
|
|
mic_aid = NULL;
|
|
}
|
|
}
|
|
|
|
u8 audio_hearing_aid_lp_flag(void)
|
|
{
|
|
return enter_sleep;
|
|
}
|
|
|
|
void audio_hearing_aid_lp_detect(void *priv, s16 *data, int len)
|
|
{
|
|
#if MIC_ENERGY_DETECT
|
|
u32 points = len / 2;
|
|
s16 *pdata = data;
|
|
u32 i = 0;
|
|
s32 total_0 = 0;
|
|
s32 total_1 = 0;
|
|
s16 diff = 0;
|
|
u32 target_points = 0;
|
|
u32 target_energy = 0;
|
|
|
|
if (enter_sleep == 0) { //低功耗期间也会进中断，不能计算能量值
|
|
if (mic_aid->isr_ignore_cnt > 0) {
|
|
mic_aid->isr_ignore_cnt--;
|
|
return;
|
|
} //跳过刚开始的一次中断数据
|
|
|
|
for (i = 0; i < points; i++) {
|
|
total_0 += *pdata;
|
|
pdata++;
|
|
if (mic_aid->adc_ch_num == 2) {
|
|
total_1 += *pdata;
|
|
pdata++;
|
|
}
|
|
}
|
|
|
|
total_0 /= (len / 2 / mic_aid->adc_ch_num); //直流量
|
|
total_1 /= (len / 2 / mic_aid->adc_ch_num);
|
|
// printf(">> total_0 %d total_1 %d\n", total_0, total_1);
|
|
pdata = data;
|
|
|
|
if (mic_aid->energy_detect_flag) { //由定时器启动的能量计算
|
|
target_points = mic_aid->exit_sniff_points; //多少时间检测
|
|
target_energy = exit_sniff_energy;
|
|
} else {
|
|
target_points = mic_aid-> enter_sniff_points; //正常工作检测多久
|
|
target_energy = enter_sniff_energy;
|
|
}
|
|
|
|
for (i = 0; i < points; i++) {
|
|
#if ENERGY_DEBUG_EN
|
|
#if 0
|
|
if (debug_p < debug_size) {
|
|
debug_buf[debug_p++] = *pdata ;
|
|
if (*pdata == 0) {
|
|
zero_cnt++;
|
|
} else {
|
|
no_zero_cnt++;
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
diff = *pdata - total_0;
|
|
if (diff > 0) {
|
|
mic_aid->abs_total_0 += diff;
|
|
} else {
|
|
mic_aid->abs_total_0 -= diff;
|
|
}
|
|
pdata++;
|
|
if (mic_aid->adc_ch_num == 2) {
|
|
diff = *pdata - total_1;
|
|
if (diff > 0) {
|
|
mic_aid->abs_total_1 += diff;
|
|
} else {
|
|
mic_aid->abs_total_1 -= diff;
|
|
}
|
|
pdata++;
|
|
}
|
|
mic_aid -> points_count++;
|
|
|
|
|
|
#if ENERGY_DEBUG_EN
|
|
/* printf("enter audio_adc_aid.c@@@@@@@@@@@@@@@@@@@@@@@@@@%d,%d,%d,%d\n",__LINE__,target_points,enter_sleep,mic_aid->points_count); */
|
|
#endif
|
|
|
|
|
|
if (mic_aid->points_count == target_points) {
|
|
|
|
#if ENERGY_DEBUG_EN
|
|
printf("enter low_power_deal.c %d,%d,%d,%d,%d\n", __LINE__, mic_aid->abs_total_0, mic_aid->abs_total_1, mic_aid->points_count, target_points);
|
|
#endif
|
|
mic_aid->abs_total_0 /= target_points;
|
|
mic_aid->abs_total_1 /= target_points;
|
|
|
|
#if ENERGY_DEBUG_EN
|
|
printf("enter low_power_deal.c %d,%d,%d,%d\n", __LINE__, mic_aid->abs_total_0, mic_aid->abs_total_1, target_energy);
|
|
#endif
|
|
|
|
#if ENERGY_DEBUG_EN
|
|
extern void audio_adda_dump(void); //打印所有的dac,adc寄存器
|
|
extern void audio_gain_dump();
|
|
audio_adda_dump();
|
|
audio_gain_dump();
|
|
#endif
|
|
|
|
if ((mic_aid->abs_total_0 < target_energy) && (mic_aid->abs_total_1 < target_energy)) { //
|
|
|
|
|
|
|
|
|
|
mic_aid->dac_stop_timer = sys_timer_add(NULL, dac_stop_timer, 1);
|
|
mic_aid->exit_sniff_timer = sys_timer_add(NULL, exit_sniff_start, MIC_CHECK_INTER); //退出低功耗计算能量值
|
|
#if ENERGY_DEBUG_EN
|
|
debug_p = 0;
|
|
zero_cnt = no_zero_cnt = 0;
|
|
/* memset(debug_buf, 0, debug_size * 2); */
|
|
printf("enter low_power_deal.c %d,%d,%d\n", __LINE__, mic_aid->abs_total_0, mic_aid->abs_total_1);
|
|
#endif
|
|
break;
|
|
} else {
|
|
//将变量清0，开始新一轮计算
|
|
mic_aid->abs_total_0 = 0;
|
|
mic_aid->abs_total_1 = 0;
|
|
mic_aid->points_count = 0;
|
|
mic_aid->energy_detect_flag = 0;
|
|
enter_sleep = 0;
|
|
|
|
#if ENERGY_DEBUG_EN
|
|
debug_p = 0;
|
|
/* memset(debug_buf, 0, debug_size * 2); */
|
|
zero_cnt = no_zero_cnt = 0;
|
|
#endif
|
|
|
|
if (!audio_dac_is_working(&dac_hdl)) {
|
|
|
|
mic_aid->dac_start_timer = sys_timer_add(NULL, dac_start_timer, 1);
|
|
}
|
|
}
|
|
|
|
} //end of if 点数等于 enter_sniff_points
|
|
}//endf of for
|
|
} //end of 低功耗期间也会进中断，不能计算能量值
|
|
|
|
if (mic_aid->dac_open == 0) {
|
|
return;
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|