/* Copyright (c) 2012-2013, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "msm-pcm-voice-v2.h" #include "q6voice.h" static struct msm_voice voice_info[VOICE_SESSION_INDEX_MAX]; static struct snd_pcm_hardware msm_pcm_hardware = { .info = (SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME), .formats = SNDRV_PCM_FMTBIT_S16_LE, .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000, .rate_min = 8000, .rate_max = 16000, .channels_min = 1, .channels_max = 1, .buffer_bytes_max = 4096 * 2, .period_bytes_min = 2048, .period_bytes_max = 4096, .periods_min = 2, .periods_max = 4, .fifo_size = 0, }; static int is_volte(struct msm_voice *pvolte) { if (pvolte == &voice_info[VOLTE_SESSION_INDEX]) return true; else return false; } static int is_voice2(struct msm_voice *pvoice2) { if (pvoice2 == &voice_info[VOICE2_SESSION_INDEX]) return true; else return false; } static uint32_t get_session_id(struct msm_voice *pvoc) { uint32_t session_id = 0; if (is_volte(pvoc)) session_id = voc_get_session_id(VOLTE_SESSION_NAME); else if (is_voice2(pvoc)) session_id = voc_get_session_id(VOICE2_SESSION_NAME); else session_id = voc_get_session_id(VOICE_SESSION_NAME); return session_id; } static int msm_pcm_playback_prepare(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; pr_debug("%s\n", __func__); if (!prtd->playback_start) prtd->playback_start = 1; return 0; } static int msm_pcm_capture_prepare(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; pr_debug("%s\n", __func__); if (!prtd->capture_start) prtd->capture_start = 1; return 0; } static int msm_pcm_open(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *voice; if (!strncmp("VoLTE", substream->pcm->id, 5)) { voice = &voice_info[VOLTE_SESSION_INDEX]; pr_debug("%s: Open VoLTE Substream Id=%s\n", __func__, substream->pcm->id); } else if (!strncmp("Voice2", substream->pcm->id, 6)) { voice = &voice_info[VOICE2_SESSION_INDEX]; pr_debug("%s: Open Voice2 Substream Id=%s\n", __func__, substream->pcm->id); } else { voice = &voice_info[VOICE_SESSION_INDEX]; pr_debug("%s: Open VOICE Substream Id=%s\n", __func__, substream->pcm->id); } mutex_lock(&voice->lock); runtime->hw = msm_pcm_hardware; if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) voice->playback_substream = substream; else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) voice->capture_substream = substream; voice->instance++; pr_debug("%s: Instance = %d, Stream ID = %s\n", __func__ , voice->instance, substream->pcm->id); runtime->private_data = voice; mutex_unlock(&voice->lock); return 0; } static int msm_pcm_playback_close(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; pr_debug("%s\n", __func__); if (prtd->playback_start) prtd->playback_start = 0; prtd->playback_substream = NULL; return 0; } static int msm_pcm_capture_close(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; pr_debug("%s\n", __func__); if (prtd->capture_start) prtd->capture_start = 0; prtd->capture_substream = NULL; return 0; } static int msm_pcm_close(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; uint32_t session_id = 0; int ret = 0; mutex_lock(&prtd->lock); if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) ret = msm_pcm_playback_close(substream); else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) ret = msm_pcm_capture_close(substream); prtd->instance--; if (!prtd->playback_start && !prtd->capture_start) { pr_debug("end voice call\n"); session_id = get_session_id(prtd); if (session_id) voc_end_voice_call(session_id); } mutex_unlock(&prtd->lock); return ret; } static int msm_pcm_prepare(struct snd_pcm_substream *substream) { int ret = 0; struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; uint32_t session_id = 0; mutex_lock(&prtd->lock); if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) ret = msm_pcm_playback_prepare(substream); else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) ret = msm_pcm_capture_prepare(substream); if (prtd->playback_start && prtd->capture_start) { session_id = get_session_id(prtd); if (session_id) voc_start_voice_call(session_id); } mutex_unlock(&prtd->lock); return ret; } static int msm_pcm_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params) { pr_debug("%s: Voice\n", __func__); snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer); return 0; } static int msm_pcm_trigger(struct snd_pcm_substream *substream, int cmd) { int ret = 0; struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; uint32_t session_id = 0; pr_debug("%s: cmd = %d\n", __func__, cmd); session_id = get_session_id(prtd); switch (cmd) { case SNDRV_PCM_TRIGGER_START: case SNDRV_PCM_TRIGGER_STOP: pr_debug("Start & Stop Voice call not handled in Trigger.\n"); break; case SNDRV_PCM_TRIGGER_RESUME: case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: pr_debug("%s: resume call session_id = %d\n", __func__, session_id); if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) ret = msm_pcm_playback_prepare(substream); else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) ret = msm_pcm_capture_prepare(substream); if (prtd->playback_start && prtd->capture_start) { if (session_id) voc_resume_voice_call(session_id); } break; case SNDRV_PCM_TRIGGER_SUSPEND: case SNDRV_PCM_TRIGGER_PAUSE_PUSH: pr_debug("%s: pause call session_id=%d\n", __func__, session_id); if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { if (prtd->playback_start) prtd->playback_start = 0; } else if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { if (prtd->capture_start) prtd->capture_start = 0; } if (session_id) voc_standby_voice_call(session_id); break; default: ret = -EINVAL; break; } return ret; } static int msm_pcm_ioctl(struct snd_pcm_substream *substream, unsigned int cmd, void *arg) { struct snd_pcm_runtime *runtime = substream->runtime; struct msm_voice *prtd = runtime->private_data; uint16_t session_id = get_session_id(prtd); enum voice_lch_mode lch_mode; int ret = 0; switch (cmd) { case SNDRV_VOICE_IOCTL_LCH: if (copy_from_user(&lch_mode, (void *)arg, sizeof(enum voice_lch_mode))) { pr_err("%s: Copy from user failed, size %d\n", __func__, sizeof(enum voice_lch_mode)); ret = -EFAULT; break; } pr_debug("%s: %s lch_mode:%d\n", __func__, substream->pcm->id, lch_mode); switch (lch_mode) { case VOICE_LCH_START: case VOICE_LCH_STOP: ret = voc_set_lch(session_id, lch_mode); break; default: pr_err("%s: Invalid LCH MODE %d\n", __func__, lch_mode); ret = -EFAULT; } break; default: pr_debug("%s: Falling into default snd_lib_ioctl cmd 0x%x\n", __func__, cmd); ret = snd_pcm_lib_ioctl(substream, cmd, arg); break; } if (!ret) pr_debug("%s: ret %d\n", __func__, ret); else pr_err("%s: cmd 0x%x failed %d\n", __func__, cmd, ret); return ret; } static int msm_voice_volume_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_voice_volume_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int volume = ucontrol->value.integer.value[0]; pr_debug("%s: volume: %d\n", __func__, volume); voc_set_rx_vol_index(voc_get_session_id(VOICE_SESSION_NAME), RX_PATH, volume); return 0; } static int msm_volte_volume_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_volte_volume_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int volume = ucontrol->value.integer.value[0]; pr_debug("%s: volume: %d\n", __func__, volume); voc_set_rx_vol_index(voc_get_session_id(VOLTE_SESSION_NAME), RX_PATH, volume); return 0; } static int msm_voice2_volume_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_voice2_volume_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int volume = ucontrol->value.integer.value[0]; pr_debug("%s: volume: %d\n", __func__, volume); voc_set_rx_vol_index(voc_get_session_id(VOICE2_SESSION_NAME), RX_PATH, volume); return 0; } static int msm_voice_topology_disable_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_voice_topology_disable_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int disable = ucontrol->value.integer.value[0]; uint32_t session_id = ucontrol->value.integer.value[1]; pr_debug("%s: disable = %d, session_id = %d\n", __func__, disable, session_id); return voc_disable_topology(session_id, disable); } static int msm_voice_mute_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_voice_mute_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int mute = ucontrol->value.integer.value[0]; pr_debug("%s: mute=%d\n", __func__, mute); voc_set_tx_mute(voc_get_session_id(VOICE_SESSION_NAME), TX_PATH, mute); return 0; } static int msm_volte_mute_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_volte_mute_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int mute = ucontrol->value.integer.value[0]; pr_debug("%s: mute=%d\n", __func__, mute); voc_set_tx_mute(voc_get_session_id(VOLTE_SESSION_NAME), TX_PATH, mute); return 0; } static int msm_voice2_mute_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = 0; return 0; } static int msm_voice2_mute_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int mute = ucontrol->value.integer.value[0]; pr_debug("%s: mute=%d\n", __func__, mute); voc_set_tx_mute(voc_get_session_id(VOICE2_SESSION_NAME), TX_PATH, mute); return 0; } static int msm_voice_rx_device_mute_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = voc_get_rx_device_mute(voc_get_session_id(VOICE_SESSION_NAME)); return 0; } static int msm_voice_rx_device_mute_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int mute = ucontrol->value.integer.value[0]; pr_debug("%s: mute=%d\n", __func__, mute); voc_set_rx_device_mute(voc_get_session_id(VOICE_SESSION_NAME), mute); return 0; } static int msm_volte_rx_device_mute_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = voc_get_rx_device_mute(voc_get_session_id(VOLTE_SESSION_NAME)); return 0; } static int msm_volte_rx_device_mute_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int mute = ucontrol->value.integer.value[0]; pr_debug("%s: mute=%d\n", __func__, mute); voc_set_rx_device_mute(voc_get_session_id(VOLTE_SESSION_NAME), mute); return 0; } static int msm_voice2_rx_device_mute_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = voc_get_rx_device_mute(voc_get_session_id(VOICE2_SESSION_NAME)); return 0; } static int msm_voice2_rx_device_mute_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int mute = ucontrol->value.integer.value[0]; pr_debug("%s: mute=%d\n", __func__, mute); voc_set_rx_device_mute(voc_get_session_id(VOICE2_SESSION_NAME), mute); return 0; } static const char const *tty_mode[] = {"OFF", "HCO", "VCO", "FULL"}; static const struct soc_enum msm_tty_mode_enum[] = { SOC_ENUM_SINGLE_EXT(4, tty_mode), }; static int msm_voice_tty_mode_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = voc_get_tty_mode(voc_get_session_id(VOICE_SESSION_NAME)); return 0; } static int msm_voice_tty_mode_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int tty_mode = ucontrol->value.integer.value[0]; pr_debug("%s: tty_mode=%d\n", __func__, tty_mode); voc_set_tty_mode(voc_get_session_id(VOICE_SESSION_NAME), tty_mode); voc_set_tty_mode(voc_get_session_id(VOICE2_SESSION_NAME), tty_mode); voc_set_tty_mode(voc_get_session_id(VOLTE_SESSION_NAME), tty_mode); return 0; } static int msm_voice_slowtalk_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { int st_enable = ucontrol->value.integer.value[0]; pr_debug("%s: st enable=%d\n", __func__, st_enable); voc_set_pp_enable(voc_get_session_id(VOICE_SESSION_NAME), MODULE_ID_VOICE_MODULE_ST, st_enable); voc_set_pp_enable(voc_get_session_id(VOICE2_SESSION_NAME), MODULE_ID_VOICE_MODULE_ST, st_enable); return 0; } static int msm_voice_slowtalk_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = voc_get_pp_enable(voc_get_session_id(VOICE_SESSION_NAME), MODULE_ID_VOICE_MODULE_ST); return 0; } static struct snd_kcontrol_new msm_voice_controls[] = { SOC_SINGLE_EXT("Voice Rx Device Mute", SND_SOC_NOPM, 0, 1, 0, msm_voice_rx_device_mute_get, msm_voice_rx_device_mute_put), SOC_SINGLE_EXT("Voice Tx Mute", SND_SOC_NOPM, 0, 1, 0, msm_voice_mute_get, msm_voice_mute_put), SOC_SINGLE_EXT("Voice Rx Volume", SND_SOC_NOPM, 0, 5, 0, msm_voice_volume_get, msm_voice_volume_put), SOC_SINGLE_MULTI_EXT("Voice Topology Disable", SND_SOC_NOPM, 0, VSID_MAX, 0, 2, msm_voice_topology_disable_get, msm_voice_topology_disable_put), SOC_ENUM_EXT("TTY Mode", msm_tty_mode_enum[0], msm_voice_tty_mode_get, msm_voice_tty_mode_put), SOC_SINGLE_EXT("Slowtalk Enable", SND_SOC_NOPM, 0, 1, 0, msm_voice_slowtalk_get, msm_voice_slowtalk_put), SOC_SINGLE_EXT("VoLTE Rx Device Mute", SND_SOC_NOPM, 0, 1, 0, msm_volte_rx_device_mute_get, msm_volte_rx_device_mute_put), SOC_SINGLE_EXT("VoLTE Tx Mute", SND_SOC_NOPM, 0, 1, 0, msm_volte_mute_get, msm_volte_mute_put), SOC_SINGLE_EXT("VoLTE Rx Volume", SND_SOC_NOPM, 0, 5, 0, msm_volte_volume_get, msm_volte_volume_put), SOC_SINGLE_EXT("Voice2 Rx Device Mute", SND_SOC_NOPM, 0, 1, 0, msm_voice2_rx_device_mute_get, msm_voice2_rx_device_mute_put), SOC_SINGLE_EXT("Voice2 Tx Mute", SND_SOC_NOPM, 0, 1, 0, msm_voice2_mute_get, msm_voice2_mute_put), SOC_SINGLE_EXT("Voice2 Rx Volume", SND_SOC_NOPM, 0, 5, 0, msm_voice2_volume_get, msm_voice2_volume_put), }; static struct snd_pcm_ops msm_pcm_ops = { .open = msm_pcm_open, .hw_params = msm_pcm_hw_params, .close = msm_pcm_close, .prepare = msm_pcm_prepare, .trigger = msm_pcm_trigger, .ioctl = msm_pcm_ioctl, }; static int msm_asoc_pcm_new(struct snd_soc_pcm_runtime *rtd) { struct snd_card *card = rtd->card->snd_card; int ret = 0; if (!card->dev->coherent_dma_mask) card->dev->coherent_dma_mask = DMA_BIT_MASK(32); return ret; } static int msm_pcm_voice_probe(struct snd_soc_platform *platform) { snd_soc_add_platform_controls(platform, msm_voice_controls, ARRAY_SIZE(msm_voice_controls)); return 0; } static struct snd_soc_platform_driver msm_soc_platform = { .ops = &msm_pcm_ops, .pcm_new = msm_asoc_pcm_new, .probe = msm_pcm_voice_probe, }; static __devinit int msm_pcm_probe(struct platform_device *pdev) { if (pdev->dev.of_node) dev_set_name(&pdev->dev, "%s", "msm-pcm-voice"); pr_debug("%s: dev name %s\n", __func__, dev_name(&pdev->dev)); return snd_soc_register_platform(&pdev->dev, &msm_soc_platform); } static int msm_pcm_remove(struct platform_device *pdev) { snd_soc_unregister_platform(&pdev->dev); return 0; } static const struct of_device_id msm_voice_dt_match[] = { {.compatible = "qcom,msm-pcm-voice"}, {} }; MODULE_DEVICE_TABLE(of, msm_voice_dt_match); static struct platform_driver msm_pcm_driver = { .driver = { .name = "msm-pcm-voice", .owner = THIS_MODULE, .of_match_table = msm_voice_dt_match, }, .probe = msm_pcm_probe, .remove = __devexit_p(msm_pcm_remove), }; static int __init msm_soc_platform_init(void) { int i = 0; memset(&voice_info, 0, sizeof(voice_info)); for (i = 0; i < VOICE_SESSION_INDEX_MAX; i++) mutex_init(&voice_info[i].lock); return platform_driver_register(&msm_pcm_driver); } module_init(msm_soc_platform_init); static void __exit msm_soc_platform_exit(void) { platform_driver_unregister(&msm_pcm_driver); } module_exit(msm_soc_platform_exit); MODULE_DESCRIPTION("Voice PCM module platform driver"); MODULE_LICENSE("GPL v2");