static int set_rt55xx_init(void)
{
pr_info("%s:set set_rt550xx_init, rt55xx_chip %d\n",__func__,rt55xx_chip);
switch(rt55xx_chip) {
case RT55XX_07:
rt5506_write_reg(0x0,0xc0);
rt5506_write_reg(0x81,0x30);
rt5506_write_reg(0x87,0xea);
rt5506_write_reg(0x90,0xd0);
rt5506_write_reg(0x93,0x9d);
rt5506_write_reg(0x95,0x7b);
rt5506_write_reg(0xa4,0x52);
rt5506_write_reg(0x97,0x00);
rt5506_write_reg(0x98,0x22);
rt5506_write_reg(0x99,0x33);
rt5506_write_reg(0x9a,0x55);
rt5506_write_reg(0x9b,0x66);
rt5506_write_reg(0x9c,0x99);
rt5506_write_reg(0x9d,0x66);
rt5506_write_reg(0x9e,0x99);
rt5506_write_reg(0x90,0x93);
break;
case RT55XX_06:
default:
rt5506_write_reg(0x0,0xc0);
rt5506_write_reg(0x81,0x30);
rt5506_write_reg(0x90,0xd0);
rt5506_write_reg(0x93,0x9d);
rt5506_write_reg(0x95,0x7b);
rt5506_write_reg(0xa4,0x52);
rt5506_write_reg(0x97,0x00);
rt5506_write_reg(0x98,0x22);
rt5506_write_reg(0x99,0x33);
rt5506_write_reg(0x9a,0x55);
rt5506_write_reg(0x9b,0x66);
rt5506_write_reg(0x9c,0x99);
rt5506_write_reg(0x9d,0x66);
rt5506_write_reg(0x9e,0x99);
break;
}
return 0;
}
static int rt5506_headset_detect(void *private_data, int on)
{
if(!rt5506Connect)
return 0;
if(on) {
pr_info("%s: headset in ++\n",__func__);
cancel_delayed_work_sync(&rt5506_query.hs_imp_detec_work);
mutex_lock(&rt5506_query.gpiolock);
mutex_lock(&rt5506_query.mlock);
rt5506_query.hs_qstatus = RT55XX_QUERY_HEADSET;
rt5506_query.headsetom = HEADSET_OM_UNDER_DETECT;
if(rt5506_query.rt5506_status == RT55XX_PLAYBACK) {
if(high_imp) {
rt5506_write_reg(1,0x7);
rt5506_write_reg(0xb1,0x81);
} else {
rt5506_write_reg(1,0xc7);
}
last_spkamp_state = 0;
pr_info("%s: OFF\n", __func__);
rt5506_query.rt5506_status = RT55XX_SUSPEND;
}
pr_info("%s: headset in --\n",__func__);
mutex_unlock(&rt5506_query.mlock);
mutex_unlock(&rt5506_query.gpiolock);
queue_delayed_work(hs_wq,&rt5506_query.hs_imp_detec_work,msecs_to_jiffies(5));
pr_info("%s: headset in --2\n",__func__);
} else {
pr_info("%s: headset remove ++\n",__func__);
cancel_delayed_work_sync(&rt5506_query.hs_imp_detec_work);
flush_work(&rt5506_query.volume_ramp_work.work);
mutex_lock(&rt5506_query.gpiolock);
mutex_lock(&rt5506_query.mlock);
rt5506_query.hs_qstatus = RT55XX_QUERY_OFF;
rt5506_query.headsetom = HEADSET_OM_UNDER_DETECT;
if(rt5506_query.regstatus == REG_AUTO_MODE) {
set_rt5506_regulator(REG_PWM_MODE);
rt5506_query.regstatus = REG_PWM_MODE;
}
if(rt5506_query.rt5506_status == RT55XX_PLAYBACK) {
if(high_imp) {
rt5506_write_reg(1,0x7);
rt5506_write_reg(0xb1,0x81);
} else {
rt5506_write_reg(1,0xc7);
}
last_spkamp_state = 0;
pr_info("%s: OFF\n", __func__);
rt5506_query.rt5506_status = RT55XX_SUSPEND;
}
if(high_imp) {
int closegpio = 0;
if(rt5506_query.gpiostatus == AMP_GPIO_OFF) {
pr_info("%s: enable gpio %d\n", __func__, pdata->gpio_rt55xx_enable);
if(rt5506_query.regstatus == REG_AUTO_MODE) {
set_rt5506_regulator(REG_PWM_MODE);
rt5506_query.regstatus = REG_PWM_MODE;
msleep(1);
}
gpio_set_value(pdata->gpio_rt55xx_enable, 1);
closegpio = 1;
usleep_range(20000,20000);
}
pr_info("%s: reset rt5501\n",__func__);
rt5506_write_reg(0x0,0x4);
mdelay(1);
rt5506_write_reg(0x1,0xc7);
high_imp = 0;
if(closegpio) {
pr_info("%s: disable gpio %d\n", __func__, pdata->gpio_rt55xx_enable);
gpio_set_value(pdata->gpio_rt55xx_enable, 0);
if(rt5506_query.regstatus == REG_PWM_MODE) {
set_rt5506_regulator(REG_AUTO_MODE);
rt5506_query.regstatus = REG_AUTO_MODE;
}
}
}
rt5506_query.curmode = RT55XX_MODE_OFF;
pr_info("%s: headset remove --1\n",__func__);
mutex_unlock(&rt5506_query.mlock);
mutex_unlock(&rt5506_query.gpiolock);
pr_info("%s: headset remove --2\n",__func__);
}
return 0;
}
static int rt5506_headset_detect(void *private_data, int on)
{
if(!rt5506Connect)
return 0;
if(on) {
mutex_lock(&rt5506_query.mlock);
if(rt5506_query.hs_connec) {
pr_info("%s: headset exist, ignore\n",__func__);
mutex_unlock(&rt5506_query.mlock);
return 0;
}
mutex_unlock(&rt5506_query.mlock);
pr_info("%s: headset in ++\n",__func__);
cancel_delayed_work_sync(&rt5506_query.hs_imp_detec_work);
mutex_lock(&rt5506_query.gpiolock);
mutex_lock(&rt5506_query.mlock);
rt5506_query.hs_qstatus = QUERY_HEADSET;
rt5506_query.headsetom = HEADSET_OM_UNDER_DETECT;
if(rt5506_query.rt5506_status == STATUS_PLAYBACK) {
if(high_imp) {
rt5506_write_reg(1,0x7);
rt5506_write_reg(0xb1,0x81);
} else {
rt5506_write_reg(1,0xc7);
}
last_spkamp_state = 0;
pr_info("%s: OFF\n", __func__);
rt5506_query.rt5506_status = STATUS_SUSPEND;
}
rt5506_query.hs_connec = 1;
pr_info("%s: headset in --\n",__func__);
mutex_unlock(&rt5506_query.mlock);
mutex_unlock(&rt5506_query.gpiolock);
queue_delayed_work(hs_wq,&rt5506_query.hs_imp_detec_work,msecs_to_jiffies(5));
pr_info("%s: headset in --2\n",__func__);
} else {
mutex_lock(&rt5506_query.mlock);
if(!rt5506_query.hs_connec) {
pr_info("%s: headset isn't exist, ignore\n",__func__);
mutex_unlock(&rt5506_query.mlock);
return 0;
}
mutex_unlock(&rt5506_query.mlock);
pr_info("%s: headset remove ++\n",__func__);
cancel_delayed_work_sync(&rt5506_query.hs_imp_detec_work);
flush_work_sync(&rt5506_query.volume_ramp_work.work);
mutex_lock(&rt5506_query.gpiolock);
mutex_lock(&rt5506_query.mlock);
rt5506_query.hs_qstatus = QUERY_OFF;
rt5506_query.headsetom = HEADSET_OM_UNDER_DETECT;
if(rt5506_query.regstatus == REG_AUTO_MODE) {
set_rt5506_regulator(REG_PWM_MODE);
rt5506_query.regstatus = REG_PWM_MODE;
}
if(rt5506_query.rt5506_status == STATUS_PLAYBACK) {
if(high_imp) {
rt5506_write_reg(1,0x7);
rt5506_write_reg(0xb1,0x81);
} else {
rt5506_write_reg(1,0xc7);
}
last_spkamp_state = 0;
pr_info("%s: OFF\n", __func__);
rt5506_query.rt5506_status = STATUS_SUSPEND;
}
if(high_imp) {
vote_power(&rt5506_query.power_mask, POWER_HIGH_IMP_RESET);
pr_info("%s: reset rt5501\n",__func__);
rt5506_write_reg(0x0,0x4);
mdelay(1);
rt5506_write_reg(0x1,0xc7);
high_imp = 0;
unvote_power(&rt5506_query.power_mask, POWER_HIGH_IMP_RESET);
}
rt5506_query.curmode = PLAYBACK_MODE_OFF;
rt5506_query.hs_connec = 0;
pr_info("%s: headset remove --1\n",__func__);
mutex_unlock(&rt5506_query.mlock);
mutex_unlock(&rt5506_query.gpiolock);
pr_info("%s: headset remove --2\n",__func__);
}
return 0;
}