1/* hfp.c
2Copyright (c) 2012-2014, The Linux Foundation. All rights reserved.
3
4Redistribution and use in source and binary forms, with or without
5modification, are permitted provided that the following conditions are
6met:
7    * Redistributions of source code must retain the above copyright
8      notice, this list of conditions and the following disclaimer.
9    * Redistributions in binary form must reproduce the above
10      copyright notice, this list of conditions and the following
11      disclaimer in the documentation and/or other materials provided
12      with the distribution.
13    * Neither the name of The Linux Foundation nor the names of its
14      contributors may be used to endorse or promote products derived
15      from this software without specific prior written permission.
16
17THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
18WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
19MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
20ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
21BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
24BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
25WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
26OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
27IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.*/
28
29#define LOG_TAG "audio_hw_hfp"
30/*#define LOG_NDEBUG 0*/
31#define LOG_NDDEBUG 0
32
33#include <errno.h>
34#include <math.h>
35#include <cutils/log.h>
36
37#include "audio_hw.h"
38#include "platform.h"
39#include "platform_api.h"
40#include <stdlib.h>
41#include <cutils/str_parms.h>
42
43#ifdef HFP_ENABLED
44#define AUDIO_PARAMETER_HFP_ENABLE      "hfp_enable"
45#define AUDIO_PARAMETER_HFP_SET_SAMPLING_RATE "hfp_set_sampling_rate"
46#define AUDIO_PARAMETER_KEY_HFP_VOLUME "hfp_volume"
47
48#ifdef PLATFORM_MSM8994
49#define HFP_RX_VOLUME     "SEC AUXPCM LOOPBACK Volume"
50#else
51#define HFP_RX_VOLUME     "Internal HFP RX Volume"
52#endif
53
54static int32_t start_hfp(struct audio_device *adev,
55                               struct str_parms *parms);
56
57static int32_t stop_hfp(struct audio_device *adev);
58
59struct hfp_module {
60    struct pcm *hfp_sco_rx;
61    struct pcm *hfp_sco_tx;
62    struct pcm *hfp_pcm_rx;
63    struct pcm *hfp_pcm_tx;
64    bool is_hfp_running;
65    float hfp_volume;
66    audio_usecase_t ucid;
67};
68
69static struct hfp_module hfpmod = {
70    .hfp_sco_rx = NULL,
71    .hfp_sco_tx = NULL,
72    .hfp_pcm_rx = NULL,
73    .hfp_pcm_tx = NULL,
74    .hfp_volume = 0,
75    .is_hfp_running = 0,
76    .ucid = USECASE_AUDIO_HFP_SCO,
77};
78static struct pcm_config pcm_config_hfp = {
79    .channels = 1,
80    .rate = 8000,
81    .period_size = 240,
82    .period_count = 2,
83    .format = PCM_FORMAT_S16_LE,
84    .start_threshold = 0,
85    .stop_threshold = INT_MAX,
86    .avail_min = 0,
87};
88
89static int32_t hfp_set_volume(struct audio_device *adev, float value)
90{
91    int32_t vol, ret = 0;
92    struct mixer_ctl *ctl;
93    const char *mixer_ctl_name = HFP_RX_VOLUME;
94
95    ALOGV("%s: entry", __func__);
96    ALOGD("%s: (%f)\n", __func__, value);
97
98    hfpmod.hfp_volume = value;
99    if (value < 0.0) {
100        ALOGW("%s: (%f) Under 0.0, assuming 0.0\n", __func__, value);
101        value = 0.0;
102    } else {
103        value = ((value > 15.000000) ? 1.0 : (value / 15));
104        ALOGW("%s: Volume brought with in range (%f)\n", __func__, value);
105    }
106    vol  = lrint((value * 0x2000) + 0.5);
107
108    if (!hfpmod.is_hfp_running) {
109        ALOGV("%s: HFP not active, ignoring set_hfp_volume call", __func__);
110        return -EIO;
111    }
112
113    ALOGD("%s: Setting HFP volume to %d \n", __func__, vol);
114    ctl = mixer_get_ctl_by_name(adev->mixer, mixer_ctl_name);
115    if (!ctl) {
116        ALOGE("%s: Could not get ctl for mixer cmd - %s",
117              __func__, mixer_ctl_name);
118        return -EINVAL;
119    }
120    if(mixer_ctl_set_value(ctl, 0, vol) < 0) {
121        ALOGE("%s: Couldn't set HFP Volume: [%d]", __func__, vol);
122        return -EINVAL;
123    }
124
125    ALOGV("%s: exit", __func__);
126    return ret;
127}
128
129static int32_t start_hfp(struct audio_device *adev,
130                         struct str_parms *parms __unused)
131{
132    int32_t i, ret = 0;
133    struct audio_usecase *uc_info;
134    int32_t pcm_dev_rx_id, pcm_dev_tx_id, pcm_dev_asm_rx_id, pcm_dev_asm_tx_id;
135
136    ALOGD("%s: enter", __func__);
137
138    uc_info = (struct audio_usecase *)calloc(1, sizeof(struct audio_usecase));
139
140    if (!uc_info)
141        return -ENOMEM;
142
143    uc_info->id = hfpmod.ucid;
144    uc_info->type = PCM_HFP_CALL;
145    uc_info->stream.out = adev->primary_output;
146    uc_info->devices = adev->primary_output->devices;
147    uc_info->in_snd_device = SND_DEVICE_NONE;
148    uc_info->out_snd_device = SND_DEVICE_NONE;
149
150    list_add_tail(&adev->usecase_list, &uc_info->list);
151
152    select_devices(adev, hfpmod.ucid);
153
154    pcm_dev_rx_id = platform_get_pcm_device_id(uc_info->id, PCM_PLAYBACK);
155    pcm_dev_tx_id = platform_get_pcm_device_id(uc_info->id, PCM_CAPTURE);
156    pcm_dev_asm_rx_id = HFP_ASM_RX_TX;
157    pcm_dev_asm_tx_id = HFP_ASM_RX_TX;
158    if (pcm_dev_rx_id < 0 || pcm_dev_tx_id < 0 ||
159        pcm_dev_asm_rx_id < 0 || pcm_dev_asm_tx_id < 0 ) {
160        ALOGE("%s: Invalid PCM devices (rx: %d tx: %d asm: rx tx %d) for the usecase(%d)",
161              __func__, pcm_dev_rx_id, pcm_dev_tx_id, pcm_dev_asm_rx_id, uc_info->id);
162        ret = -EIO;
163        goto exit;
164    }
165
166    ALOGV("%s: HFP PCM devices (hfp rx tx: %d pcm rx tx: %d) for the usecase(%d)",
167              __func__, pcm_dev_rx_id, pcm_dev_tx_id, uc_info->id);
168
169    ALOGV("%s: Opening PCM playback device card_id(%d) device_id(%d)",
170          __func__, adev->snd_card, pcm_dev_asm_rx_id);
171    hfpmod.hfp_sco_rx = pcm_open(adev->snd_card,
172                                  pcm_dev_asm_rx_id,
173                                  PCM_OUT, &pcm_config_hfp);
174    if (hfpmod.hfp_sco_rx && !pcm_is_ready(hfpmod.hfp_sco_rx)) {
175        ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_sco_rx));
176        ret = -EIO;
177        goto exit;
178    }
179    ALOGD("%s: Opening PCM capture device card_id(%d) device_id(%d)",
180          __func__, adev->snd_card, pcm_dev_tx_id);
181    hfpmod.hfp_pcm_rx = pcm_open(adev->snd_card,
182                                   pcm_dev_rx_id,
183                                   PCM_OUT, &pcm_config_hfp);
184    if (hfpmod.hfp_pcm_rx && !pcm_is_ready(hfpmod.hfp_pcm_rx)) {
185        ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_pcm_rx));
186        ret = -EIO;
187        goto exit;
188    }
189    hfpmod.hfp_sco_tx = pcm_open(adev->snd_card,
190                                  pcm_dev_asm_tx_id,
191                                  PCM_IN, &pcm_config_hfp);
192    if (hfpmod.hfp_sco_tx && !pcm_is_ready(hfpmod.hfp_sco_tx)) {
193        ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_sco_tx));
194        ret = -EIO;
195        goto exit;
196    }
197    ALOGV("%s: Opening PCM capture device card_id(%d) device_id(%d)",
198          __func__, adev->snd_card, pcm_dev_tx_id);
199    hfpmod.hfp_pcm_tx = pcm_open(adev->snd_card,
200                                   pcm_dev_tx_id,
201                                   PCM_IN, &pcm_config_hfp);
202    if (hfpmod.hfp_pcm_tx && !pcm_is_ready(hfpmod.hfp_pcm_tx)) {
203        ALOGE("%s: %s", __func__, pcm_get_error(hfpmod.hfp_pcm_tx));
204        ret = -EIO;
205        goto exit;
206    }
207    if (pcm_start(hfpmod.hfp_sco_rx) < 0) {
208        ALOGE("%s: pcm start for hfp sco rx failed", __func__);
209        ret = -EINVAL;
210        goto exit;
211    }
212    if (pcm_start(hfpmod.hfp_sco_tx) < 0) {
213        ALOGE("%s: pcm start for hfp sco tx failed", __func__);
214        ret = -EINVAL;
215        goto exit;
216    }
217    if (pcm_start(hfpmod.hfp_pcm_rx) < 0) {
218        ALOGE("%s: pcm start for hfp pcm rx failed", __func__);
219        ret = -EINVAL;
220        goto exit;
221    }
222    if (pcm_start(hfpmod.hfp_pcm_tx) < 0) {
223        ALOGE("%s: pcm start for hfp pcm tx failed", __func__);
224        ret = -EINVAL;
225        goto exit;
226    }
227
228    hfpmod.is_hfp_running = true;
229    hfp_set_volume(adev, hfpmod.hfp_volume);
230
231    ALOGD("%s: exit: status(%d)", __func__, ret);
232    return 0;
233
234exit:
235    stop_hfp(adev);
236    ALOGE("%s: Problem in HFP start: status(%d)", __func__, ret);
237    return ret;
238}
239
240static int32_t stop_hfp(struct audio_device *adev)
241{
242    int32_t i, ret = 0;
243    struct audio_usecase *uc_info;
244
245    ALOGD("%s: enter", __func__);
246    hfpmod.is_hfp_running = false;
247
248    /* 1. Close the PCM devices */
249    if (hfpmod.hfp_sco_rx) {
250        pcm_close(hfpmod.hfp_sco_rx);
251        hfpmod.hfp_sco_rx = NULL;
252    }
253    if (hfpmod.hfp_sco_tx) {
254        pcm_close(hfpmod.hfp_sco_tx);
255        hfpmod.hfp_sco_tx = NULL;
256    }
257    if (hfpmod.hfp_pcm_rx) {
258        pcm_close(hfpmod.hfp_pcm_rx);
259        hfpmod.hfp_pcm_rx = NULL;
260    }
261    if (hfpmod.hfp_pcm_tx) {
262        pcm_close(hfpmod.hfp_pcm_tx);
263        hfpmod.hfp_pcm_tx = NULL;
264    }
265
266    uc_info = get_usecase_from_list(adev, hfpmod.ucid);
267    if (uc_info == NULL) {
268        ALOGE("%s: Could not find the usecase (%d) in the list",
269              __func__, hfpmod.ucid);
270        return -EINVAL;
271    }
272
273    /* 2. Disable echo reference while stopping hfp */
274    platform_set_echo_reference(adev->platform, false);
275
276    /* 3. Get and set stream specific mixer controls */
277    disable_audio_route(adev, uc_info);
278
279    /* 4. Disable the rx and tx devices */
280    disable_snd_device(adev, uc_info->out_snd_device);
281    disable_snd_device(adev, uc_info->in_snd_device);
282
283    list_remove(&uc_info->list);
284    free(uc_info);
285
286    ALOGD("%s: exit: status(%d)", __func__, ret);
287    return ret;
288}
289
290bool audio_extn_hfp_is_active(struct audio_device *adev)
291{
292    struct audio_usecase *hfp_usecase = NULL;
293    hfp_usecase = get_usecase_from_list(adev, hfpmod.ucid);
294
295    if (hfp_usecase != NULL)
296        return true;
297    else
298        return false;
299}
300
301audio_usecase_t audio_extn_hfp_get_usecase()
302{
303    return hfpmod.ucid;
304}
305
306void audio_extn_hfp_set_parameters(struct audio_device *adev, struct str_parms *parms)
307{
308    int ret;
309    int rate;
310    int val;
311    float vol;
312    char value[32]={0};
313
314    ret = str_parms_get_str(parms, AUDIO_PARAMETER_HFP_ENABLE, value,
315                            sizeof(value));
316    if (ret >= 0) {
317           if (!strncmp(value,"true",sizeof(value)))
318               ret = start_hfp(adev,parms);
319           else
320               stop_hfp(adev);
321    }
322    memset(value, 0, sizeof(value));
323    ret = str_parms_get_str(parms,AUDIO_PARAMETER_HFP_SET_SAMPLING_RATE, value,
324                            sizeof(value));
325    if (ret >= 0) {
326           rate = atoi(value);
327           if (rate == 8000){
328               hfpmod.ucid = USECASE_AUDIO_HFP_SCO;
329               pcm_config_hfp.rate = rate;
330           } else if (rate == 16000){
331               hfpmod.ucid = USECASE_AUDIO_HFP_SCO_WB;
332               pcm_config_hfp.rate = rate;
333           } else
334               ALOGE("Unsupported rate..");
335    }
336
337    if (hfpmod.is_hfp_running) {
338        memset(value, 0, sizeof(value));
339        ret = str_parms_get_str(parms, AUDIO_PARAMETER_STREAM_ROUTING,
340                                value, sizeof(value));
341        if (ret >= 0) {
342            val = atoi(value);
343            if (val > 0)
344                select_devices(adev, hfpmod.ucid);
345        }
346    }
347
348    memset(value, 0, sizeof(value));
349    ret = str_parms_get_str(parms, AUDIO_PARAMETER_KEY_HFP_VOLUME,
350                            value, sizeof(value));
351    if (ret >= 0) {
352        if (sscanf(value, "%f", &vol) != 1){
353            ALOGE("%s: error in retrieving hfp volume", __func__);
354            ret = -EIO;
355            goto exit;
356        }
357        ALOGD("%s: set_hfp_volume usecase, Vol: [%f]", __func__, vol);
358        hfp_set_volume(adev, vol);
359    }
360exit:
361    ALOGV("%s Exit",__func__);
362}
363#endif /*HFP_ENABLED*/
364