1815 lines
59 KiB
C
1815 lines
59 KiB
C
#include "audio_effect/audio_gain_process_demo.h"
|
||
#include "audio_effect/audio_voice_changer_demo.h"
|
||
#include "audio_effect/audio_vbass_demo.h"
|
||
#include "media/effects_adj.h"
|
||
#include "audio_effect/audio_eff_default_parm.h"
|
||
#include "app_sound_box_tool.h"
|
||
#include "app_config.h"
|
||
#include "audio_mic/effect_parm.h"
|
||
|
||
|
||
|
||
#define PARM_DEBUG 0
|
||
|
||
#define LOG_TAG "[EFFECT]"
|
||
#define LOG_ERROR_ENABLE
|
||
#define LOG_DEBUG_ENABLE
|
||
#define LOG_INFO_ENABLE
|
||
#define LOG_DUMP_ENABLE
|
||
#include "debug.h"
|
||
#ifdef SUPPORT_MS_EXTENSIONS
|
||
//#pragma bss_seg(".audio_mic_stream_bss")
|
||
//#pragma data_seg(".audio_mic_stream_data")
|
||
#pragma const_seg(".audio_effect_adj_const")
|
||
#pragma code_seg(".audio_effect_adj_code")
|
||
#endif
|
||
|
||
//#define EFF_CFG_FILE_NAME SDFILE_RES_ROOT_PATH"eq_cfg_hw.bin"
|
||
u8 EFF_CFG_FILE_NAME[48] = SDFILE_RES_ROOT_PATH"eq_cfg_hw.bin";
|
||
const u8 eff_sdk_name[16] = "AC695N";
|
||
const u8 eff_eq_ver[4] = {1, 0, 0, 0};
|
||
|
||
|
||
extern const u16 eq_name[5] ;
|
||
extern const u16 drc_name[5] ;
|
||
static const u16 eff_mode_seq[8] = {mic_mode_seq0, mic_mode_seq1, mic_mode_seq2, mic_mode_seq3, mic_mode_seq4, mic_mode_seq5, mic_mode_seq6, mic_mode_seq7}; //混响模式标号
|
||
|
||
//每个模块id对应一个group_id(功能id)
|
||
const struct mode_list mlist[] = {
|
||
{AEID_ESCO_DL_EQ, phone_eq_nsection, 2, {EFF_PHONE_WIDEBAND_EQ, EFF_PHONE_NARROWBAND_EQ}},
|
||
{AEID_ESCO_DL_DRC, phone_eq_nsection, 2, {EFF_PHONE_WIDEBAND_DRC, EFF_PHONE_NARROWBAND_DRC}},
|
||
{AEID_ESCO_UL_EQ, phone_eq_nsection, 2, {EFF_AEC_WIDEBAND_EQ, EFF_AEC_NARROWBAND_EQ}},
|
||
{AEID_ESCO_UL_DRC, phone_eq_nsection, 2, {EFF_AEC_WIDEBAND_DRC, EFF_AEC_NARROWBAND_DRC}},
|
||
|
||
{AEID_MUSIC_EQ, music_eq_nsection, 1, {EFF_MUSIC_EQ}},
|
||
{AEID_MUSIC_EQ2, music_eq2_nsection, 1, {EFF_MUSIC_EQ2}},
|
||
{AEID_MUSIC_DRC, music_eq_nsection, 5, {EFF_MUSIC_LOW_DRC, EFF_MUSIC_MID_DRC, EFF_MUSIC_HIGH_DRC, EFF_MUSIC_WHOLE_DRC, EFF_MUSIC_CROSSOVER }}, //最后一个groud_id存方分频器
|
||
{AEID_MUSIC_FR_EQ, music_eq_nsection, 1, {0x2003}},
|
||
{AEID_MUSIC_FR_DRC, music_eq_nsection, 1, {0x2004}},
|
||
{AEID_MUSIC_RL_EQ, music_eq_nsection, 1, {0x2005}},
|
||
{AEID_MUSIC_RL_DRC, music_eq_nsection, 5, {EFF_MUSIC_RL_LOW_DRC, EFF_MUSIC_RL_MID_DRC, EFF_MUSIC_RL_MID_DRC, EFF_MUSIC_RL_HIGH_DRC, EFF_MUSIC_RL_WHOLE_DRC }},
|
||
{AEID_MUSIC_RR_EQ, music_eq_nsection, 1, {0x2007}},
|
||
{AEID_MUSIC_RR_DRC, music_eq_nsection, 1, {0x2008}},
|
||
|
||
{AEID_MIC_EQ0, mic_eq_nsection, 1, {EFF_MIC_EQ0}},
|
||
{AEID_MIC_DRC0, mic_eq_nsection, 1, {EFF_MIC_DRC0}},
|
||
{AEID_MIC_EQ1, mic_eq_nsection, 1, {EFF_MIC_EQ1}},
|
||
{AEID_MIC_DRC1, mic_eq_nsection, 1, {EFF_MIC_DRC1}},
|
||
{AEID_MIC_EQ2, mic_eq_nsection, 1, {EFF_MIC_EQ2}},
|
||
{AEID_MIC_DRC2, mic_eq_nsection, 1, {EFF_MIC_DRC2}},
|
||
{AEID_MIC_EQ3, mic_eq_nsection, 1, {EFF_MIC_EQ3}},
|
||
{AEID_MIC_DRC3, mic_eq_nsection, 1, {EFF_MIC_DRC3}},
|
||
{AEID_MIC_EQ4, mic_eq_nsection, 1, {EFF_MIC_EQ4}},
|
||
{AEID_MIC_DRC4, mic_eq_nsection, 1, {EFF_MIC_DRC4}},
|
||
|
||
{AEID_LINEIN_EQ, music_eq_nsection, 1, {EFF_LINEIN_EQ}},
|
||
{AEID_LINEIN_DRC, music_eq_nsection, 1, {EFF_LINEIN_DRC}},
|
||
{AEID_HIGH_BASS_EQ, music_eq_nsection, 1, {EFF_MUSIC_HIGH_BASS_EQ}},
|
||
{AEID_HIGH_BASS_DRC, music_eq_nsection, 1, {EFF_MUSIC_HIGH_BASS_DRC}},
|
||
{AEID_MUSIC_LPF_EQ, music_eq_nsection, 1, {EFF_MUSIC_LPF_EQ}},
|
||
|
||
};
|
||
|
||
int get_module_name(u16 group_id)
|
||
{
|
||
for (int i = 0; i < ARRAY_SIZE(mlist); i++) {
|
||
struct mode_list *list = (struct mode_list *)&mlist[i];
|
||
for (int j = 0; j < list->group_num; j++) {
|
||
if (list->group_id[j] == group_id) {
|
||
return list->module_name;
|
||
}
|
||
}
|
||
}
|
||
log_e("get_module_name error\n");
|
||
return 0;
|
||
}
|
||
int get_module_name_and_index(u16 group_id, u16 *index)
|
||
{
|
||
for (int i = 0; i < ARRAY_SIZE(mlist); i++) {
|
||
struct mode_list *list = (struct mode_list *)&mlist[i];
|
||
for (int j = 0; j < list->group_num; j++) {
|
||
if (list->group_id[j] == group_id) {
|
||
*index = j;
|
||
return list->module_name;
|
||
}
|
||
}
|
||
}
|
||
log_e("get_module_name error\n");
|
||
return 0;
|
||
}
|
||
|
||
int get_group_id(u16 module_name, u8 tar)
|
||
{
|
||
for (int i = 0; i < ARRAY_SIZE(mlist); i++) {
|
||
struct mode_list *list = (struct mode_list *)&mlist[i];
|
||
if (list->module_name == module_name) { //
|
||
return list->group_id[tar];
|
||
}
|
||
}
|
||
log_e("get_module_id error\n");
|
||
return 0;
|
||
}
|
||
struct mode_list *get_group_list(u16 module_name)
|
||
{
|
||
for (int i = 0; i < ARRAY_SIZE(mlist); i++) {
|
||
struct mode_list *list = (struct mode_list *)&mlist[i];
|
||
if (list->module_name == module_name) { //
|
||
return list;
|
||
}
|
||
}
|
||
return NULL;
|
||
}
|
||
int get_eq_nsection(u16 module_name)
|
||
{
|
||
for (int i = 0; i < ARRAY_SIZE(mlist); i++) {
|
||
struct mode_list *list = (struct mode_list *)&mlist[i];
|
||
if (list->module_name == module_name) {
|
||
return list->nsection;
|
||
}
|
||
}
|
||
log_e("get_eq_nsection error\n");
|
||
return 0;
|
||
}
|
||
|
||
int get_eq_seg(u16 module_name)
|
||
{
|
||
return 0;
|
||
}
|
||
void get_eff_mode(u16 mode_id, u16 group_id, u8 *mode_index, u8 *drc_index)//获取混响模式的index
|
||
{
|
||
*mode_index = mode_id - mic_mode_seq0;
|
||
*drc_index = group_id - EFF_MIC_DRC0;
|
||
}
|
||
int get_phone_mode(u16 group_id)
|
||
{
|
||
return group_id - EFF_PHONE_WIDEBAND_EQ;
|
||
}
|
||
|
||
#define REPLY_TO_TOOL (0)
|
||
#define EFF_CFG_FILE_ID (0x3)//音效配置项源文件id
|
||
|
||
static u8 eff_mode_save = 0;
|
||
#if TCFG_DYNAMIC_EQ_ENABLE
|
||
DynamicEQParam_TOOL_SET dynamic_eq;
|
||
#endif
|
||
struct eff_parm eff_mode[EFFECT_REVERB_PARM_MAX];//混响的8个模式
|
||
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
struct music_parm_tool_set linein_mode;//linin模式
|
||
|
||
#endif
|
||
struct music_parm_tool_set music_mode;//音乐模式
|
||
|
||
#if TCFG_DYNAMIC_EQ_ENABLE
|
||
struct music_eq2_tool music_eq2_parm;//音乐模式下第二eq
|
||
#endif
|
||
|
||
struct phone_parm_tool_set phone_mode[4];//通话上下行模式 0:下行宽 1：下行窄 2：上行宽 3:上行窄
|
||
|
||
#if (TCFG_AUDIO_DAC_CONNECT_MODE == DAC_OUTPUT_FRONT_LR_REAR_LR)
|
||
struct music_eq_tool rl_eq_parm;//rl通道eq
|
||
struct nband_drc rl_drc_parm;//rl通道drc
|
||
#endif
|
||
#if defined(SOUND_TRACK_2_P_X_CH_CONFIG) &&SOUND_TRACK_2_P_X_CH_CONFIG
|
||
LowPassParam_TOOL_SET low_pass_parm;//rl rr通道低通滤波器
|
||
#endif
|
||
|
||
void wdrc_printf(void *_wdrc);
|
||
static u16 alive_timer = 0;
|
||
|
||
int vbass_prev_gain_process_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if AUDIO_VBASS_CONFIG
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&vbass_prev_gain_parm, &packet->data[1], sizeof(vbass_prev_gain_parm));
|
||
audio_gain_update_parm(AEID_MUSIC_VBASS_PREV_GAIN, &vbass_prev_gain_parm.parm, vbass_prev_gain_parm.is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("vbass_prev_gain_parm.is_bypass %d, gain 0x%x", vbass_prev_gain_parm.is_bypass, *(int *)&vbass_prev_gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
|
||
int music_vbass_parm_ananlyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if AUDIO_VBASS_CONFIG
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&vbass_parm, &packet->data[1], sizeof(vbass_parm));
|
||
audio_vbass_update_demo(AEID_MUSIC_VBASS, &vbass_parm.parm, vbass_parm.is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("is_bypass %d, ratio %d, boost %d, fc %d\n", vbass_parm.is_bypass, vbass_parm.parm.ratio, vbass_parm.parm.boost, vbass_parm.parm.fc);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
|
||
int mic_voice_changer_parm_ananlyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
#if defined(TCFG_MIC_VOICE_CHANGER_ENABLE) && TCFG_MIC_VOICE_CHANGER_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
VoiceChangerParam_TOOL_SET *changer_parm = &eff_mode[mode_id - mic_mode_seq0].voicechanger_parm;
|
||
memcpy(changer_parm, &packet->data[1], sizeof(eff_mode[mode_id - mic_mode_seq0].voicechanger_parm));
|
||
audio_voice_changer_update_demo(AEID_MIC_VOICE_CHANGER, &changer_parm->parm, changer_parm->is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("effect_v %d, shiftv %d, formant_shift %d, is_bypass %d\n", changer_parm->parm.effect_v, changer_parm->parm.shiftv, changer_parm->parm.formant_shift, changer_parm->is_bypass);
|
||
#endif
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int mic_gain_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if GAIN_PROCESS_EN
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
Gain_Process_TOOL_SET *gain_parm = &eff_mode[mode_id - mic_mode_seq0].gain_parm; //增益
|
||
memcpy(gain_parm, &packet->data[1], sizeof(eff_mode[mode_id - mic_mode_seq0].gain_parm));
|
||
audio_gain_update_parm(AEID_MIC_GAIN, &gain_parm->parm, eff_mode[mode_id - mic_mode_seq0].gain_parm.is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("gain_parm.is_bypass %d, gain 0x%x", gain_parm->is_bypass, *(int *)&gain_parm->parm.gain);
|
||
#endif
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int gain_process_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if GAIN_PROCESS_EN
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&gain_parm, &packet->data[1], sizeof(gain_parm));
|
||
audio_gain_update_parm(AEID_MUSIC_GAIN, &gain_parm.parm, gain_parm.is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("gain_parm.is_bypass %d, gain 0x%x", gain_parm.is_bypass, *(int *)&gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
int linein_gain_process_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if GAIN_PROCESS_EN
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&linein_gain_parm, &packet->data[1], sizeof(linein_gain_parm));
|
||
audio_gain_update_parm(AEID_LINEIN_GAIN, &linein_gain_parm.parm, linein_gain_parm.is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("linein_gain_parm.is_bypass %d, gain 0x%x", linein_gain_parm.is_bypass, *(int *)&linein_gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int rl_gain_process_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if GAIN_PROCESS_EN
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&rl_gain_parm, &packet->data[1], sizeof(rl_gain_parm));
|
||
audio_gain_update_parm(AEID_MUSIC_RL_GAIN, &rl_gain_parm.parm, rl_gain_parm.is_bypass);
|
||
#if PARM_DEBUG
|
||
log_debug("rl_gain_parm.is_bypass %d, gain 0x%x", rl_gain_parm.is_bypass, *(int *)&rl_gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
void dynamic_eq_printf(DynamicEQParam_TOOL_SET *dy_parm)
|
||
{
|
||
#if PARM_DEBUG
|
||
log_debug("dy_parm->is_bypass %d\n", dy_parm->is_bypass);
|
||
for (int i = 0; i < dy_parm->nSection; i++) {
|
||
log_debug("fc %d , Q 0x%x, gain:0x%x, type %d, attacktime %d, releaseTime %d, rmsTime %d, threshold 0x%x, ratio 0x%x, noisegate_threshold 0x%x, fixGain %x, algorithm %d\n",
|
||
dy_parm->effect_param[i].fc,
|
||
*(int *)&dy_parm->effect_param[i].Q,
|
||
*(int *)&dy_parm->effect_param[i].gain,
|
||
dy_parm->effect_param[i].type,
|
||
dy_parm->effect_param[i].attackTime,
|
||
dy_parm->effect_param[i].releaseTime,
|
||
dy_parm->effect_param[i].rmsTime,
|
||
*(int *)&dy_parm->effect_param[i].threshold,
|
||
*(int *)&dy_parm->effect_param[i].ratio,
|
||
*(int *)&dy_parm->effect_param[i].noisegate_threshold,
|
||
*(int *)&dy_parm->effect_param[i].fixGain,
|
||
dy_parm->effect_param[i].algorithm);
|
||
}
|
||
|
||
log_debug("nSection %d, detect_mode %d\n", dy_parm->nSection, dy_parm->detect_mode);
|
||
#endif
|
||
}
|
||
|
||
|
||
int dynamic_eq_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if TCFG_DYNAMIC_EQ_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&dynamic_eq, &packet->data[1], sizeof(dynamic_eq));
|
||
|
||
DynamicEQParam_TOOL_SET *dy_parm = &dynamic_eq;//&packet->data[1];
|
||
DynamicEQEffectParam *parm1 = dy_parm->effect_param;
|
||
|
||
DynamicEQParam parm2 = {0};
|
||
parm2.nSection = dy_parm->nSection;
|
||
parm2.detect_mode = dy_parm->detect_mode;
|
||
|
||
DynamicEQDetectionParam detectParm[2] = {0};
|
||
detectParm[0].fc = dy_parm->effect_param[0].fc;
|
||
detectParm[1].fc = dy_parm->effect_param[1].fc;
|
||
|
||
dynamic_eq_printf(&dynamic_eq);
|
||
audio_dynamic_eq_detection_update_parm(detectParm, dy_parm->is_bypass);//动态eq检测更新
|
||
|
||
audio_dynamic_eq_update_parm((void *)parm1, (void *)&parm2, dy_parm->is_bypass);//动态eq更新
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int phone_eq_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
u32 eq_name = get_module_name(packet->cmd);//查询到相应模块
|
||
float global_gain = 0;
|
||
u8 mode_id = packet->data[0];
|
||
log_debug("mode_id %d\n", mode_id);
|
||
struct eq_seg_info *seg = (struct eq_seg_info *)&packet->data[1];
|
||
|
||
if (seg->index == (u16) - 1) {
|
||
memcpy(&global_gain, &seg->iir_type, sizeof(float));
|
||
cur_eq_set_global_gain(eq_name, global_gain);
|
||
log_info("global_gain 0x%x\n", *(int *)&global_gain);
|
||
}
|
||
|
||
void *tar_seg = NULL;
|
||
u8 tar = packet->cmd - EFF_PHONE_WIDEBAND_EQ;
|
||
log_debug("phone_mode tar %d\n", tar);
|
||
if (seg->index == (u16) - 1) {
|
||
phone_mode[tar].eq_parm.global_gain = global_gain;
|
||
} else {
|
||
tar_seg = &phone_mode[tar].eq_parm.seg[seg->index];
|
||
}
|
||
if (seg->index != (u16) - 1) {
|
||
#if PARM_DEBUG
|
||
log_info("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
#endif
|
||
memcpy(tar_seg, seg, sizeof(struct eq_seg_info));
|
||
cur_eq_set_update(eq_name, tar_seg, get_eq_nsection(eq_name), 0);
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
int low_pass_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(SOUND_TRACK_2_P_X_CH_CONFIG) &&SOUND_TRACK_2_P_X_CH_CONFIG
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&low_pass_parm, &packet->data[1], sizeof(LowPassParam_TOOL_SET));
|
||
cur_eq_set_update(AEID_MUSIC_RL_EQ, NULL, 1, 0);
|
||
#if PARM_DEBUG
|
||
log_info("low_pass_parm.is_bypass %d\n", low_pass_parm.is_bypass);
|
||
struct advance_iir *low_p = &low_pass_parm.low_pass;
|
||
log_info("low_p->fc %d, low_p->order %d, low_p->type %d\n", low_p->fc, low_p->order, low_p->type);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
int mic_eq_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u32 eq_name = get_module_name(packet->cmd);//查询到相应模块
|
||
float global_gain = 0;
|
||
u8 mode_id = packet->data[0];
|
||
log_debug("mode_id %d\n", mode_id);
|
||
struct eq_seg_info *seg = (struct eq_seg_info *)&packet->data[1];
|
||
|
||
if (seg->index == (u16) - 1) {
|
||
memcpy(&global_gain, &seg->iir_type, sizeof(float));
|
||
cur_eq_set_global_gain(eq_name, global_gain);
|
||
log_info("global_gain 0x%x\n", *(int *)&global_gain);
|
||
}
|
||
|
||
void *tar_seg = NULL;
|
||
u8 tar = packet->cmd - EFF_MIC_EQ0;
|
||
log_debug("eff_mode tar %d\n", tar);
|
||
if (seg->index == (u16) - 1) {
|
||
eff_mode[mode_id - mic_mode_seq0].eq_parm[tar].global_gain = global_gain;
|
||
} else {
|
||
tar_seg = &eff_mode[mode_id - mic_mode_seq0].eq_parm[tar].seg[seg->index];
|
||
}
|
||
if (seg->index != (u16) - 1) {
|
||
#if PARM_DEBUG
|
||
log_info("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
#endif
|
||
memcpy(tar_seg, seg, sizeof(struct eq_seg_info));
|
||
cur_eq_set_update(eq_name, tar_seg, get_eq_nsection(eq_name), 1);
|
||
}
|
||
#endif
|
||
|
||
return 0;
|
||
}
|
||
|
||
int music_eq_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
u32 eq_name = get_module_name(packet->cmd);//查询到相应模块
|
||
float global_gain = 0;
|
||
u8 mode_id = packet->data[0];
|
||
log_debug("mode_id %d\n", mode_id);
|
||
struct eq_seg_info *seg = (struct eq_seg_info *)&packet->data[1];
|
||
|
||
if (seg->index == (u16) - 1) {
|
||
memcpy(&global_gain, &seg->iir_type, sizeof(float));
|
||
cur_eq_set_global_gain(eq_name, global_gain);
|
||
log_info("global_gain 0x%x\n", *(int *)&global_gain);
|
||
}
|
||
|
||
void *tar_seg = NULL;
|
||
if (packet->cmd == EFF_MUSIC_EQ) {
|
||
if (seg->index == (u16) - 1) {
|
||
music_mode.eq_parm.global_gain = global_gain;
|
||
} else {
|
||
tar_seg = &music_mode.eq_parm.seg[seg->index];
|
||
}
|
||
} else if (packet->cmd == EFF_MUSIC_EQ2) {
|
||
#if TCFG_DYNAMIC_EQ_ENABLE
|
||
if (seg->index == (u16) - 1) {
|
||
music_eq2_parm.global_gain = global_gain;
|
||
} else {
|
||
tar_seg = &music_eq2_parm.seg[seg->index];
|
||
}
|
||
#endif
|
||
} else if (packet->cmd == EFF_MUSIC_HIGH_BASS_EQ) {
|
||
if (seg->index == (u16) - 1) {
|
||
high_bass_eq_parm.global_gain = global_gain;
|
||
} else {
|
||
tar_seg = &high_bass_eq_parm.seg[seg->index];
|
||
}
|
||
}
|
||
if (seg->index != (u16) - 1) {
|
||
#if PARM_DEBUG
|
||
log_info("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
#endif
|
||
memcpy(tar_seg, seg, sizeof(struct eq_seg_info));
|
||
cur_eq_set_update(eq_name, tar_seg, get_eq_nsection(eq_name), 0);
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
int linein_eq_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
u32 eq_name = get_module_name(packet->cmd);//查询到相应模块
|
||
float global_gain = 0;
|
||
u8 mode_id = packet->data[0];
|
||
log_debug("mode_id %d\n", mode_id);
|
||
struct eq_seg_info *seg = (struct eq_seg_info *)&packet->data[1];
|
||
|
||
if (seg->index == (u16) - 1) {
|
||
memcpy(&global_gain, &seg->iir_type, sizeof(float));
|
||
cur_eq_set_global_gain(eq_name, global_gain);
|
||
log_info("global_gain 0x%x\n", *(int *)&global_gain);
|
||
}
|
||
|
||
void *tar_seg = NULL;
|
||
if (packet->cmd == EFF_LINEIN_EQ) {
|
||
if (seg->index == (u16) - 1) {
|
||
linein_mode.eq_parm.global_gain = global_gain;
|
||
} else {
|
||
tar_seg = &linein_mode.eq_parm.seg[seg->index];
|
||
}
|
||
}
|
||
if (seg->index != (u16) - 1) {
|
||
#if PARM_DEBUG
|
||
log_info("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
#endif
|
||
memcpy(tar_seg, seg, sizeof(struct eq_seg_info));
|
||
cur_eq_set_update(eq_name, tar_seg, get_eq_nsection(eq_name), 0);
|
||
}
|
||
#endif
|
||
|
||
return 0;
|
||
}
|
||
int linein_wdrc_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
u16 type = 0; //0:low 1:mid 2:high ,3:other band, 4:crossover
|
||
u32 drc_name = get_module_name_and_index(packet->cmd, &type);
|
||
wdrc_struct_TOOL_SET *wdrc_parm = (wdrc_struct_TOOL_SET *)&packet->data[1];
|
||
void *tar_wdrc = NULL;
|
||
|
||
log_debug("wdrc_parm type %d\n", type);
|
||
struct mode_list *list = get_group_list(drc_name);
|
||
if ((list->group_num > 1) && (type == (list->group_num - 1))) { ////最后一个存分频器系数
|
||
CrossOverParam_TOOL_SET *parm = (CrossOverParam_TOOL_SET *)&packet->data[1];
|
||
tar_wdrc = &linein_mode.drc_parm.crossover;
|
||
memcpy(tar_wdrc, parm, sizeof(CrossOverParam_TOOL_SET));
|
||
cur_crossover_set_update(drc_name, tar_wdrc);
|
||
log_debug("way_num %d, N %d, low_freq %d, high_freq %d\n", parm->way_num, parm->N, parm->low_freq, parm->high_freq);
|
||
return 0;
|
||
} else {
|
||
tar_wdrc = &linein_mode.drc_parm.wdrc_parm[type];
|
||
}
|
||
|
||
memcpy(tar_wdrc, wdrc_parm, sizeof(wdrc_struct_TOOL_SET));
|
||
|
||
wdrc_printf(tar_wdrc);
|
||
cur_drc_set_update(drc_name, type, tar_wdrc);
|
||
cur_drc_set_bypass(drc_name, type, wdrc_parm->is_bypass);
|
||
#endif
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
int mic_wdrc_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u16 type = 0; //0:low 1:mid 2:high ,3:other band, 4:crossover
|
||
u32 drc_name = get_module_name_and_index(packet->cmd, &type);
|
||
type = 0;//混响没有多带drc
|
||
wdrc_struct_TOOL_SET *wdrc_parm = (wdrc_struct_TOOL_SET *)&packet->data[1];
|
||
void *tar_wdrc = NULL;
|
||
|
||
log_debug("wdrc_parm type %d\n", type);
|
||
u8 mode_id = packet->data[0];
|
||
u8 tar = packet->cmd - EFF_MIC_DRC0;
|
||
tar_wdrc = &eff_mode[mode_id - mic_mode_seq0].drc_parm[tar];
|
||
memcpy(tar_wdrc, wdrc_parm, sizeof(wdrc_struct_TOOL_SET));
|
||
|
||
wdrc_printf(tar_wdrc);
|
||
cur_drc_set_update(drc_name, type, tar_wdrc);
|
||
cur_drc_set_bypass(drc_name, type, wdrc_parm->is_bypass);
|
||
#endif
|
||
|
||
return 0;
|
||
}
|
||
int high_bass_wdrc_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
u16 type = 0; //0:low 1:mid 2:high ,3:other band, 4:crossover
|
||
u32 drc_name = get_module_name_and_index(packet->cmd, &type);
|
||
type = 0;//混响没有多带drc
|
||
wdrc_struct_TOOL_SET *wdrc_parm = (wdrc_struct_TOOL_SET *)&packet->data[1];
|
||
void *tar_wdrc = NULL;
|
||
|
||
log_debug("wdrc_parm type %d\n", type);
|
||
u8 mode_id = packet->data[0];
|
||
u8 tar = packet->cmd - EFF_MIC_DRC0;
|
||
tar_wdrc = &eff_mode[mode_id - mic_mode_seq0].drc_parm[tar];
|
||
memcpy(tar_wdrc, wdrc_parm, sizeof(wdrc_struct_TOOL_SET));
|
||
|
||
wdrc_printf(tar_wdrc);
|
||
cur_drc_set_update(drc_name, type, tar_wdrc);
|
||
cur_drc_set_bypass(drc_name, type, wdrc_parm->is_bypass);
|
||
|
||
return 0;
|
||
}
|
||
|
||
int music_wdrc_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
u16 type = 0; //0:low 1:mid 2:high ,3:other band, 4:crossover
|
||
u32 drc_name = get_module_name_and_index(packet->cmd, &type);
|
||
wdrc_struct_TOOL_SET *wdrc_parm = (wdrc_struct_TOOL_SET *)&packet->data[1];
|
||
void *tar_wdrc = NULL;
|
||
|
||
log_debug("wdrc_parm type %d\n", type);
|
||
struct mode_list *list = get_group_list(drc_name);
|
||
if (type == (list->group_num - 1)) { ////最后一个存分频器系数
|
||
CrossOverParam_TOOL_SET *parm = (CrossOverParam_TOOL_SET *)&packet->data[1];
|
||
tar_wdrc = &music_mode.drc_parm.crossover;
|
||
memcpy(tar_wdrc, parm, sizeof(CrossOverParam_TOOL_SET));
|
||
cur_crossover_set_update(drc_name, tar_wdrc);
|
||
log_debug("way_num %d, N %d, low_freq %d, high_freq %d\n", parm->way_num, parm->N, parm->low_freq, parm->high_freq);
|
||
return 0;
|
||
} else {
|
||
tar_wdrc = &music_mode.drc_parm.wdrc_parm[type];
|
||
}
|
||
|
||
memcpy(tar_wdrc, wdrc_parm, sizeof(wdrc_struct_TOOL_SET));
|
||
|
||
wdrc_printf(tar_wdrc);
|
||
cur_drc_set_update(drc_name, type, tar_wdrc);
|
||
cur_drc_set_bypass(drc_name, type, wdrc_parm->is_bypass);
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
int music_rl_wdrc_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if (TCFG_AUDIO_DAC_CONNECT_MODE == DAC_OUTPUT_FRONT_LR_REAR_LR)
|
||
u16 type = 0; //0:low 1:mid 2:high ,3:other band, 4:crossover
|
||
u32 drc_name = get_module_name_and_index(packet->cmd, &type);
|
||
wdrc_struct_TOOL_SET *wdrc_parm = (wdrc_struct_TOOL_SET *)&packet->data[1];
|
||
void *tar_wdrc = NULL;
|
||
|
||
log_debug("wdrc_parm type %d\n", type);
|
||
struct mode_list *list = get_group_list(drc_name);
|
||
if (type == (list->group_num - 1)) { ////最后一个存分频器系数
|
||
CrossOverParam_TOOL_SET *parm = (CrossOverParam_TOOL_SET *)&packet->data[1];
|
||
tar_wdrc = &rl_drc_parm.crossover;
|
||
memcpy(tar_wdrc, parm, sizeof(CrossOverParam_TOOL_SET));
|
||
cur_crossover_set_update(drc_name, tar_wdrc);
|
||
log_debug("way_num %d, N %d, low_freq %d, high_freq %d\n", parm->way_num, parm->N, parm->low_freq, parm->high_freq);
|
||
return 0;
|
||
} else {
|
||
tar_wdrc = &rl_drc_parm.wdrc_parm[type];
|
||
}
|
||
|
||
memcpy(tar_wdrc, wdrc_parm, sizeof(wdrc_struct_TOOL_SET));
|
||
|
||
wdrc_printf(tar_wdrc);
|
||
cur_drc_set_update(drc_name, type, tar_wdrc);
|
||
cur_drc_set_bypass(drc_name, type, wdrc_parm->is_bypass);
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
|
||
int phone_wdrc_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
u16 type = 0; //0:low 1:mid 2:high ,3:other band, 4:crossover
|
||
u32 drc_name = get_module_name_and_index(packet->cmd, &type);
|
||
wdrc_struct_TOOL_SET *wdrc_parm = (wdrc_struct_TOOL_SET *)&packet->data[1];
|
||
type = 0;//通话下行使用type位置做更新
|
||
void *tar_wdrc = NULL;
|
||
log_debug("wdrc_parm type %d\n", type);
|
||
u8 tar = packet->cmd - EFF_PHONE_WIDEBAND_DRC;
|
||
tar_wdrc = &phone_mode[tar].drc_parm;
|
||
memcpy(tar_wdrc, wdrc_parm, sizeof(wdrc_struct_TOOL_SET));
|
||
wdrc_printf(tar_wdrc);
|
||
cur_drc_set_update(drc_name, type, tar_wdrc);
|
||
cur_drc_set_bypass(drc_name, type, wdrc_parm->is_bypass);
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
int noise_gate_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&eff_mode[mode_id - mic_mode_seq0].noise_gate_parm, &packet->data[1], sizeof(NoiseGateParam_TOOL_SET));
|
||
NoiseGateParam_TOOL_SET *parmt = &eff_mode[mode_id - mic_mode_seq0].noise_gate_parm;
|
||
noisegate_update_parm(&parmt->parm, parmt->is_bypass);
|
||
|
||
#if PARM_DEBUG
|
||
noisegate_update_param *parm = &parmt->parm;
|
||
log_debug("noise gate attact_time %d,releasetime %d, threshold %d, low_th_gain %d\n",
|
||
parm->attackTime, parm->releaseTime, parm->threshold, parm->low_th_gain);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int howling_pitch_shift_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&eff_mode[mode_id - mic_mode_seq0].howlingps_parm, &packet->data[1], sizeof(HowlingPs_PARM_TOOL_SET));
|
||
HowlingPs_PARM_TOOL_SET *parmt = &eff_mode[mode_id - mic_mode_seq0].howlingps_parm;
|
||
howling_pitch_shift_update_parm(&parmt->parm, parmt->is_bypass);
|
||
#if PARM_DEBUG
|
||
HOWLING_PITCHSHIFT_PARM *parm = &parmt->parm;
|
||
log_debug("ps_parm %d, fe_parm %d, effect_v %d\n", parm->ps_parm, parm->fe_parm, parm->effect_v);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int notchhowline_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&eff_mode[mode_id - mic_mode_seq0].notchhowling_parm, &packet->data[1], sizeof(NotchHowlingParam_TOOL_SET));
|
||
NotchHowlingParam_TOOL_SET *parmt = &eff_mode[mode_id - mic_mode_seq0].notchhowling_parm;
|
||
notchhowline_update_parm(&parmt->parm, parmt->is_bypass);
|
||
|
||
#if PARM_DEBUG
|
||
NotchHowlingParam *parm = &parmt->parm;
|
||
log_debug("parmt->is_bypass %d\n", parmt->is_bypass);
|
||
log_debug("Q 0x%x, gain 0x%x, fade_n %d\n", *(int *)&parm->Q, *(int *)&parm->gain, parm->fade_n);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
|
||
int reverb_parm_analyze(EFF_ONLINE_PACKET *packet)
|
||
{
|
||
#if 0
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&eff_mode[mode_id - mic_mode_seq0].reverb_parm, &packet->data[1], sizeof(REVERBN_PARM_TOOL_SET));
|
||
REVERBN_PARM_TOOL_SET *parmt = &eff_mode[mode_id - mic_mode_seq0].reverb_parm;
|
||
reverb_update_parm(&parmt->parm);
|
||
REVERBN_PARM_SET *parm = &parmt->parm;
|
||
log_debug("dry %d,\n wet %d,\n delay %d,\n rot60 %d,\n Erwet %d,\nErfactor %d,\n Ewidth %d,\n Ertolate %d,\nErbasslpf %d,\nErbassB %d,\n predelay %d,\nallpassfeedback %d,\ndiffusion %d,\n dampinglpf %d,\n basslpf %d,\n bassB %d,\n lowcut %d\n",
|
||
parm->dry,
|
||
parm->wet,
|
||
parm->delay,
|
||
parm->rot60,
|
||
parm->Erwet,
|
||
parm->Erfactor,
|
||
parm->Ewidth,
|
||
parm->Ertolate,
|
||
parm->Erbasslpf,
|
||
parm->ErbassB,
|
||
parm->predelay,
|
||
parm->allpassfeedback,
|
||
parm->diffusion,
|
||
parm->dampinglpf,
|
||
parm->basslpf,
|
||
parm->bassB,
|
||
parm->lowcut
|
||
);
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
int plate_reverb_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&eff_mode[mode_id - mic_mode_seq0].plate_reverb_parm, &packet->data[1], sizeof(Plate_reverb_TOOL_SET));
|
||
Plate_reverb_TOOL_SET *parmt = &eff_mode[mode_id - mic_mode_seq0].plate_reverb_parm;
|
||
plate_reverb_update_parm(&parmt->parm, parmt->is_bypass);
|
||
|
||
#if PARM_DEBUG
|
||
Plate_reverb_parm *parm = &parmt->parm;
|
||
log_debug("wet %d\n dry %d\n pre_delay %d\n highcutoff %d\n diffusion %d\n decayfactor %d\n highfrequencydamping %d\n modulate %d\n roomsize %d\n", parm->wet, parm->dry, parm->pre_delay, parm->highcutoff, parm->diffusion, parm->decayfactor, parm->highfrequencydamping, parm->modulate, parm->roomsize);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
|
||
int echo_parm_analyze(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 mode_id = packet->data[0];
|
||
memcpy(&eff_mode[mode_id - mic_mode_seq0].echo_parm, &packet->data[1], sizeof(EF_ECHO_TOOL_SET));
|
||
EF_ECHO_TOOL_SET *parmt = &eff_mode[mode_id - mic_mode_seq0].echo_parm;
|
||
echo_updata_parm(&parmt->parm, parmt->is_bypass);
|
||
#if PARM_DEBUG
|
||
ECHO_PARM_SET *parm = &parmt->parm;
|
||
log_debug("delay %d, decayval %d, filt_enable %d, lpf_cutoff %d, wetgain %d, drygain %d\n",
|
||
parm->delay, parm->decayval, parm->filt_enable, parm->lpf_cutoff, parm->wetgain, parm->drygain);
|
||
#endif
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
|
||
|
||
void eff_send_packet(void *priv, u32 id, u8 *packet, int size, u8 sq)
|
||
{
|
||
all_assemble_package_send_to_pc(id, sq, packet, size);
|
||
}
|
||
|
||
void alive_timer_send_packet(void *p)
|
||
{
|
||
u32 T = 2;
|
||
u8 sq = 0;
|
||
eff_send_packet(NULL, T, (u8 *)"empty", 5, sq);
|
||
}
|
||
|
||
|
||
int eff_tool_get_cfg_file_size(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
struct file_s {
|
||
int id;
|
||
int fileid;
|
||
};
|
||
struct file_s fs;
|
||
memcpy(&fs, packet, sizeof(struct file_s));
|
||
u32 file_size = 0;
|
||
if (fs.fileid == EFF_CFG_FILE_ID) {
|
||
FILE *file = NULL;
|
||
file = fopen(EFF_CFG_FILE_NAME, "r");
|
||
if (!file) {
|
||
log_error("EFF_CFG_FILE_NAME err %s\n", EFF_CFG_FILE_NAME);
|
||
} else {
|
||
file_size = flen(file);
|
||
fclose(file);
|
||
}
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)&file_size, sizeof(u32), sq);
|
||
}
|
||
return 1;
|
||
}
|
||
int eff_tool_get_cfg_file_data(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
struct file_s {
|
||
int id;
|
||
int fileid;
|
||
int offset;
|
||
int size;
|
||
};
|
||
struct file_s fs;
|
||
memcpy(&fs, packet, sizeof(struct file_s));
|
||
if (fs.fileid == (int)EFF_CFG_FILE_ID) {
|
||
FILE *file = NULL;
|
||
file = fopen(EFF_CFG_FILE_NAME, "r");
|
||
if (!file) {
|
||
return -EINVAL;
|
||
}
|
||
|
||
fseek(file, fs.offset, SEEK_SET);
|
||
u8 *data = malloc(fs.size);
|
||
if (!data) {
|
||
fclose(file);
|
||
return -EINVAL;
|
||
}
|
||
int ret = fread(file, data, fs.size);
|
||
if (ret != fs.size) {
|
||
}
|
||
fclose(file);
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)data, fs.size, sq);
|
||
free(data);
|
||
}
|
||
return 1;
|
||
}
|
||
|
||
|
||
static s32 eff_online_update(void *_packet)
|
||
{
|
||
u8 *ptr = _packet;
|
||
u8 id = ptr[0];
|
||
u8 sq = ptr[1];
|
||
int res = -1;
|
||
EFF_ONLINE_PACKET *packet = (EFF_ONLINE_PACKET *)&ptr[2];
|
||
struct cmd_interface *p = NULL;
|
||
#if PARM_DEBUG
|
||
if (packet->cmd != 0x4) {//离线查询
|
||
log_debug(" id 0x%x, sq %d\n", id, sq);
|
||
log_debug("_cmd:0x%x mode_id %d\n", packet->cmd, packet->data[0]);
|
||
}
|
||
#endif
|
||
if (!alive_timer) {
|
||
alive_timer = sys_timer_add(NULL, alive_timer_send_packet, 900);//定时往上位机推送，可能对工具离线的消息有帮助
|
||
}
|
||
list_for_each_cmd_interface(p) {
|
||
if (p->cmd == packet->cmd) {
|
||
if (p->cmd_deal) {
|
||
res = p->cmd_deal(packet, REPLY_TO_TOOL, sq);
|
||
}
|
||
}
|
||
}
|
||
return res;
|
||
}
|
||
|
||
int eff_tool_get_version(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
struct _ver_info {
|
||
char sdkname[16];
|
||
u8 eqver[4];
|
||
};
|
||
struct _ver_info _ver_info = {0};
|
||
memcpy(_ver_info.sdkname, eff_sdk_name, sizeof(eff_sdk_name));
|
||
memcpy(_ver_info.eqver, eff_eq_ver, sizeof(eff_eq_ver));
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)&_ver_info, sizeof(struct _ver_info), sq);
|
||
return 1;
|
||
}
|
||
int eff_tool_set_channge_mode(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
struct cmd {
|
||
int id;
|
||
int modeId;
|
||
};
|
||
struct cmd cmd;
|
||
memcpy(&cmd, packet, sizeof(struct cmd));
|
||
log_debug("cmd.modeId %d\n", cmd.modeId);
|
||
if ((cmd.modeId >= mic_mode_seq0) && (cmd.modeId <= mic_mode_seq7)) { //混响0~7
|
||
set_mic_reverb_mode_by_id(cmd.modeId - mic_mode_seq0);
|
||
}
|
||
#endif
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)"OK", 2, sq);
|
||
return 1;
|
||
}
|
||
//在线检测应答
|
||
int eff_tool_set_inquire(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
//eff_send_packet(NULL, id, (u8 *)"OK", 2, sq);//OK表示需要重传，NO表示不需要重传,ER还是表示未知命令
|
||
eff_send_packet(NULL, id, (u8 *)"NO", 2, sq);//OK表示需要重传，NO表示不需要重传,ER还是表示未知命令
|
||
return 1;
|
||
}
|
||
|
||
int eff_tool_resync_parm_begin(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
eff_mode_save = get_mic_eff_mode();
|
||
#endif
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)"OK", 2, sq);
|
||
return 1;
|
||
}
|
||
|
||
int eff_tool_resync_parm_end(EFF_ONLINE_PACKET *packet, u8 id, u8 sq)
|
||
{
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
u8 eff_mode = eff_mode_save;
|
||
set_mic_reverb_mode_by_id(eff_mode);//还原混响的模式
|
||
#endif
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)"OK", 2, sq);
|
||
return 1;
|
||
}
|
||
|
||
|
||
static void effect_tool_callback(u8 *_packet, u32 size)
|
||
{
|
||
int res = 0;
|
||
u8 *ptr = _packet;
|
||
u8 id = ptr[0];
|
||
u8 sq = ptr[1];
|
||
u8 *packet = (u8 *)&ptr[2];
|
||
ASSERT(((int)packet & 0x3) == 0, "buf %x size %d\n", (unsigned int)packet, size - 2);
|
||
|
||
res = eff_online_update(ptr);
|
||
if (!res) {
|
||
log_debug("Ack");
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)"OK", 2, sq);
|
||
} else if (res != 1) {
|
||
log_debug("Nack");
|
||
eff_send_packet(NULL, REPLY_TO_TOOL, (u8 *)"ER", 2, sq);
|
||
}
|
||
}
|
||
|
||
REGISTER_DETECT_TARGET(eff_adj_target) = {
|
||
.id = 0x11,//EFF_CONFIG_ID,
|
||
.tool_message_deal = effect_tool_callback,
|
||
};
|
||
|
||
//在线调试不进power down
|
||
static u8 effect_tool_idle_query(void)
|
||
{
|
||
#if TCFG_EFFECT_TOOL_ENABLE
|
||
return 1;
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
REGISTER_LP_TARGET(effect_adj_lp_target) = {
|
||
.name = "effect_adj",
|
||
.is_idle = effect_tool_idle_query,
|
||
};
|
||
|
||
#define INDEX_HEAD 0xFFFD
|
||
int eff_file_exist()
|
||
{
|
||
FILE *file = fopen((const char *)EFF_CFG_FILE_NAME, "r");
|
||
if (file) {
|
||
fclose(file);
|
||
return 1;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
int eff_file_analyze(u32 mode_id, u16 group_id, void *data_buf, u32 buf_len)
|
||
{
|
||
#if PARM_DEBUG
|
||
log_debug("mode_id 0x%x, group_id 0x%x\n", mode_id, group_id);
|
||
#endif
|
||
int ret = 0;
|
||
u8 *crc_buf = NULL;
|
||
FILE *file = NULL;
|
||
file = fopen((const char *)EFF_CFG_FILE_NAME, "r");
|
||
if (!file) {
|
||
log_error("eff file open err\n");
|
||
return -ENOENT;
|
||
}
|
||
u8 FV = 0;
|
||
if (1 != fread(file, &FV, 1)) {
|
||
ret = -1;
|
||
|
||
goto err_exit;
|
||
}
|
||
|
||
u8 ver[4] = {0};
|
||
if (4 != fread(file, ver, 4)) {
|
||
ret = -2;
|
||
goto err_exit;
|
||
}
|
||
|
||
if (memcmp(ver, eff_eq_ver, sizeof(eff_eq_ver))) {
|
||
log_error("eff ver err \n");
|
||
log_error_hexdump((unsigned char *)ver, 4);
|
||
fseek(file, 0, SEEK_SET);
|
||
ret = -3;
|
||
goto err_exit;
|
||
}
|
||
|
||
u16 index_head = 0;//索引头
|
||
if (2 != fread(file, &index_head, 2)) {
|
||
ret = -4;
|
||
goto err_exit;
|
||
}
|
||
|
||
if (index_head != INDEX_HEAD) {
|
||
ret = -5;
|
||
goto err_exit;
|
||
}
|
||
u16 index_len = 0;//索引区域长度
|
||
if (2 != fread(file, &index_len, 2)) {
|
||
ret = -6;
|
||
goto err_exit;
|
||
}
|
||
u8 mode_num = 0;//模式个数
|
||
if (1 != fread(file, &mode_num, 1)) {
|
||
ret = -7;
|
||
goto err_exit;
|
||
}
|
||
|
||
u16 off0 = 0; //组索引区域的偏移
|
||
u16 off1 = 0; //模式索引区域的偏移
|
||
for (int mode_cnt = 0; mode_cnt < mode_num; mode_cnt++) {
|
||
u16 mode_seq = 0;//模式标识
|
||
if (2 != fread(file, &mode_seq, 2)) {
|
||
ret = -8;
|
||
goto err_exit;
|
||
}
|
||
if (2 != fread(file, &off0, 2)) {
|
||
ret = -9;
|
||
goto err_exit;
|
||
}
|
||
if (2 != fread(file, &off1, 2)) {
|
||
ret = -10;
|
||
goto err_exit;
|
||
}
|
||
if (mode_seq != mode_id) { //查询到相应的模式
|
||
continue;
|
||
} else {
|
||
break;
|
||
}
|
||
}
|
||
fseek(file, off0, SEEK_SET);//偏移到组索引区域
|
||
|
||
u8 group_num = 0;
|
||
if (1 != fread(file, &group_num, 1)) {
|
||
ret = -11;
|
||
goto err_exit;
|
||
}
|
||
u16 g_id = 0;//模块id
|
||
u16 group_id_addr = 0;//模块id的内容地址
|
||
int group_cnt = 0;
|
||
for (group_cnt = 0; group_cnt < group_num; group_cnt++) {
|
||
if (2 != fread(file, &g_id, 2)) {
|
||
ret = -12;
|
||
goto err_exit;
|
||
}
|
||
if (2 != fread(file, &group_id_addr, 2)) {
|
||
ret = -13;
|
||
goto err_exit;
|
||
}
|
||
if (g_id != group_id) {
|
||
continue;
|
||
} else {
|
||
break;
|
||
}
|
||
}
|
||
if (group_cnt == group_num) {
|
||
ret = -14;
|
||
#if PARM_DEBUG
|
||
log_error("seek group id addr err\n");
|
||
#endif
|
||
goto err_exit;
|
||
}
|
||
fseek(file, group_id_addr, SEEK_SET);//偏移到模式id的具体内容
|
||
|
||
u16 crc16 = 0;
|
||
u16 verify_group_id = 0;
|
||
u16 group_len;
|
||
if (2 != fread(file, &crc16, 2)) {
|
||
ret = -15;
|
||
goto err_exit;
|
||
}
|
||
int cur_addr = fpos(file);
|
||
if (2 != fread(file, &verify_group_id, 2)) {
|
||
ret = -16;
|
||
goto err_exit;
|
||
}
|
||
if (2 != fread(file, &group_len, 2)) {
|
||
ret = -17;
|
||
goto err_exit;
|
||
}
|
||
if (!group_len) {
|
||
ret = -18;
|
||
goto err_exit;
|
||
}
|
||
if (verify_group_id != group_id) {
|
||
ret = -19;
|
||
log_error("verify_group_id %x != group_id %x\n", verify_group_id, group_id);
|
||
log_error("verify groud id err\n");
|
||
goto err_exit;
|
||
}
|
||
|
||
fseek(file, cur_addr, SEEK_SET);
|
||
u16 size = sizeof(crc16) + sizeof(group_len);
|
||
crc_buf = zalloc(group_len + size);
|
||
u8 *group_buf = &crc_buf[size];
|
||
if ((group_len + size) != fread(file, crc_buf, group_len + size)) {
|
||
ret = -20;
|
||
goto err_exit;
|
||
}
|
||
u16 calc_crc = CRC16(crc_buf, group_len + size); //id + len +playload
|
||
if (crc16 != calc_crc) {
|
||
ret = -21;
|
||
log_error("crc16 %x, calc_crc %x\n", crc16, calc_crc);
|
||
goto err_exit;
|
||
}
|
||
if (!data_buf) {
|
||
ret = -22;
|
||
#if PARM_DEBUG
|
||
log_error("input data buf NULL\n");
|
||
#endif
|
||
goto err_exit;
|
||
}
|
||
if (group_len <= buf_len) {
|
||
memcpy(data_buf, group_buf, group_len);
|
||
} else {
|
||
ret = -23;
|
||
log_error("input data buf len : %d < group_len:%d\n", buf_len, group_len);
|
||
goto err_exit;
|
||
}
|
||
|
||
err_exit:
|
||
if (crc_buf) {
|
||
free(crc_buf);
|
||
crc_buf = NULL;
|
||
}
|
||
fclose(file);
|
||
|
||
#if PARM_DEBUG
|
||
if (ret) {
|
||
log_error("ret :%d, analyze eff file err, please check it\n", ret);
|
||
}
|
||
#endif
|
||
return 0;
|
||
}
|
||
|
||
void phone_eff_analyze_data(void)
|
||
{
|
||
u16 phone_eq_name[] = {AEID_ESCO_DL_EQ};
|
||
u16 aec_eq_name[] = {AEID_ESCO_UL_EQ};
|
||
u8 index = 0;
|
||
void *tar_buf = NULL;
|
||
u16 tar_len = 0;
|
||
u16 group_id = 0;
|
||
u16 mode_seq = 0;
|
||
|
||
mode_seq = phone_mode_seq;
|
||
for (int i = 0; i < ARRAY_SIZE(phone_eq_name); i++) {
|
||
struct mode_list *list = get_group_list(phone_eq_name[i]);
|
||
for (int j = 0; j < list->group_num; j++) {
|
||
group_id = get_group_id(phone_eq_name[i], j);
|
||
index = group_id - EFF_PHONE_WIDEBAND_EQ;
|
||
tar_buf = &phone_mode[index].eq_parm;
|
||
tar_len = sizeof(phone_mode[index].eq_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
}
|
||
}
|
||
mode_seq = aec_mode_seq;
|
||
for (int i = 0; i < ARRAY_SIZE(aec_eq_name); i++) {
|
||
struct mode_list *list = get_group_list(aec_eq_name[i]);
|
||
for (int j = 0; j < list->group_num; j++) {
|
||
group_id = get_group_id(aec_eq_name[i], j);
|
||
index = group_id - EFF_PHONE_WIDEBAND_EQ;
|
||
tar_buf = &phone_mode[index].eq_parm;
|
||
tar_len = sizeof(phone_mode[index].eq_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
}
|
||
}
|
||
|
||
u16 phone_drc_name[] = {AEID_ESCO_DL_DRC};
|
||
u16 aec_drc_name[] = {AEID_ESCO_UL_DRC};
|
||
mode_seq = phone_mode_seq;
|
||
for (int i = 0; i < ARRAY_SIZE(phone_drc_name); i++) {
|
||
struct mode_list *list = get_group_list(phone_drc_name[i]);
|
||
for (int j = 0; j < list->group_num; j++) {
|
||
group_id = get_group_id(phone_drc_name[i], j);
|
||
index = group_id - EFF_PHONE_WIDEBAND_DRC;
|
||
tar_buf = &phone_mode[index].drc_parm;
|
||
tar_len = sizeof(phone_mode[index].drc_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
wdrc_printf(tar_buf);
|
||
}
|
||
}
|
||
|
||
mode_seq = aec_mode_seq;
|
||
for (int i = 0; i < ARRAY_SIZE(aec_drc_name); i++) {
|
||
struct mode_list *list = get_group_list(aec_drc_name[i]);
|
||
for (int j = 0; j < list->group_num; j++) {
|
||
group_id = get_group_id(aec_drc_name[i], j);
|
||
index = group_id - EFF_PHONE_WIDEBAND_DRC;
|
||
tar_buf = &phone_mode[index].drc_parm;
|
||
tar_len = sizeof(phone_mode[index].drc_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
wdrc_printf(tar_buf);
|
||
}
|
||
}
|
||
}
|
||
|
||
void music_eq_printf(void *_parm)
|
||
{
|
||
#if PARM_DEBUG
|
||
puts("----------------------- music eq ----------------------\n");
|
||
struct music_eq_tool *parm = _parm;
|
||
log_debug("global_gain:0x%x\n", *(int *)&parm->global_gain);
|
||
log_debug("seg_num:%d\n", parm->seg_num);
|
||
struct eq_seg_info *seg;
|
||
for (int i = 0; i < parm->seg_num; i++) {
|
||
seg = &parm->seg[i];
|
||
log_debug("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
}
|
||
#endif
|
||
}
|
||
void music_eq2_printf(void *_parm)
|
||
{
|
||
#if PARM_DEBUG
|
||
puts("----------------------- music eq2 ----------------------\n");
|
||
struct music_eq2_tool *parm = _parm;
|
||
log_debug("global_gain:0x%x\n", *(int *)&parm->global_gain);
|
||
log_debug("seg_num:%d\n", parm->seg_num);
|
||
struct eq_seg_info *seg;
|
||
for (int i = 0; i < parm->seg_num; i++) {
|
||
seg = &parm->seg[i];
|
||
log_debug("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
}
|
||
#endif
|
||
}
|
||
|
||
void music_eff_analyze_data(void)
|
||
{
|
||
u8 index = 0;
|
||
void *tar_buf = NULL;
|
||
u16 tar_len = 0;
|
||
u16 group_id = 0;
|
||
u16 mode_seq = music_mode_seq0;
|
||
|
||
|
||
#if AUDIO_VBASS_CONFIG
|
||
tar_buf = &vbass_prev_gain_parm;
|
||
tar_len = sizeof(vbass_prev_gain_parm);
|
||
eff_file_analyze(mode_seq, EFF_MUSIC_VBASS_PREV_GAIN, tar_buf, tar_len);
|
||
|
||
tar_buf = &vbass_parm;
|
||
tar_len = sizeof(vbass_parm);
|
||
eff_file_analyze(mode_seq, EFF_MUSIC_VBASS, tar_buf, tar_len);
|
||
#endif
|
||
|
||
#if defined(TCFG_EQ_ENABLE) && TCFG_EQ_ENABLE
|
||
//eq
|
||
group_id = get_group_id(AEID_MUSIC_EQ, 0);
|
||
tar_buf = &music_mode.eq_parm;
|
||
tar_len = sizeof(music_mode.eq_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
music_eq_printf(tar_buf);
|
||
#endif
|
||
//drc
|
||
struct mode_list *list = get_group_list(AEID_MUSIC_DRC);
|
||
if (list) {
|
||
for (int i = 0; i < list->group_num; i++) {
|
||
group_id = list->group_id[i];
|
||
if (i == (list->group_num - 1)) { //最后一个存分频器系数
|
||
tar_buf = &music_mode.drc_parm.crossover;
|
||
tar_len = sizeof(music_mode.drc_parm.crossover);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
CrossOverParam_TOOL_SET *parm = tar_buf;
|
||
log_debug("way_num %d, N %d, low_freq %d, high_freq %d\n", parm->way_num, parm->N, parm->low_freq, parm->high_freq);
|
||
#endif
|
||
} else {
|
||
tar_buf = &music_mode.drc_parm.wdrc_parm[i];
|
||
tar_len = sizeof(music_mode.drc_parm.wdrc_parm[i]);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
wdrc_printf(tar_buf);
|
||
}
|
||
}
|
||
}
|
||
|
||
#if TCFG_DYNAMIC_EQ_ENABLE
|
||
group_id = get_group_id(AEID_MUSIC_EQ2, 0);
|
||
tar_buf = &music_eq2_parm;
|
||
tar_len = sizeof(music_eq2_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
music_eq2_printf(tar_buf);
|
||
|
||
//dynamic eq
|
||
group_id = EFF_MUSIC_DYNAMIC_EQ;//get_group_id(AEID_MUSIC_EQ2, 0);
|
||
tar_buf = &dynamic_eq;
|
||
tar_len = sizeof(DynamicEQParam_TOOL_SET);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
dynamic_eq_printf(tar_buf);
|
||
#endif
|
||
|
||
#if GAIN_PROCESS_EN
|
||
//gain
|
||
group_id = EFF_MUSIC_GAIN;
|
||
tar_buf = &gain_parm;
|
||
tar_len = sizeof(gain_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
log_debug("gain_parm.is_bypass %d, gain 0x%x", gain_parm.is_bypass, *(int *)&gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
|
||
#if defined(SOUND_TRACK_2_P_X_CH_CONFIG) &&SOUND_TRACK_2_P_X_CH_CONFIG
|
||
//low pass
|
||
group_id = EFF_MUSIC_RL_RR_LOW_PASS;
|
||
tar_buf = &low_pass_parm;
|
||
tar_len = sizeof(low_pass_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
log_info("low_pass_parm.is_bypass %d\n", low_pass_parm.is_bypass);
|
||
struct advance_iir *low_p = &low_pass_parm.low_pass;
|
||
log_info("low_p->fc %d, low_p->order %d, low_p->type %d\n", low_p->fc, low_p->order, low_p->type);
|
||
#endif
|
||
#endif
|
||
|
||
#if (TCFG_AUDIO_DAC_CONNECT_MODE == DAC_OUTPUT_FRONT_LR_REAR_LR)
|
||
//rl_wdrc
|
||
u8 type = 0;
|
||
group_id = EFF_MUSIC_RL_LOW_DRC;
|
||
tar_buf = &rl_drc_parm.wdrc_parm[type];
|
||
tar_len = sizeof(rl_drc_parm.wdrc_parm[type]);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
wdrc_printf(tar_buf);
|
||
#endif
|
||
#if GAIN_PROCESS_EN
|
||
//rl_rr_gain
|
||
group_id = EFF_MUSIC_RL_GAIN;
|
||
tar_buf = &rl_gain_parm;
|
||
tar_len = sizeof(rl_gain_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
log_debug("rl_gain_parm.is_bypass %d, gain 0x%x", rl_gain_parm.is_bypass, *(int *)&rl_gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
}
|
||
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
void linein_eff_analyze_data(void)
|
||
{
|
||
u8 index = 0;
|
||
void *tar_buf = NULL;
|
||
u16 tar_len = 0;
|
||
u16 group_id = 0;
|
||
u16 mode_seq = linein_mode_seq;
|
||
//eq
|
||
group_id = get_group_id(AEID_LINEIN_EQ, 0);
|
||
tar_buf = &linein_mode.eq_parm;
|
||
tar_len = sizeof(linein_mode.eq_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
music_eq_printf(tar_buf);
|
||
//drc
|
||
struct mode_list *list = get_group_list(AEID_LINEIN_DRC);
|
||
if (list) {
|
||
for (int i = 0; i < list->group_num; i++) {
|
||
group_id = list->group_id[i];
|
||
if ((list->group_num > 1) && (i == (list->group_num - 1))) { //最后一个存分频器系数
|
||
tar_buf = &linein_mode.drc_parm.crossover;
|
||
tar_len = sizeof(linein_mode.drc_parm.crossover);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
CrossOverParam_TOOL_SET *parm = tar_buf;
|
||
log_debug("way_num %d, N %d, low_freq %d, high_freq %d\n", parm->way_num, parm->N, parm->low_freq, parm->high_freq);
|
||
#endif
|
||
} else {
|
||
tar_buf = &linein_mode.drc_parm.wdrc_parm[i];
|
||
tar_len = sizeof(linein_mode.drc_parm.wdrc_parm[i]);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
wdrc_printf(tar_buf);
|
||
}
|
||
}
|
||
}
|
||
|
||
#if GAIN_PROCESS_EN
|
||
//gain
|
||
group_id = EFF_LINEIN_GAIN;
|
||
tar_buf = &gain_parm;
|
||
tar_len = sizeof(gain_parm);
|
||
eff_file_analyze(mode_seq, group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
log_debug("gain_parm.is_bypass %d, gain 0x%x", gain_parm.is_bypass, *(int *)&gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
}
|
||
#endif
|
||
|
||
|
||
extern struct phone_parm_tool_set phone_mode[4];
|
||
extern int eff_file_analyze(u32 mode_id, u16 group_id, void *data_buf, u32 buf_len);
|
||
void wdrc_printf(void *_wdrc)
|
||
{
|
||
#if PARM_DEBUG
|
||
puts("---------------------- drc -----------------------\n");
|
||
wdrc_struct_TOOL_SET *twdrc = _wdrc;
|
||
struct wdrc_struct *wdrc = &twdrc->parm;
|
||
printf("wdrc->is_bypass %d\n", twdrc->is_bypass);
|
||
printf("wdrc attacktime %d, releasetime %d threshold_num %d rms_time %d algorithm%d, mode%d ,0x%x,0x%x\n", wdrc->attacktime, wdrc->releasetime, wdrc->threshold_num, wdrc->rms_time, wdrc->algorithm, wdrc->mode, *(int *)&wdrc->inputgain, *(int *)&wdrc->outputgain);
|
||
struct threshold_group *tt = (struct threshold_group *)wdrc->threshold;
|
||
for (int i = 0; i < wdrc->threshold_num; i++) {
|
||
printf("in_threshold 0x%x, out_threshold 0x%x\n", *(int *)&tt[i].in_threshold, *(int *)&tt[i].out_threshold);
|
||
}
|
||
#endif
|
||
}
|
||
|
||
void eq_printf(void *_parm)
|
||
{
|
||
#if PARM_DEBUG
|
||
puts("----------------------- eq ----------------------\n");
|
||
struct eq_tool *parm = _parm;
|
||
printf("global_gain:0x%x\n", *(int *)&parm->global_gain);
|
||
printf("seg_num:%d\n", parm->seg_num);
|
||
struct eq_seg_info *seg;// = parm->seg;
|
||
for (int i = 0; i < parm->seg_num; i++) {
|
||
seg = &parm->seg[i];
|
||
printf("idx:%d, iir:%d, frq:%d, gain:0x%x, q:0x%x \n", seg->index, seg->iir_type, seg->freq, *(int *)&seg->gain, *(int *)&seg->q);
|
||
}
|
||
#endif
|
||
}
|
||
|
||
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
//文件效果还原到 相应结构体
|
||
void mic_eff_analyze_data(u8 tar_mode)
|
||
{
|
||
#if PARM_DEBUG
|
||
log_debug("------------------------------ eff mode %d\n", tar_mode);
|
||
#endif
|
||
u8 index = tar_mode;
|
||
void *tar_buf = NULL;//
|
||
u16 tar_len = 0;
|
||
u16 group_id = 0;
|
||
//noisegate
|
||
tar_buf = (void *)&eff_mode[index].noise_gate_parm;
|
||
tar_len = sizeof(eff_mode[index].noise_gate_parm);
|
||
eff_file_analyze(eff_mode_seq[index], EFF_MIC_NOISEGATE, tar_buf, tar_len);
|
||
//howlingps_parm
|
||
tar_buf = (void *)&eff_mode[index].howlingps_parm;
|
||
tar_len = sizeof(eff_mode[index].howlingps_parm);
|
||
eff_file_analyze(eff_mode_seq[index], EFF_MIC_HOWLINE_PS, tar_buf, tar_len);
|
||
//notchowling_parm
|
||
tar_buf = (void *)&eff_mode[index].notchhowling_parm;
|
||
tar_len = sizeof(eff_mode[index].notchhowling_parm);
|
||
eff_file_analyze(eff_mode_seq[index], EFF_MIC_NOTCH_HOWLING, tar_buf, tar_len);
|
||
//voice_changer
|
||
#if defined(TCFG_MIC_VOICE_CHANGER_ENABLE) && TCFG_MIC_VOICE_CHANGER_ENABLE
|
||
tar_buf = (void *)&eff_mode[index].voicechanger_parm;
|
||
tar_len = sizeof(eff_mode[index].voicechanger_parm);
|
||
eff_file_analyze(eff_mode_seq[index], EFF_MIC_VOICE_CHANGER, tar_buf, tar_len);
|
||
#endif
|
||
|
||
//echo
|
||
tar_buf = (void *)&eff_mode[index].echo_parm;
|
||
tar_len = sizeof(eff_mode[index].echo_parm);
|
||
eff_file_analyze(eff_mode_seq[index], EFF_MIC_ECHO, tar_buf, tar_len);
|
||
//palte_reverb
|
||
tar_buf = (void *)&eff_mode[index].plate_reverb_parm;
|
||
tar_len = sizeof(eff_mode[index].plate_reverb_parm);
|
||
eff_file_analyze(eff_mode_seq[index], EFF_MIC_PLATE_REVERB, tar_buf, tar_len);
|
||
Plate_reverb_TOOL_SET *parm = tar_buf;
|
||
|
||
|
||
//eq
|
||
for (int i = 0; i < ARRAY_SIZE(eq_name); i++) {
|
||
group_id = get_group_id(eq_name[i], 0);
|
||
tar_buf = (void *)&eff_mode[index].eq_parm[i];
|
||
tar_len = sizeof(eff_mode[index].eq_parm[i]);
|
||
eff_file_analyze(eff_mode_seq[index], group_id, tar_buf, tar_len);
|
||
eq_printf(tar_buf);
|
||
}
|
||
//wdrc
|
||
for (int i = 0; i < ARRAY_SIZE(drc_name); i++) {
|
||
group_id = get_group_id(drc_name[i], 0);
|
||
tar_buf = (void *)&eff_mode[index].drc_parm[i];
|
||
tar_len = sizeof(eff_mode[index].drc_parm[i]);
|
||
eff_file_analyze(eff_mode_seq[index], group_id, tar_buf, tar_len);
|
||
wdrc_printf(tar_buf);
|
||
}
|
||
|
||
#if GAIN_PROCESS_EN
|
||
//gain
|
||
group_id = EFF_MIC_GAIN;
|
||
tar_buf = &eff_mode[index].gain_parm;
|
||
tar_len = sizeof(eff_mode[index].gain_parm);
|
||
eff_file_analyze(eff_mode_seq[index], group_id, tar_buf, tar_len);
|
||
#if PARM_DEBUG
|
||
log_debug("gain_parm.is_bypass %d, gain 0x%x", gain_parm.is_bypass, *(int *)&gain_parm.parm.gain);
|
||
#endif
|
||
#endif
|
||
}
|
||
#endif
|
||
/**
|
||
*注册相应模块的解析函数,返回值0成功，返回小于0失败
|
||
* */
|
||
REGISTER_CMD_TARGET(mic_g) = {
|
||
.cmd = EFF_MIC_GAIN,
|
||
.cmd_deal = mic_gain_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(music_g) = {
|
||
.cmd = EFF_MUSIC_GAIN,
|
||
.cmd_deal = gain_process_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(music_rl_g) = {
|
||
.cmd = EFF_MUSIC_RL_GAIN,
|
||
.cmd_deal = rl_gain_process_parm_analyze,
|
||
};
|
||
|
||
|
||
REGISTER_CMD_TARGET(dyeq) = {
|
||
.cmd = EFF_MUSIC_DYNAMIC_EQ,
|
||
.cmd_deal = dynamic_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(echo) = {
|
||
.cmd = EFF_MIC_ECHO,
|
||
.cmd_deal = echo_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(p_reverb) = {
|
||
.cmd = EFF_MIC_PLATE_REVERB,
|
||
.cmd_deal = plate_reverb_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(notch_howling) = {
|
||
.cmd = EFF_MIC_NOTCH_HOWLING,
|
||
.cmd_deal = notchhowline_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(howling_ps) = {
|
||
.cmd = EFF_MIC_HOWLINE_PS,
|
||
.cmd_deal = howling_pitch_shift_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(noisegate) = {
|
||
.cmd = EFF_MIC_NOISEGATE,
|
||
.cmd_deal = noise_gate_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(pw_drc) = {//下行宽频drc
|
||
.cmd = EFF_PHONE_WIDEBAND_DRC,
|
||
.cmd_deal = phone_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(ph_drc) = {//下行窄频drc
|
||
.cmd = EFF_PHONE_NARROWBAND_DRC,
|
||
.cmd_deal = phone_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(aw_drc) = {//上行宽频drc
|
||
.cmd = EFF_AEC_WIDEBAND_DRC,
|
||
.cmd_deal = phone_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(an_drc) = {//上行窄频drc
|
||
.cmd = EFF_AEC_NARROWBAND_DRC,
|
||
.cmd_deal = phone_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(ml_drc) = {//music_drc
|
||
.cmd = EFF_MUSIC_LOW_DRC,
|
||
.cmd_deal = music_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(mm_drc) = {//music_drc
|
||
.cmd = EFF_MUSIC_MID_DRC,
|
||
.cmd_deal = music_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(mh_drc) = {//music_drc
|
||
.cmd = EFF_MUSIC_HIGH_DRC,
|
||
.cmd_deal = music_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(m_whole_drc) = {//music_drc
|
||
.cmd = EFF_MUSIC_WHOLE_DRC,
|
||
.cmd_deal = music_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(m_cross) = {//music_crossover
|
||
.cmd = EFF_MUSIC_CROSSOVER,
|
||
.cmd_deal = music_wdrc_parm_analyze,
|
||
};
|
||
|
||
REGISTER_CMD_TARGET(rl_drc_p) = {//music_rl_drc
|
||
.cmd = EFF_MUSIC_RL_LOW_DRC,
|
||
.cmd_deal = music_rl_wdrc_parm_analyze,
|
||
};
|
||
|
||
|
||
REGISTER_CMD_TARGET(micDrc0) = {//mic_drc0
|
||
.cmd = EFF_MIC_DRC0,
|
||
.cmd_deal = mic_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micDrc1) = {//mic_drc1
|
||
.cmd = EFF_MIC_DRC1,
|
||
.cmd_deal = mic_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micDrc2) = {//mic_drc2
|
||
.cmd = EFF_MIC_DRC2,
|
||
.cmd_deal = mic_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micDrc3) = {//mic_drc3
|
||
.cmd = EFF_MIC_DRC3,
|
||
.cmd_deal = mic_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micDrc4) = {//mic_drc4
|
||
.cmd = EFF_MIC_DRC4,
|
||
.cmd_deal = mic_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(music_eq) = {//music eq
|
||
.cmd = EFF_MUSIC_EQ2,
|
||
.cmd_deal = music_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(music_eq2) = {//music eq2
|
||
.cmd = EFF_MUSIC_EQ,
|
||
.cmd_deal = music_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(music_hbass_eq) = {//high bass eq
|
||
.cmd = EFF_MUSIC_HIGH_BASS_EQ,
|
||
.cmd_deal = music_eq_parm_analyze,
|
||
};
|
||
|
||
REGISTER_CMD_TARGET(micEq0) = {//mic eq0
|
||
.cmd = EFF_MIC_EQ0,
|
||
.cmd_deal = mic_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micEq1) = {//mic eq1
|
||
.cmd = EFF_MIC_EQ1,
|
||
.cmd_deal = mic_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micEq2) = {//mic eq2
|
||
.cmd = EFF_MIC_EQ2,
|
||
.cmd_deal = mic_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micEq3) = {//mic eq3
|
||
.cmd = EFF_MIC_EQ3,
|
||
.cmd_deal = mic_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(micEq4) = {//mic eq4
|
||
.cmd = EFF_MIC_EQ4,
|
||
.cmd_deal = mic_eq_parm_analyze,
|
||
};
|
||
|
||
REGISTER_CMD_TARGET(ph_Eq) = {//通话下行宽频(16k sr)
|
||
.cmd = EFF_PHONE_WIDEBAND_EQ,
|
||
.cmd_deal = phone_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(pn_Eq) = {//通话下行窄频(8k sr)
|
||
.cmd = EFF_PHONE_NARROWBAND_EQ,
|
||
.cmd_deal = phone_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(aw_Eq) = {//通话上行宽频(16k sr)
|
||
.cmd = EFF_AEC_WIDEBAND_EQ,
|
||
.cmd_deal = phone_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(an_Eq) = {//通话上行窄频(8k sr)
|
||
.cmd = EFF_AEC_NARROWBAND_EQ,
|
||
.cmd_deal = phone_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(lowpass_p) = {//2.1/2.2声道低通滤波器
|
||
.cmd = EFF_MUSIC_RL_RR_LOW_PASS,
|
||
.cmd_deal = low_pass_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(linein_eq) = {//linein eq
|
||
.cmd = EFF_LINEIN_EQ,
|
||
.cmd_deal = linein_eq_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(linein_drc) = {//linein drc
|
||
.cmd = EFF_LINEIN_DRC,
|
||
.cmd_deal = linein_wdrc_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(linein_g) = {
|
||
.cmd = EFF_LINEIN_GAIN,
|
||
.cmd_deal = linein_gain_process_parm_analyze,
|
||
};
|
||
REGISTER_CMD_TARGET(mic_voice_changer) = {
|
||
.cmd = EFF_MIC_VOICE_CHANGER,
|
||
.cmd_deal = mic_voice_changer_parm_ananlyze,
|
||
};
|
||
REGISTER_CMD_TARGET(vbass_h) = {
|
||
.cmd = EFF_MUSIC_VBASS,
|
||
.cmd_deal = music_vbass_parm_ananlyze,
|
||
};
|
||
|
||
REGISTER_CMD_TARGET(vbass_prev_g) = {
|
||
.cmd = EFF_MUSIC_VBASS_PREV_GAIN,
|
||
.cmd_deal = vbass_prev_gain_process_parm_analyze,
|
||
};
|
||
|
||
|
||
/**
|
||
*注册个别查询命令解析函数,返回值1成功，返回小于0失败
|
||
* */
|
||
REGISTER_CMD_TARGET(version) = {
|
||
.cmd = EFF_CMD_GETVER,
|
||
.cmd_deal = eff_tool_get_version,
|
||
};
|
||
REGISTER_CMD_TARGET(file_s) = {
|
||
.cmd = EFF_CMD_FILE_SIZE,
|
||
.cmd_deal = eff_tool_get_cfg_file_size,
|
||
};
|
||
REGISTER_CMD_TARGET(file_p) = {
|
||
.cmd = EFF_CMD_FILE,
|
||
.cmd_deal = eff_tool_get_cfg_file_data,
|
||
};
|
||
REGISTER_CMD_TARGET(change_mode) = {
|
||
.cmd = EFF_CMD_CHANGE_MODE,
|
||
.cmd_deal = eff_tool_set_channge_mode,
|
||
};
|
||
REGISTER_CMD_TARGET(inquire) = {
|
||
.cmd = EFF_CMD_INQUIRE,
|
||
.cmd_deal = eff_tool_set_inquire,
|
||
};
|
||
REGISTER_CMD_TARGET(resync_begin) = {
|
||
.cmd = EFF_CMD_RESYNC_PARM_BEGIN,
|
||
.cmd_deal = eff_tool_resync_parm_begin,
|
||
};
|
||
|
||
REGISTER_CMD_TARGET(resync_end) = {
|
||
.cmd = EFF_CMD_RESYNC_PARM_END,
|
||
.cmd_deal = eff_tool_resync_parm_end,
|
||
};
|
||
|
||
|
||
|
||
int eff_init(void)
|
||
{
|
||
int i = 0;
|
||
phone_eff_default_parm();
|
||
music_eff_default_parm();
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
linein_eff_default_parm();
|
||
#endif
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
for (i = 0 ; i < EFFECT_REVERB_PARM_MAX; i++) {
|
||
mic_eff_default_parm(i);
|
||
}
|
||
#endif
|
||
|
||
phone_eff_analyze_data();
|
||
music_eff_analyze_data();
|
||
#if (TCFG_EQ_ENABLE != 0)
|
||
cp_eq_file_seg_to_custom_tab();
|
||
#endif
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
linein_eff_analyze_data();
|
||
#endif
|
||
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
for (i = 0 ; i < EFFECT_REVERB_PARM_MAX; i++) {
|
||
mic_eff_analyze_data(i);
|
||
}
|
||
#endif
|
||
return 0;
|
||
}
|
||
__initcall(eff_init);
|
||
|
||
/*
|
||
*设置eq更新标志，eq运行时会重新调用系数回调，获取系数
|
||
* */
|
||
static void cur_eq_update(u32 eq_name)
|
||
{
|
||
struct audio_eq *eq = get_cur_eq_hdl_by_name(eq_name);
|
||
local_irq_disable();
|
||
if (eq) {
|
||
eq->mask[0] = (u32)-1;
|
||
eq->mask[1] = (u32)-1;
|
||
eq->updata = 1;
|
||
}
|
||
local_irq_enable();
|
||
}
|
||
/*
|
||
*设置drc更新标志，drc运行时会重新调用系数回调，获取系数
|
||
* */
|
||
static void cur_drc_update(u32 drc_name)
|
||
{
|
||
struct audio_drc *drc = get_cur_drc_hdl_by_name(drc_name);
|
||
local_irq_disable();
|
||
if (drc) {
|
||
drc->updata = 1;
|
||
}
|
||
local_irq_enable();
|
||
|
||
}
|
||
/*
|
||
*效果文件切换
|
||
*path:效果文件路径
|
||
* */
|
||
void eff_file_switch(u8 *path)
|
||
{
|
||
printf("--------------------------------------------------------->EQ SW to %s \n",path);
|
||
//更新效果文件路径
|
||
memcpy(EFF_CFG_FILE_NAME, path, strlen(path));
|
||
//重新解析效果文件
|
||
phone_eff_analyze_data();
|
||
music_eff_analyze_data();
|
||
#if (TCFG_EQ_ENABLE != 0)
|
||
cp_eq_file_seg_to_custom_tab();
|
||
#endif
|
||
#if defined(LINEIN_MODE_SOLE_EQ_EN) && LINEIN_MODE_SOLE_EQ_EN
|
||
linein_eff_analyze_data();
|
||
#endif
|
||
|
||
#if defined(TCFG_MIC_EFFECT_ENABLE) && TCFG_MIC_EFFECT_ENABLE
|
||
for (int i = 0 ; i < EFFECT_REVERB_PARM_MAX; i++) {
|
||
mic_eff_analyze_data(i);
|
||
}
|
||
#endif
|
||
|
||
//设置需要更新的模块
|
||
//audio_vbass_update_demo(AEID_MUSIC_VBASS, &vbass_parm.parm, vbass_parm.is_bypass);
|
||
int i = 0;
|
||
for(i=0;i<4;i++){
|
||
cur_drc_set_update(AEID_MUSIC_DRC, i, &music_mode.drc_parm.wdrc_parm[i]);
|
||
cur_drc_set_bypass(AEID_MUSIC_DRC, i,&music_mode.drc_parm.wdrc_parm[i].is_bypass);
|
||
}
|
||
|
||
//eq_mode_set(EQ_MODE_CUSTOM); //flym 250614
|
||
}
|