int snddev_ecodec_close(struct msm_snddev_info *dev_info)
{
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
pr_debug("%s: closing %s\n", __func__, dev_info->name);
mutex_lock(&drv->dev_lock);
if (!dev_info->opened) {
pr_err("%s: ERROR: %s is not opened\n", __func__,
dev_info->name);
mutex_unlock(&drv->dev_lock);
return -EPERM;
}
drv->ref_cnt--;
if (drv->ref_cnt == 0) {
pr_info("%s: closing all devices\n", __func__);
clk_disable_unprepare(drv->ecodec_clk);
aux_pcm_gpios_free();
afe_close(PCM_RX);
afe_close(PCM_TX);
}
mutex_unlock(&drv->dev_lock);
return 0;
}
int snddev_ecodec_close(struct msm_snddev_info *dev_info)
{
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
#ifdef CONFIG_PANTECH_AUDIO_PRESTO_AUDIENCE2020 // jmlee
//int i;
struct snddev_ecodec_state *ecodec;
#endif
pr_debug("%s: closing %s\n", __func__, dev_info->name);
mutex_lock(&drv->dev_lock);
if (!dev_info->opened) {
pr_err("%s: ERROR: %s is not opened\n", __func__,
dev_info->name);
mutex_unlock(&drv->dev_lock);
return -EPERM;
}
#ifdef CONFIG_PANTECH_AUDIO_PRESTO_AUDIENCE2020 // jmlee
/* audience disable */
ecodec = dev_info->private_data;
if (ecodec->data->pamp_off && (ecodec_audience_enable))
{
ecodec->data->pamp_off();
ecodec_audience_enable = 0;
/* Disable mic bias */ // 20110224 jhsong
//for (i = 0; i < ecodec->data->pmctl_id_sz; i++) {
// pmic_hsed_enable(ecodec->data->pmctl_id[i],
// PM_HSED_ENABLE_OFF);
//}
}
#endif
drv->ref_cnt--;
if (drv->ref_cnt == 0) {
pr_info("%s: closing all devices\n", __func__);
clk_disable(drv->ecodec_clk);
aux_pcm_gpios_free();
afe_close(PCM_RX);
afe_close(PCM_TX);
}
mutex_unlock(&drv->dev_lock);
return 0;
}
static int snddev_ecodec_close_tx(struct snddev_ecodec_state *ecodec)
{
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
/* free GPIO */
if (!drv->rx_active) {
aux_pcm_gpios_free();
clk_disable(drv->ecodec_clk);
}
/* disable AFE */
afe_disable(AFE_HW_PATH_AUXPCM_TX);
ecodec->enabled = 0;
return 0;
}
static int snddev_ecodec_close_rx(struct snddev_ecodec_state *ecodec)
{
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
MM_INFO("snddev_ecodec_close_rx : name = %s\n", ecodec->data->name);
/* free GPIO */
if (!drv->tx_active) {
aux_pcm_gpios_free();
clk_disable(drv->ecodec_clk);
}
/* disable AFE */
afe_disable(AFE_HW_PATH_AUXPCM_RX);
ecodec->enabled = 0;
return 0;
}
static int snddev_ecodec_open(struct msm_snddev_info *dev_info)
{
int rc;
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
union afe_port_config afe_config;
pr_debug("%s\n", __func__);
mutex_lock(&drv->dev_lock);
if (dev_info->opened) {
pr_err("%s: ERROR: %s already opened\n", __func__,
dev_info->name);
mutex_unlock(&drv->dev_lock);
return -EBUSY;
}
if (drv->ref_cnt != 0) {
pr_debug("%s: opened %s\n", __func__, dev_info->name);
drv->ref_cnt++;
mutex_unlock(&drv->dev_lock);
return 0;
}
pr_info("%s: opening %s\n", __func__, dev_info->name);
rc = aux_pcm_gpios_request();
if (rc < 0) {
pr_err("%s: GPIO request failed\n", __func__);
return rc;
}
clk_reset(drv->ecodec_clk, CLK_RESET_ASSERT);
afe_config.pcm.mode = AFE_PCM_CFG_MODE_PCM;
afe_config.pcm.sync = AFE_PCM_CFG_SYNC_INT;
afe_config.pcm.frame = AFE_PCM_CFG_FRM_256BPF;
afe_config.pcm.quant = AFE_PCM_CFG_QUANT_LINEAR_NOPAD;
afe_config.pcm.slot = 0;
afe_config.pcm.data = AFE_PCM_CFG_CDATAOE_MASTER;
rc = afe_open(PCM_RX, &afe_config, ECODEC_SAMPLE_RATE);
if (rc < 0) {
pr_err("%s: afe open failed for PCM_RX\n", __func__);
goto err_rx_afe;
}
rc = afe_open(PCM_TX, &afe_config, ECODEC_SAMPLE_RATE);
if (rc < 0) {
pr_err("%s: afe open failed for PCM_TX\n", __func__);
goto err_tx_afe;
}
rc = clk_set_rate(drv->ecodec_clk, 2048000);
if (rc < 0) {
pr_err("%s: clk_set_rate failed\n", __func__);
goto err_clk;
}
clk_prepare_enable(drv->ecodec_clk);
clk_reset(drv->ecodec_clk, CLK_RESET_DEASSERT);
drv->ref_cnt++;
mutex_unlock(&drv->dev_lock);
return 0;
err_clk:
afe_close(PCM_TX);
err_tx_afe:
afe_close(PCM_RX);
err_rx_afe:
aux_pcm_gpios_free();
mutex_unlock(&drv->dev_lock);
return -ENODEV;
}
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 int snddev_ecodec_open(struct msm_snddev_info *dev_info)
{
int rc;
struct snddev_ecodec_drv_state *drv = &snddev_ecodec_drv;
union afe_port_config afe_config;
#ifdef CONFIG_PANTECH_AUDIO_PRESTO_AUDIENCE2020 // jmlee
struct snddev_ecodec_state *ecodec;
//int i;
#endif
pr_debug("%s\n", __func__);
mutex_lock(&drv->dev_lock);
if (dev_info->opened) {
pr_err("%s: ERROR: %s already opened\n", __func__,
dev_info->name);
mutex_unlock(&drv->dev_lock);
return -EBUSY;
}
if (drv->ref_cnt != 0) {
pr_debug("%s: opened %s\n", __func__, dev_info->name);
drv->ref_cnt++;
mutex_unlock(&drv->dev_lock);
return 0;
}
pr_info("%s: opening %s\n", __func__, dev_info->name);
rc = aux_pcm_gpios_request();
if (rc < 0) {
pr_err("%s: GPIO request failed\n", __func__);
return rc;
}
clk_reset(drv->ecodec_clk, CLK_RESET_ASSERT);
afe_config.pcm.mode = AFE_PCM_CFG_MODE_PCM;
afe_config.pcm.sync = AFE_PCM_CFG_SYNC_INT;
afe_config.pcm.frame = AFE_PCM_CFG_FRM_256BPF;
afe_config.pcm.quant = AFE_PCM_CFG_QUANT_LINEAR_NOPAD;
afe_config.pcm.slot = 0;
afe_config.pcm.data = AFE_PCM_CFG_CDATAOE_MASTER;
rc = afe_open(PCM_RX, &afe_config, ECODEC_SAMPLE_RATE);
if (rc < 0) {
pr_err("%s: afe open failed for PCM_RX\n", __func__);
goto err_rx_afe;
}
rc = afe_open(PCM_TX, &afe_config, ECODEC_SAMPLE_RATE);
if (rc < 0) {
pr_err("%s: afe open failed for PCM_TX\n", __func__);
goto err_tx_afe;
}
rc = clk_set_rate(drv->ecodec_clk, 2048000);
if (rc < 0) {
pr_err("%s: clk_set_rate failed\n", __func__);
goto err_clk;
}
clk_enable(drv->ecodec_clk);
clk_reset(drv->ecodec_clk, CLK_RESET_DEASSERT);
drv->ref_cnt++;
mutex_unlock(&drv->dev_lock);
#ifdef CONFIG_PANTECH_AUDIO_PRESTO_AUDIENCE2020 // jmlee
/* audience enable */
ecodec = dev_info->private_data;
if ((ecodec->data->pamp_on) && (!ecodec_audience_enable))
{
ecodec->data->pamp_on();
ecodec_audience_enable = 1;
/* Enable mic bias */
//for (i = 0; i < ecodec->data->pmctl_id_sz; i++) {
// pmic_hsed_enable(ecodec->data->pmctl_id[i],
// PM_HSED_ENABLE_PWM_TCXO);
//}
}
#endif
return 0;
err_clk:
afe_close(PCM_TX);
err_tx_afe:
afe_close(PCM_RX);
err_rx_afe:
aux_pcm_gpios_free();
mutex_unlock(&drv->dev_lock);
return -ENODEV;
}
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 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");
}
}
