18e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda/* 28e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * Copyright (C) 2014 The Android Open Source Project 38e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * 48e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * Licensed under the Apache License, Version 2.0 (the "License"); 58e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * you may not use this file except in compliance with the License. 68e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * You may obtain a copy of the License at 78e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * 88e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * http://www.apache.org/licenses/LICENSE-2.0 98e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * 108e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * Unless required by applicable law or agreed to in writing, software 118e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * distributed under the License is distributed on an "AS IS" BASIS, 128e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 138e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * See the License for the specific language governing permissions and 148e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda * limitations under the License. 158e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda */ 168e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 178e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#define LOG_TAG "audio_hw_hfp" 188e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda/*#define LOG_NDEBUG 0*/ 198e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#define LOG_NDDEBUG 0 208e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 218e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include <errno.h> 228e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include <math.h> 238e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include <cutils/log.h> 248e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 258e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include "audio_hw.h" 268e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include "platform.h" 278e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include "platform_api.h" 288e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include <stdlib.h> 298e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#include <cutils/str_parms.h> 308e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 318e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#define AUDIO_PARAMETER_HFP_ENABLE "hfp_enable" 328e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#define AUDIO_PARAMETER_HFP_SET_SAMPLING_RATE "hfp_set_sampling_rate" 338e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda#define AUDIO_PARAMETER_KEY_HFP_VOLUME "hfp_volume" 348e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 358e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic int32_t start_hfp(struct audio_device *adev, 368e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct str_parms *parms); 378e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 388e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic int32_t stop_hfp(struct audio_device *adev); 398e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 408e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastruct hfp_module { 418e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct pcm *hfp_sco_rx; 428e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct pcm *hfp_sco_tx; 438e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct pcm *hfp_pcm_rx; 448e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct pcm *hfp_pcm_tx; 458e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda float hfp_volume; 468e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda bool is_hfp_running; 478e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda audio_usecase_t ucid; 488e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda}; 498e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 508e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic struct hfp_module hfpmod = { 518e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .hfp_sco_rx = NULL, 528e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .hfp_sco_tx = NULL, 538e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .hfp_pcm_rx = NULL, 548e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .hfp_pcm_tx = NULL, 558e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .hfp_volume = 0, 568e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .is_hfp_running = 0, 578e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .ucid = USECASE_AUDIO_HFP_SCO, 588e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda}; 598e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic struct pcm_config pcm_config_hfp = { 608e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .channels = 1, 618e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .rate = 8000, 628e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .period_size = 240, 638e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .period_count = 2, 648e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .format = PCM_FORMAT_S16_LE, 658e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .start_threshold = 0, 668e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .stop_threshold = INT_MAX, 678e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda .avail_min = 0, 688e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda}; 698e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 708e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic int32_t hfp_set_volume(struct audio_device *adev, float value) 718e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda{ 728e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int32_t vol, ret = 0; 738e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct mixer_ctl *ctl; 748e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda const char *mixer_ctl_name = "Internal HFP RX Volume"; 758e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 768e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s: entry", __func__); 778e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: (%f)\n", __func__, value); 788e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 798e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (value < 0.0) { 808e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGW("%s: (%f) Under 0.0, assuming 0.0\n", __func__, value); 818e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda value = 0.0; 828e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } else { 838e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda value = ((value > 15.000000) ? 1.0 : (value / 15)); 848e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGW("%s: Volume brought with in range (%f)\n", __func__, value); 858e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 868e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda vol = lrint((value * 0x2000) + 0.5); 878e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.hfp_volume = value; 888e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 898e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (!hfpmod.is_hfp_running) { 908e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s: HFP not active, ignoring set_hfp_volume call", __func__); 918e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return -EIO; 928e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 938e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 948e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: Setting HFP volume to %d \n", __func__, vol); 958e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ctl = mixer_get_ctl_by_name(adev->mixer, mixer_ctl_name); 968e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (!ctl) { 978e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: Could not get ctl for mixer cmd - %s", 988e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda __func__, mixer_ctl_name); 998e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return -EINVAL; 1008e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1018e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if(mixer_ctl_set_value(ctl, 0, vol) < 0) { 1028e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: Couldn't set HFP Volume: [%d]", __func__, vol); 1038e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return -EINVAL; 1048e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1058e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1068e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s: exit", __func__); 1078e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return ret; 1088e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda} 1098e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1108e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic int32_t start_hfp(struct audio_device *adev, 111cc9649b4f1e7d109ed005819971c3d9657a19711Haynes Mathew George struct str_parms *parms __unused) 1128e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda{ 1138e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int32_t i, ret = 0; 1148e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct audio_usecase *uc_info; 1158e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int32_t pcm_dev_rx_id, pcm_dev_tx_id, pcm_dev_asm_rx_id, pcm_dev_asm_tx_id; 1168e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1178e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: enter", __func__); 1188e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1198e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info = (struct audio_usecase *)calloc(1, sizeof(struct audio_usecase)); 1208e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info->id = hfpmod.ucid; 1218e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info->type = PCM_HFP_CALL; 1228e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info->stream.out = adev->primary_output; 1238e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info->devices = adev->primary_output->devices; 1248e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info->in_snd_device = SND_DEVICE_NONE; 1258e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info->out_snd_device = SND_DEVICE_NONE; 1268e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1278e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda list_add_tail(&adev->usecase_list, &uc_info->list); 1288e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1298e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda select_devices(adev, hfpmod.ucid); 1308e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1318e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_rx_id = platform_get_pcm_device_id(uc_info->id, PCM_PLAYBACK); 1328e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_tx_id = platform_get_pcm_device_id(uc_info->id, PCM_CAPTURE); 1338e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_asm_rx_id = HFP_ASM_RX_TX; 1348e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_asm_tx_id = HFP_ASM_RX_TX; 1358e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (pcm_dev_rx_id < 0 || pcm_dev_tx_id < 0 || 1368e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_asm_rx_id < 0 || pcm_dev_asm_tx_id < 0 ) { 1378e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: Invalid PCM devices (rx: %d tx: %d asm: rx tx %d) for the usecase(%d)", 1388e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda __func__, pcm_dev_rx_id, pcm_dev_tx_id, pcm_dev_asm_rx_id, uc_info->id); 1398e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = -EIO; 1408e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda goto exit; 1418e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1428e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1438e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s: HFP PCM devices (hfp rx tx: %d pcm rx tx: %d) for the usecase(%d)", 1448e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda __func__, pcm_dev_rx_id, pcm_dev_tx_id, uc_info->id); 1458e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1468e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s: Opening PCM playback device card_id(%d) device_id(%d)", 1474b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava __func__, adev->snd_card, pcm_dev_rx_id); 1484b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava hfpmod.hfp_sco_rx = pcm_open(adev->snd_card, 1498e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_asm_rx_id, 1508e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda PCM_OUT, &pcm_config_hfp); 1518e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_sco_rx && !pcm_is_ready(hfpmod.hfp_sco_rx)) { 1528e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_sco_rx)); 1538e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = -EIO; 1548e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda goto exit; 1558e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1568e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: Opening PCM capture device card_id(%d) device_id(%d)", 1574b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava __func__, adev->snd_card, pcm_dev_tx_id); 1584b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava hfpmod.hfp_pcm_rx = pcm_open(adev->snd_card, 1598e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_rx_id, 1608e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda PCM_OUT, &pcm_config_hfp); 1618e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_pcm_rx && !pcm_is_ready(hfpmod.hfp_pcm_rx)) { 1628e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_pcm_rx)); 1638e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = -EIO; 1648e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda goto exit; 1658e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1664b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava hfpmod.hfp_sco_tx = pcm_open(adev->snd_card, 1678e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_asm_tx_id, 1688e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda PCM_IN, &pcm_config_hfp); 1698e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_sco_tx && !pcm_is_ready(hfpmod.hfp_sco_tx)) { 1708e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_sco_tx)); 1718e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = -EIO; 1728e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda goto exit; 1738e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1748e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s: Opening PCM capture device card_id(%d) device_id(%d)", 1754b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava __func__, adev->snd_card, pcm_dev_tx_id); 1764b89e37ad290ef955abf8ac1d151728303311345Vineeta Srivastava hfpmod.hfp_pcm_tx = pcm_open(adev->snd_card, 1778e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_dev_tx_id, 1788e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda PCM_IN, &pcm_config_hfp); 1798e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_pcm_tx && !pcm_is_ready(hfpmod.hfp_pcm_tx)) { 1808e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_pcm_tx)); 1818e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = -EIO; 1828e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda goto exit; 1838e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 1848e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_start(hfpmod.hfp_sco_rx); 1858e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_start(hfpmod.hfp_sco_tx); 1868e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_start(hfpmod.hfp_pcm_rx); 1878e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_start(hfpmod.hfp_pcm_tx); 1888e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1898e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.is_hfp_running = true; 1908e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfp_set_volume(adev, hfpmod.hfp_volume); 1918e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1928e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: exit: status(%d)", __func__, ret); 1938e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return 0; 1948e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 1958e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandaexit: 1968e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda stop_hfp(adev); 1978e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: Problem in HFP start: status(%d)", __func__, ret); 1988e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return ret; 1998e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda} 2008e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2018e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandastatic int32_t stop_hfp(struct audio_device *adev) 2028e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda{ 2038e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int32_t i, ret = 0; 2048e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct audio_usecase *uc_info; 2058e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2068e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: enter", __func__); 2078e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.is_hfp_running = false; 2088e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2098e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda /* 1. Close the PCM devices */ 2108e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_sco_rx) { 2118e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_close(hfpmod.hfp_sco_rx); 2128e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.hfp_sco_rx = NULL; 2138e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2148e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_sco_tx) { 2158e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_close(hfpmod.hfp_sco_tx); 2168e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.hfp_sco_tx = NULL; 2178e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2188e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_pcm_rx) { 2198e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_close(hfpmod.hfp_pcm_rx); 2208e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.hfp_pcm_rx = NULL; 2218e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2228e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.hfp_pcm_tx) { 2238e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_close(hfpmod.hfp_pcm_tx); 2248e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.hfp_pcm_tx = NULL; 2258e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2268e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2278e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda uc_info = get_usecase_from_list(adev, hfpmod.ucid); 2288e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (uc_info == NULL) { 2298e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: Could not find the usecase (%d) in the list", 2308e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda __func__, hfpmod.ucid); 2318e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return -EINVAL; 2328e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2338e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2348e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda /* 2. Get and set stream specific mixer controls */ 2358e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda disable_audio_route(adev, uc_info); 2368e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2378e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda /* 3. Disable the rx and tx devices */ 2388e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda disable_snd_device(adev, uc_info->out_snd_device); 2398e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda disable_snd_device(adev, uc_info->in_snd_device); 2408e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2418e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda list_remove(&uc_info->list); 2428e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda free(uc_info); 2438e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2448e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: exit: status(%d)", __func__, ret); 2458e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return ret; 2468e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda} 2478e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2488e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandabool audio_extn_hfp_is_active(struct audio_device *adev) 2498e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda{ 2508e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda struct audio_usecase *hfp_usecase = NULL; 2518e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfp_usecase = get_usecase_from_list(adev, hfpmod.ucid); 2528e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2538e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfp_usecase != NULL) 2548e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return true; 2558e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda else 2568e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return false; 2578e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda} 2588e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2598e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandaaudio_usecase_t audio_extn_hfp_get_usecase() 2608e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda{ 2618e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda return hfpmod.ucid; 2628e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda} 2638e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2648e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandavoid audio_extn_hfp_set_parameters(struct audio_device *adev, struct str_parms *parms) 2658e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda{ 2668e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int ret; 2678e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int rate; 2688e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda int val; 2698e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda float vol; 2708e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda char value[32]={0}; 2718e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2728e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = str_parms_get_str(parms, AUDIO_PARAMETER_HFP_ENABLE, value, 2738e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda sizeof(value)); 2748e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (ret >= 0) { 2758e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (!strncmp(value,"true",sizeof(value))) 2768e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = start_hfp(adev,parms); 2778e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda else 2788e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda stop_hfp(adev); 2798e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2808e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda memset(value, 0, sizeof(value)); 2818e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = str_parms_get_str(parms,AUDIO_PARAMETER_HFP_SET_SAMPLING_RATE, value, 2828e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda sizeof(value)); 2838e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (ret >= 0) { 2848e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda rate = atoi(value); 2858e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (rate == 8000){ 2868e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.ucid = USECASE_AUDIO_HFP_SCO; 2878e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_config_hfp.rate = rate; 2888e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } else if (rate == 16000){ 2898e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfpmod.ucid = USECASE_AUDIO_HFP_SCO_WB; 2908e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda pcm_config_hfp.rate = rate; 2918e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } else 2928e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("Unsupported rate.."); 2938e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 2948e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 2958e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (hfpmod.is_hfp_running) { 2968e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda memset(value, 0, sizeof(value)); 2978e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = str_parms_get_str(parms, AUDIO_PARAMETER_STREAM_ROUTING, 2988e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda value, sizeof(value)); 2998e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (ret >= 0) { 3008e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda val = atoi(value); 3018e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (val > 0) 3028e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda select_devices(adev, hfpmod.ucid); 3038e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 3048e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 3058e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda 3068e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda memset(value, 0, sizeof(value)); 3078e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = str_parms_get_str(parms, AUDIO_PARAMETER_KEY_HFP_VOLUME, 3088e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda value, sizeof(value)); 3098e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (ret >= 0) { 3108e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda if (sscanf(value, "%f", &vol) != 1){ 3118e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGE("%s: error in retrieving hfp volume", __func__); 3128e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ret = -EIO; 3138e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda goto exit; 3148e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 3158e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGD("%s: set_hfp_volume usecase, Vol: [%f]", __func__, vol); 3168e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda hfp_set_volume(adev, vol); 3178e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda } 3188e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamandaexit: 3198e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda ALOGV("%s Exit",__func__); 3208e6e98fc5af6d6f79bc71eb37df470380ae82fadRavi Kumar Alamanda} 321