Fix set_devices() to ensure resetting active devices info. before adding new device
[platform/adaptation/spreadtrum/audio-hal-sc7727.git] / tizen-audio-util.c
1 /*
2  * audio-hal
3  *
4  * Copyright (c) 2000 - 2013 Samsung Electronics Co., Ltd. All rights reserved.
5  *
6  * Licensed under the Apache License, Version 2.0 (the "License");
7  * you may not use this file except in compliance with the License.
8  * You may obtain a copy of the License at
9  *
10  * http://www.apache.org/licenses/LICENSE-2.0
11  *
12  * Unless required by applicable law or agreed to in writing, software
13  * distributed under the License is distributed on an "AS IS" BASIS,
14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15  * See the License for the specific language governing permissions and
16  * limitations under the License.
17  *
18  */
19
20 #ifdef HAVE_CONFIG_H
21 #include <config.h>
22 #endif
23
24 #include <stdio.h>
25 #include <stdlib.h>
26 #include <string.h>
27 #include <pthread.h>
28
29 #include "tizen-audio-internal.h"
30
31 audio_return_t _audio_util_init(audio_hal_t *ah)
32 {
33     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
34
35     pthread_mutex_init(&(ah->mixer.mutex), NULL);
36     return AUDIO_RET_OK;
37 }
38
39 audio_return_t _audio_util_deinit(audio_hal_t *ah)
40 {
41     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
42
43     pthread_mutex_destroy(&(ah->mixer.mutex));
44     return AUDIO_RET_OK;
45 }
46
47 #ifdef __MIXER_PARAM_DUMP
48
49 static void __dump_mixer_param(char *dump, long *param, int size)
50 {
51     int i, len;
52
53     for (i = 0; i < size; i++) {
54         len = sprintf(dump, "%ld", *param);
55         if (len > 0)
56             dump += len;
57         if (i != size -1) {
58             *dump++ = ',';
59         }
60
61         param++;
62     }
63     *dump = '\0';
64 }
65
66 #endif
67
68 audio_return_t _audio_mixer_control_set_param(audio_hal_t *ah, const char* ctl_name, snd_ctl_elem_value_t* param, int size)
69 {
70     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
71
72     /* TODO. */
73     return AUDIO_RET_OK;
74 }
75
76 audio_return_t _audio_mixer_control_get_value(audio_hal_t *ah, const char *ctl_name, int *val)
77 {
78     snd_ctl_t *handle;
79     snd_ctl_elem_value_t *control;
80     snd_ctl_elem_id_t *id;
81     snd_ctl_elem_info_t *info;
82     snd_ctl_elem_type_t type;
83
84     int ret = 0, count = 0, i = 0;
85
86     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
87
88     pthread_mutex_lock(&(ah->mixer.mutex));
89
90     ret = snd_ctl_open(&handle, ALSA_DEFAULT_CARD, 0);
91     if (ret < 0) {
92         AUDIO_LOG_ERROR("snd_ctl_open error, %s\n", snd_strerror(ret));
93         pthread_mutex_unlock(&(ah->mixer.mutex));
94         return AUDIO_ERR_IOCTL;
95     }
96
97     // Get Element Info
98
99     snd_ctl_elem_id_alloca(&id);
100     snd_ctl_elem_info_alloca(&info);
101     snd_ctl_elem_value_alloca(&control);
102
103     snd_ctl_elem_id_set_interface(id, SND_CTL_ELEM_IFACE_MIXER);
104     snd_ctl_elem_id_set_name(id, ctl_name);
105
106     snd_ctl_elem_info_set_id(info, id);
107     if (snd_ctl_elem_info(handle, info) < 0) {
108         AUDIO_LOG_ERROR("Cannot find control element: %s\n", ctl_name);
109         goto close;
110     }
111     snd_ctl_elem_info_get_id(info, id);
112
113     type = snd_ctl_elem_info_get_type(info);
114     count = snd_ctl_elem_info_get_count(info);
115
116     snd_ctl_elem_value_set_id(control, id);
117
118     if (snd_ctl_elem_read(handle, control) < 0) {
119         AUDIO_LOG_ERROR("snd_ctl_elem_read failed \n");
120         goto close;
121 }
122
123     switch (type) {
124     case SND_CTL_ELEM_TYPE_BOOLEAN:
125         *val = snd_ctl_elem_value_get_boolean(control, i);
126         break;
127     case SND_CTL_ELEM_TYPE_INTEGER:
128         for (i = 0; i < count; i++)
129         *val = snd_ctl_elem_value_get_integer(control, i);
130         break;
131     case SND_CTL_ELEM_TYPE_ENUMERATED:
132         for (i = 0; i < count; i++)
133         *val = snd_ctl_elem_value_get_enumerated(control, i);
134         break;
135     default:
136         AUDIO_LOG_WARN("unsupported control element type\n");
137         goto close;
138     }
139
140     snd_ctl_close(handle);
141
142 #ifdef AUDIO_DEBUG
143     AUDIO_LOG_INFO("get mixer(%s) = %d success", ctl_name, *val);
144 #endif
145
146     pthread_mutex_unlock(&(ah->mixer.mutex));
147     return AUDIO_RET_OK;
148
149 close:
150     AUDIO_LOG_ERROR("Error\n");
151     snd_ctl_close(handle);
152     pthread_mutex_unlock(&(ah->mixer.mutex));
153     return AUDIO_ERR_UNDEFINED;
154 }
155
156 audio_return_t _audio_mixer_control_set_value(audio_hal_t *ah, const char *ctl_name, int val)
157 {
158     snd_ctl_t *handle;
159     snd_ctl_elem_value_t *control;
160     snd_ctl_elem_id_t *id;
161     snd_ctl_elem_info_t *info;
162     snd_ctl_elem_type_t type;
163     int ret = 0, count = 0, i = 0;
164
165     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
166     AUDIO_RETURN_VAL_IF_FAIL(ctl_name, AUDIO_ERR_PARAMETER);
167
168     pthread_mutex_lock(&(ah->mixer.mutex));
169
170     ret = snd_ctl_open(&handle, ALSA_DEFAULT_CARD, 0);
171     if (ret < 0) {
172         AUDIO_LOG_ERROR("snd_ctl_open error, card: %s: %s", ALSA_DEFAULT_CARD, snd_strerror(ret));
173         pthread_mutex_unlock(&(ah->mixer.mutex));
174         return AUDIO_ERR_IOCTL;
175     }
176
177     // Get Element Info
178
179     snd_ctl_elem_id_alloca(&id);
180     snd_ctl_elem_info_alloca(&info);
181     snd_ctl_elem_value_alloca(&control);
182
183     snd_ctl_elem_id_set_interface(id, SND_CTL_ELEM_IFACE_MIXER);
184     snd_ctl_elem_id_set_name(id, ctl_name);
185
186     snd_ctl_elem_info_set_id(info, id);
187     if (snd_ctl_elem_info(handle, info) < 0) {
188         AUDIO_LOG_ERROR("Cannot find control element: %s", ctl_name);
189         goto close;
190     }
191     snd_ctl_elem_info_get_id(info, id);
192
193     type = snd_ctl_elem_info_get_type(info);
194     count = snd_ctl_elem_info_get_count(info);
195
196     snd_ctl_elem_value_set_id(control, id);
197
198     snd_ctl_elem_read(handle, control);
199
200     switch (type) {
201     case SND_CTL_ELEM_TYPE_BOOLEAN:
202         for (i = 0; i < count; i++)
203             snd_ctl_elem_value_set_boolean(control, i, val);
204         break;
205     case SND_CTL_ELEM_TYPE_INTEGER:
206         for (i = 0; i < count; i++)
207             snd_ctl_elem_value_set_integer(control, i, val);
208         break;
209     case SND_CTL_ELEM_TYPE_ENUMERATED:
210         for (i = 0; i < count; i++)
211             snd_ctl_elem_value_set_enumerated(control, i, val);
212         break;
213
214     default:
215         AUDIO_LOG_WARN("unsupported control element type");
216         goto close;
217     }
218
219     snd_ctl_elem_write(handle, control);
220
221     snd_ctl_close(handle);
222
223     AUDIO_LOG_INFO("set mixer(%s) = %d success", ctl_name, val);
224
225     pthread_mutex_unlock(&(ah->mixer.mutex));
226     return AUDIO_RET_OK;
227
228 close:
229     AUDIO_LOG_ERROR("Error");
230     snd_ctl_close(handle);
231     pthread_mutex_unlock(&(ah->mixer.mutex));
232     return AUDIO_ERR_UNDEFINED;
233 }
234
235 audio_return_t _audio_mixer_control_set_value_string(audio_hal_t *ah, const char* ctl_name, const char* value)
236 {
237     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
238     AUDIO_RETURN_VAL_IF_FAIL(ctl_name, AUDIO_ERR_PARAMETER);
239
240     /* TODO. */
241     return AUDIO_RET_OK;
242 }
243
244
245 audio_return_t _audio_mixer_control_get_element(audio_hal_t *ah, const char *ctl_name, snd_hctl_elem_t **elem)
246 {
247     AUDIO_RETURN_VAL_IF_FAIL(ah, AUDIO_ERR_PARAMETER);
248     AUDIO_RETURN_VAL_IF_FAIL(ctl_name, AUDIO_ERR_PARAMETER);
249     AUDIO_RETURN_VAL_IF_FAIL(elem, AUDIO_ERR_PARAMETER);
250
251     /* TODO. */
252     return AUDIO_RET_OK;
253 }
254
255 #ifdef __USE_TINYALSA__
256 /* Convert pcm format from pulse to alsa */
257 static const uint32_t g_format_convert_table[] = {
258     [AUDIO_SAMPLE_U8]        = PCM_FORMAT_S8,
259     [AUDIO_SAMPLE_S16LE]     = PCM_FORMAT_S16_LE,
260     [AUDIO_SAMPLE_S32LE]     = PCM_FORMAT_S32_LE,
261     [AUDIO_SAMPLE_S24_32LE]  = PCM_FORMAT_S24_LE
262 };
263 #else  /* alsa-lib */
264 /* Convert pcm format from pulse to alsa */
265 static const uint32_t g_format_convert_table[] = {
266     [AUDIO_SAMPLE_U8]        = SND_PCM_FORMAT_U8,
267     [AUDIO_SAMPLE_ALAW]      = SND_PCM_FORMAT_A_LAW,
268     [AUDIO_SAMPLE_ULAW]      = SND_PCM_FORMAT_MU_LAW,
269     [AUDIO_SAMPLE_S16LE]     = SND_PCM_FORMAT_S16_LE,
270     [AUDIO_SAMPLE_S16BE]     = SND_PCM_FORMAT_S16_BE,
271     [AUDIO_SAMPLE_FLOAT32LE] = SND_PCM_FORMAT_FLOAT_LE,
272     [AUDIO_SAMPLE_FLOAT32BE] = SND_PCM_FORMAT_FLOAT_BE,
273     [AUDIO_SAMPLE_S32LE]     = SND_PCM_FORMAT_S32_LE,
274     [AUDIO_SAMPLE_S32BE]     = SND_PCM_FORMAT_S32_BE,
275     [AUDIO_SAMPLE_S24LE]     = SND_PCM_FORMAT_S24_3LE,
276     [AUDIO_SAMPLE_S24BE]     = SND_PCM_FORMAT_S24_3BE,
277     [AUDIO_SAMPLE_S24_32LE]  = SND_PCM_FORMAT_S24_LE,
278     [AUDIO_SAMPLE_S24_32BE]  = SND_PCM_FORMAT_S24_BE
279 };
280 #endif
281
282 uint32_t _convert_format(audio_sample_format_t format)
283 {
284     return g_format_convert_table[format];
285 }
286
287 /* Generic snd pcm interface APIs */
288 audio_return_t _audio_pcm_set_hw_params(snd_pcm_t *pcm, audio_pcm_sample_spec_t *sample_spec, uint8_t *use_mmap, snd_pcm_uframes_t *period_size, snd_pcm_uframes_t *buffer_size)
289 {
290     audio_return_t ret = AUDIO_RET_OK;
291     snd_pcm_hw_params_t *hwparams;
292     int err = 0;
293     int dir;
294     unsigned int val = 0;
295     snd_pcm_uframes_t _period_size = period_size ? *period_size : 0;
296     snd_pcm_uframes_t _buffer_size = buffer_size ? *buffer_size : 0;
297     uint8_t _use_mmap = use_mmap && *use_mmap;
298     uint32_t channels = 0;
299
300     AUDIO_RETURN_VAL_IF_FAIL(pcm, AUDIO_ERR_PARAMETER);
301
302     snd_pcm_hw_params_alloca(&hwparams);
303
304     /* Skip parameter setting to null device. */
305     if (snd_pcm_type(pcm) == SND_PCM_TYPE_NULL)
306         return AUDIO_ERR_IOCTL;
307
308     /* Allocate a hardware parameters object. */
309     snd_pcm_hw_params_alloca(&hwparams);
310
311     /* Fill it in with default values. */
312     if (snd_pcm_hw_params_any(pcm, hwparams) < 0) {
313         AUDIO_LOG_ERROR("snd_pcm_hw_params_any() : failed! - %s\n", snd_strerror(err));
314         goto error;
315     }
316
317     /* Set the desired hardware parameters. */
318
319     if (_use_mmap) {
320
321         if (snd_pcm_hw_params_set_access(pcm, hwparams, SND_PCM_ACCESS_MMAP_INTERLEAVED) < 0) {
322
323             /* mmap() didn't work, fall back to interleaved */
324
325             if ((ret = snd_pcm_hw_params_set_access(pcm, hwparams, SND_PCM_ACCESS_RW_INTERLEAVED)) < 0) {
326                 AUDIO_LOG_DEBUG("snd_pcm_hw_params_set_access() failed: %s", snd_strerror(ret));
327                 goto error;
328             }
329
330             _use_mmap = 0;
331         }
332
333     } else if ((ret = snd_pcm_hw_params_set_access(pcm, hwparams, SND_PCM_ACCESS_RW_INTERLEAVED)) < 0) {
334         AUDIO_LOG_DEBUG("snd_pcm_hw_params_set_access() failed: %s", snd_strerror(ret));
335         goto error;
336     }
337     AUDIO_LOG_DEBUG("setting rate - %d", sample_spec->rate);
338     err = snd_pcm_hw_params_set_rate(pcm, hwparams, sample_spec->rate, 0);
339     if (err < 0) {
340         AUDIO_LOG_ERROR("snd_pcm_hw_params_set_rate() : failed! - %s\n", snd_strerror(err));
341     }
342
343     err = snd_pcm_hw_params(pcm, hwparams);
344     if (err < 0) {
345         AUDIO_LOG_ERROR("snd_pcm_hw_params() : failed! - %s\n", snd_strerror(err));
346         goto error;
347     }
348
349     /* Dump current param */
350
351     if ((ret = snd_pcm_hw_params_current(pcm, hwparams)) < 0) {
352         AUDIO_LOG_INFO("snd_pcm_hw_params_current() failed: %s", snd_strerror(ret));
353         goto error;
354     }
355
356     if ((ret = snd_pcm_hw_params_get_period_size(hwparams, &_period_size, &dir)) < 0 ||
357         (ret = snd_pcm_hw_params_get_buffer_size(hwparams, &_buffer_size)) < 0) {
358         AUDIO_LOG_INFO("snd_pcm_hw_params_get_{period|buffer}_size() failed: %s", snd_strerror(ret));
359         goto error;
360     }
361
362     snd_pcm_hw_params_get_access(hwparams, (snd_pcm_access_t *) &val);
363     AUDIO_LOG_DEBUG("access type = %s\n", snd_pcm_access_name((snd_pcm_access_t)val));
364
365     snd_pcm_hw_params_get_format(hwparams, &sample_spec->format);
366     AUDIO_LOG_DEBUG("format = '%s' (%s)\n",
367                     snd_pcm_format_name((snd_pcm_format_t)sample_spec->format),
368                     snd_pcm_format_description((snd_pcm_format_t)sample_spec->format));
369
370     snd_pcm_hw_params_get_subformat(hwparams, (snd_pcm_subformat_t *)&val);
371     AUDIO_LOG_DEBUG("subformat = '%s' (%s)\n",
372                     snd_pcm_subformat_name((snd_pcm_subformat_t)val),
373                     snd_pcm_subformat_description((snd_pcm_subformat_t)val));
374
375     snd_pcm_hw_params_get_channels(hwparams, &channels);
376     sample_spec->channels = (uint8_t)channels;
377     AUDIO_LOG_DEBUG("channels = %d\n", sample_spec->channels);
378
379     if (buffer_size)
380         *buffer_size = _buffer_size;
381
382     if (period_size)
383         *period_size = _period_size;
384
385     if (use_mmap)
386         *use_mmap = _use_mmap;
387
388     return AUDIO_RET_OK;
389
390 error:
391     return AUDIO_ERR_RESOURCE;
392 }
393
394 audio_return_t _audio_pcm_set_sw_params(snd_pcm_t *pcm, snd_pcm_uframes_t avail_min, uint8_t period_event)
395 {
396     snd_pcm_sw_params_t *swparams;
397     snd_pcm_uframes_t boundary;
398     int err;
399
400     AUDIO_RETURN_VAL_IF_FAIL(pcm, AUDIO_ERR_PARAMETER);
401
402     snd_pcm_sw_params_alloca(&swparams);
403
404     if ((err = snd_pcm_sw_params_current(pcm, swparams)) < 0) {
405         AUDIO_LOG_WARN("Unable to determine current swparams: %s\n", snd_strerror(err));
406         goto error;
407     }
408     if ((err = snd_pcm_sw_params_set_period_event(pcm, swparams, period_event)) < 0) {
409         AUDIO_LOG_WARN("Unable to disable period event: %s\n", snd_strerror(err));
410         goto error;
411     }
412     if ((err = snd_pcm_sw_params_set_tstamp_mode(pcm, swparams, SND_PCM_TSTAMP_ENABLE)) < 0) {
413         AUDIO_LOG_WARN("Unable to enable time stamping: %s\n", snd_strerror(err));
414         goto error;
415     }
416     if ((err = snd_pcm_sw_params_get_boundary(swparams, &boundary)) < 0) {
417         AUDIO_LOG_WARN("Unable to get boundary: %s\n", snd_strerror(err));
418         goto error;
419     }
420     if ((err = snd_pcm_sw_params_set_stop_threshold(pcm, swparams, boundary)) < 0) {
421         AUDIO_LOG_WARN("Unable to set stop threshold: %s\n", snd_strerror(err));
422         goto error;
423     }
424     if ((err = snd_pcm_sw_params_set_start_threshold(pcm, swparams, (snd_pcm_uframes_t) avail_min)) < 0) {
425         AUDIO_LOG_WARN("Unable to set start threshold: %s\n", snd_strerror(err));
426         goto error;
427     }
428     if ((err = snd_pcm_sw_params_set_avail_min(pcm, swparams, avail_min)) < 0) {
429         AUDIO_LOG_WARN("snd_pcm_sw_params_set_avail_min() failed: %s", snd_strerror(err));
430         goto error;
431     }
432     if ((err = snd_pcm_sw_params(pcm, swparams)) < 0) {
433         AUDIO_LOG_WARN("Unable to set sw params: %s\n", snd_strerror(err));
434         goto error;
435     }
436     return AUDIO_RET_OK;
437 error:
438     return err;
439 }
440
441 /* ------ dump helper --------  */
442 #define MAX(a, b) ((a) > (b) ? (a) : (b))
443
444 dump_data_t* dump_new(int length)
445 {
446     dump_data_t* dump = NULL;
447
448     if ((dump = malloc(sizeof(dump_data_t)))) {
449         memset(dump, 0, sizeof(dump_data_t));
450         if ((dump->strbuf = malloc(length))) {
451             dump->p = &dump->strbuf[0];
452             dump->left = length;
453         } else {
454             free(dump);
455             dump = NULL;
456         }
457     }
458
459     return dump;
460 }
461
462 void dump_add_str(dump_data_t *dump, const char *fmt, ...)
463 {
464     int len;
465     va_list ap;
466
467     if (!dump)
468         return;
469
470     va_start(ap, fmt);
471     len = vsnprintf(dump->p, dump->left, fmt, ap);
472     va_end(ap);
473
474     dump->p += MAX(0, len);
475     dump->left -= MAX(0, len);
476 }
477
478 char* dump_get_str(dump_data_t *dump)
479 {
480     return (dump) ? dump->strbuf : NULL;
481 }
482
483 void dump_free(dump_data_t *dump)
484 {
485     if (dump) {
486         if (dump->strbuf)
487             free(dump->strbuf);
488         free(dump);
489     }
490 }
491 /* ------ dump helper --------  */