static int snddev_ecodec_open_rx(struct snddev_ecodec_state *ecodec)
{
int rc = 0;
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
struct msm_afe_config afe_config;
MM_DBG("snddev_ecodec_open_rx\n");
MM_INFO("snddev_ecodec_open_rx : name = %s\n", ecodec->data->name);
if (!drv->tx_active) {
/* request GPIO */
rc = aux_pcm_gpios_request();
if (rc) {
MM_ERR("GPIO enable failed\n");
goto done;
}
/* config clocks */
clk_enable(drv->lpa_core_clk);
/* enable ecodec clk */
clk_enable(drv->ecodec_clk);
/* let ADSP confiure AUX PCM regs */
aux_codec_adsp_codec_ctl_en(ADSP_CTL);
/* let adsp configure pcm path */
aux_codec_pcm_path_ctl_en(ADSP_CTL);
/* choose ADSP_A */
audio_interct_aux_regsel(AUDIO_ADSP_A);
audio_interct_tpcm_source(AUDIO_ADSP_A);
audio_interct_rpcm_source(AUDIO_ADSP_A);
clk_disable(drv->lpa_core_clk);
/* send AUX_CODEC_CONFIG to AFE */
rc = afe_config_aux_codec(ecodec->data->conf_pcm_ctl_val,
ecodec->data->conf_aux_codec_intf,
ecodec->data->conf_data_format_padding_val);
if (IS_ERR_VALUE(rc))
goto error;
}
/* send CODEC CONFIG to AFE */
afe_config.sample_rate = ecodec->sample_rate / 1000;
afe_config.channel_mode = ecodec->data->channel_mode;
afe_config.volume = AFE_VOLUME_UNITY;
rc = afe_enable(AFE_HW_PATH_AUXPCM_RX, &afe_config);
if (IS_ERR_VALUE(rc)) {
if (!drv->tx_active) {
aux_pcm_gpios_free();
clk_disable(drv->ecodec_clk);
}
goto done;
}
ecodec->enabled = 1;
return 0;
error:
aux_pcm_gpios_free();
clk_disable(drv->ecodec_clk);
done:
return rc;
}
static int snddev_ecodec_open_rx(struct snddev_ecodec_state *ecodec)
{
int rc = 0;
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
struct msm_afe_config afe_config;
int ret = 0;
MM_DBG("snddev_ecodec_open_rx\n");
if (!drv->tx_active) {
/* request GPIO */
rc = aux_pcm_gpios_request();
if (rc) {
MM_ERR("GPIO enable failed\n");
goto done;
}
/* config clocks */
clk_enable(drv->lpa_core_clk);
/*if long sync is selected in aux PCM interface
ecodec clock is updated to work with 128KHz,
if short sync is selected ecodec clock is updated to
work with 2.048MHz frequency, actual clock output is
different than the SW configuration by factor of two*/
if (!(ecodec->data->conf_aux_codec_intf &
AUX_CODEC_CTL__AUX_CODEC_MODE__I2S_V)) {
if (ecodec->data->conf_aux_codec_intf &
AUX_CODEC_CTL__AUX_PCM_MODE__AUX_MASTER_V) {
MM_DBG("Update ecodec clock to 128 KHz, long "
"sync in master mode is selected\n");
ret = clk_set_rate(drv->ecodec_clk, 256000);
if (ret < 0)
MM_ERR("Error updating ecodec clock"
" to 128KHz\n");
} else if (ecodec->data->conf_aux_codec_intf &
AUX_CODEC_CTL__AUX_PCM_MODE__PRIM_SLAVE_V) {
MM_DBG("Update ecodec clock to 2 MHz, short"
" sync in slave mode is selected\n");
ret = clk_set_rate(drv->ecodec_clk, 4096000);
if (ret < 0)
MM_ERR("Error updating ecodec clock"
" to 2.048MHz\n");
} else {
MM_DBG("Update ecodec clock to 2 MHz, short"
" sync in master mode is selected\n");
ret = clk_set_rate(drv->ecodec_clk, 4096000);
if (ret < 0)
MM_ERR("Error updating ecodec clock"
" to 2.048MHz\n");
}
}
/* enable ecodec clk */
clk_enable(drv->ecodec_clk);
/* let ADSP confiure AUX PCM regs */
aux_codec_adsp_codec_ctl_en(ADSP_CTL);
/* let adsp configure pcm path */
aux_codec_pcm_path_ctl_en(ADSP_CTL);
/* choose ADSP_A */
audio_interct_aux_regsel(AUDIO_ADSP_A);
audio_interct_tpcm_source(AUDIO_ADSP_A);
audio_interct_rpcm_source(AUDIO_ADSP_A);
clk_disable(drv->lpa_core_clk);
/* send AUX_CODEC_CONFIG to AFE */
rc = afe_config_aux_codec(ecodec->data->conf_pcm_ctl_val,
ecodec->data->conf_aux_codec_intf,
ecodec->data->conf_data_format_padding_val);
if (IS_ERR_VALUE(rc))
goto error;
}
/* send CODEC CONFIG to AFE */
afe_config.sample_rate = ecodec->sample_rate / 1000;
afe_config.channel_mode = ecodec->data->channel_mode;
afe_config.volume = AFE_VOLUME_UNITY;
rc = afe_enable(AFE_HW_PATH_AUXPCM_RX, &afe_config);
if (IS_ERR_VALUE(rc)) {
if (!drv->tx_active) {
aux_pcm_gpios_free();
clk_disable(drv->ecodec_clk);
}
goto done;
}
ecodec->enabled = 1;
return 0;
error:
aux_pcm_gpios_free();
clk_disable(drv->ecodec_clk);
done:
return rc;
}
static void bt_sco_set_loopback_mode(u32 loop)
{
int trc;
struct msm_afe_config afe_config;
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
MM_INFO("[BTUI] bt_sco_set_loopback_mode : %d \n", loop);
if(loop & 1)
{
/**********************************************************
* Aux PCM Common set up
***********************************************************/
/* request GPIO */
trc = aux_pcm_gpios_request();
if (trc)
{
MM_ERR("[BTUI] ###### GPIO enable failed\n");
}
/* config clocks */
clk_enable(drv->lpa_core_clk);
/* enable ecodec clk */
clk_enable(drv->ecodec_clk);
/* let ADSP confiure AUX PCM regs */
aux_codec_adsp_codec_ctl_en(ADSP_CTL);
/* let adsp configure pcm path */
aux_codec_pcm_path_ctl_en(ADSP_CTL);
/* choose ADSP_A */
audio_interct_aux_regsel(AUDIO_ADSP_A);
audio_interct_tpcm_source(AUDIO_ADSP_A);
audio_interct_rpcm_source(AUDIO_ADSP_A);
clk_disable(drv->lpa_core_clk);
/* send AUX_CODEC_CONFIG to AFE */
trc = afe_config_aux_codec(TESTMODE_HANDSET_PCM_CTL_VAL,TESTMODE_AUX_CODEC_INTF,TESTMODE_DATA_FORMAT_PADDING);
if (IS_ERR_VALUE(trc))
{
MM_ERR("[BTUI] ###### afe_config_aux_codec failed\n");
}
/**********************************************************
* Aux PCM Rx path set up
***********************************************************/
/* send CODEC CONFIG to AFE */
afe_config.sample_rate = 8;
afe_config.channel_mode = 1;
afe_config.volume = AFE_VOLUME_UNITY;
trc = afe_enable(AFE_HW_PATH_AUXPCM_RX, &afe_config);
if (IS_ERR_VALUE(trc)){
MM_ERR("[BTUI] ###### afe_enable failed\n");
}
/**********************************************************
* Aux PCM Tx path set up
***********************************************************/
/* send CODEC CONFIG to AFE */
afe_config.sample_rate = 8;
afe_config.channel_mode = 1;
afe_config.volume = AFE_VOLUME_UNITY;
trc = afe_enable(AFE_HW_PATH_AUXPCM_TX, &afe_config);
if (IS_ERR_VALUE(trc)) {
MM_ERR("[BTUI] ###### afe_enable tx failed\n");
}
/************************************************************************************
* Start LoopBack
*************************************************************************************/
/* Set the volume level to non unity, to avoid
loopback effect */
afe_device_volume_ctrl(AFE_HW_PATH_AUXPCM_RX, 0x0500);
lb_status = loop;
MM_INFO("[BTUI] bt_sco_set_loopback_mode : [ENABLED] \n");
afe_config_ext_pcm_loopback(0xFFFF);
}
else {
/*release GPIOs*/
aux_pcm_gpios_free();
afe_config_ext_pcm_loopback(0x0);
/*disable clocks*/
clk_disable(drv->ecodec_clk);
/*Disable afe configuration */
afe_disable(AFE_HW_PATH_AUXPCM_RX);
afe_disable(AFE_HW_PATH_AUXPCM_TX);
lb_status = 0;
MM_INFO("[BTUI] bt_sco_set_loopback_mode : [DISABLED] \n");
}
}