1 /*
2 * Copyright (C) 2012 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17 #define LOG_TAG "modules.usbaudio.audio_hal"
18 /*#define LOG_NDEBUG 0*/
19
20 #include <errno.h>
21 #include <inttypes.h>
22 #include <pthread.h>
23 #include <stdint.h>
24 #include <stdlib.h>
25 #include <sys/time.h>
26
27 #include <log/log.h>
28 #include <cutils/list.h>
29 #include <cutils/str_parms.h>
30 #include <cutils/properties.h>
31
32 #include <hardware/audio.h>
33 #include <hardware/audio_alsaops.h>
34 #include <hardware/hardware.h>
35
36 #include <system/audio.h>
37
38 #include <tinyalsa/asoundlib.h>
39
40 #include <audio_utils/channels.h>
41
42 #include "alsa_device_profile.h"
43 #include "alsa_device_proxy.h"
44 #include "alsa_logging.h"
45
46 #define DEFAULT_INPUT_BUFFER_SIZE_MS 20
47
48 /* Lock play & record samples rates at or above this threshold */
49 #define RATELOCK_THRESHOLD 96000
50
51 struct audio_device {
52 struct audio_hw_device hw_device;
53
54 pthread_mutex_t lock; /* see note below on mutex acquisition order */
55
56 /* output */
57 alsa_device_profile out_profile;
58 struct listnode output_stream_list;
59
60 /* input */
61 alsa_device_profile in_profile;
62 struct listnode input_stream_list;
63
64 /* lock input & output sample rates */
65 /*FIXME - How do we address multiple output streams? */
66 uint32_t device_sample_rate;
67
68 bool mic_muted;
69
70 bool standby;
71 };
72
73 struct stream_lock {
74 pthread_mutex_t lock; /* see note below on mutex acquisition order */
75 pthread_mutex_t pre_lock; /* acquire before lock to avoid DOS by playback thread */
76 };
77
78 struct stream_out {
79 struct audio_stream_out stream;
80
81 struct stream_lock lock;
82
83 bool standby;
84
85 struct audio_device *adev; /* hardware information - only using this for the lock */
86
87 alsa_device_profile * profile; /* Points to the alsa_device_profile in the audio_device */
88 alsa_device_proxy proxy; /* state of the stream */
89
90 unsigned hal_channel_count; /* channel count exposed to AudioFlinger.
91 * This may differ from the device channel count when
92 * the device is not compatible with AudioFlinger
93 * capabilities, e.g. exposes too many channels or
94 * too few channels. */
95 audio_channel_mask_t hal_channel_mask; /* USB devices deal in channel counts, not masks
96 * so the proxy doesn't have a channel_mask, but
97 * audio HALs need to talk about channel masks
98 * so expose the one calculated by
99 * adev_open_output_stream */
100
101 struct listnode list_node;
102
103 void * conversion_buffer; /* any conversions are put into here
104 * they could come from here too if
105 * there was a previous conversion */
106 size_t conversion_buffer_size; /* in bytes */
107 };
108
109 struct stream_in {
110 struct audio_stream_in stream;
111
112 struct stream_lock lock;
113
114 bool standby;
115
116 struct audio_device *adev; /* hardware information - only using this for the lock */
117
118 alsa_device_profile * profile; /* Points to the alsa_device_profile in the audio_device */
119 alsa_device_proxy proxy; /* state of the stream */
120
121 unsigned hal_channel_count; /* channel count exposed to AudioFlinger.
122 * This may differ from the device channel count when
123 * the device is not compatible with AudioFlinger
124 * capabilities, e.g. exposes too many channels or
125 * too few channels. */
126 audio_channel_mask_t hal_channel_mask; /* USB devices deal in channel counts, not masks
127 * so the proxy doesn't have a channel_mask, but
128 * audio HALs need to talk about channel masks
129 * so expose the one calculated by
130 * adev_open_input_stream */
131
132 struct listnode list_node;
133
134 /* We may need to read more data from the device in order to data reduce to 16bit, 4chan */
135 void * conversion_buffer; /* any conversions are put into here
136 * they could come from here too if
137 * there was a previous conversion */
138 size_t conversion_buffer_size; /* in bytes */
139 };
140
141 /*
142 * Locking Helpers
143 */
144 /*
145 * NOTE: when multiple mutexes have to be acquired, always take the
146 * stream_in or stream_out mutex first, followed by the audio_device mutex.
147 * stream pre_lock is always acquired before stream lock to prevent starvation of control thread by
148 * higher priority playback or capture thread.
149 */
150
stream_lock_init(struct stream_lock * lock)151 static void stream_lock_init(struct stream_lock *lock) {
152 pthread_mutex_init(&lock->lock, (const pthread_mutexattr_t *) NULL);
153 pthread_mutex_init(&lock->pre_lock, (const pthread_mutexattr_t *) NULL);
154 }
155
stream_lock(struct stream_lock * lock)156 static void stream_lock(struct stream_lock *lock) {
157 pthread_mutex_lock(&lock->pre_lock);
158 pthread_mutex_lock(&lock->lock);
159 pthread_mutex_unlock(&lock->pre_lock);
160 }
161
stream_unlock(struct stream_lock * lock)162 static void stream_unlock(struct stream_lock *lock) {
163 pthread_mutex_unlock(&lock->lock);
164 }
165
device_lock(struct audio_device * adev)166 static void device_lock(struct audio_device *adev) {
167 pthread_mutex_lock(&adev->lock);
168 }
169
device_try_lock(struct audio_device * adev)170 static int device_try_lock(struct audio_device *adev) {
171 return pthread_mutex_trylock(&adev->lock);
172 }
173
device_unlock(struct audio_device * adev)174 static void device_unlock(struct audio_device *adev) {
175 pthread_mutex_unlock(&adev->lock);
176 }
177
178 /*
179 * streams list management
180 */
adev_add_stream_to_list(struct audio_device * adev,struct listnode * list,struct listnode * stream_node)181 static void adev_add_stream_to_list(
182 struct audio_device* adev, struct listnode* list, struct listnode* stream_node) {
183 device_lock(adev);
184
185 list_add_tail(list, stream_node);
186
187 device_unlock(adev);
188 }
189
adev_remove_stream_from_list(struct audio_device * adev,struct listnode * stream_node)190 static void adev_remove_stream_from_list(
191 struct audio_device* adev, struct listnode* stream_node) {
192 device_lock(adev);
193
194 list_remove(stream_node);
195
196 device_unlock(adev);
197 }
198
199 /*
200 * Extract the card and device numbers from the supplied key/value pairs.
201 * kvpairs A null-terminated string containing the key/value pairs or card and device.
202 * i.e. "card=1;device=42"
203 * card A pointer to a variable to receive the parsed-out card number.
204 * device A pointer to a variable to receive the parsed-out device number.
205 * NOTE: The variables pointed to by card and device return -1 (undefined) if the
206 * associated key/value pair is not found in the provided string.
207 * Return true if the kvpairs string contain a card/device spec, false otherwise.
208 */
parse_card_device_params(const char * kvpairs,int * card,int * device)209 static bool parse_card_device_params(const char *kvpairs, int *card, int *device)
210 {
211 struct str_parms * parms = str_parms_create_str(kvpairs);
212 char value[32];
213 int param_val;
214
215 // initialize to "undefined" state.
216 *card = -1;
217 *device = -1;
218
219 param_val = str_parms_get_str(parms, "card", value, sizeof(value));
220 if (param_val >= 0) {
221 *card = atoi(value);
222 }
223
224 param_val = str_parms_get_str(parms, "device", value, sizeof(value));
225 if (param_val >= 0) {
226 *device = atoi(value);
227 }
228
229 str_parms_destroy(parms);
230
231 return *card >= 0 && *device >= 0;
232 }
233
device_get_parameters(alsa_device_profile * profile,const char * keys)234 static char * device_get_parameters(alsa_device_profile * profile, const char * keys)
235 {
236 if (profile->card < 0 || profile->device < 0) {
237 return strdup("");
238 }
239
240 struct str_parms *query = str_parms_create_str(keys);
241 struct str_parms *result = str_parms_create();
242
243 /* These keys are from hardware/libhardware/include/audio.h */
244 /* supported sample rates */
245 if (str_parms_has_key(query, AUDIO_PARAMETER_STREAM_SUP_SAMPLING_RATES)) {
246 char* rates_list = profile_get_sample_rate_strs(profile);
247 str_parms_add_str(result, AUDIO_PARAMETER_STREAM_SUP_SAMPLING_RATES,
248 rates_list);
249 free(rates_list);
250 }
251
252 /* supported channel counts */
253 if (str_parms_has_key(query, AUDIO_PARAMETER_STREAM_SUP_CHANNELS)) {
254 char* channels_list = profile_get_channel_count_strs(profile);
255 str_parms_add_str(result, AUDIO_PARAMETER_STREAM_SUP_CHANNELS,
256 channels_list);
257 free(channels_list);
258 }
259
260 /* supported sample formats */
261 if (str_parms_has_key(query, AUDIO_PARAMETER_STREAM_SUP_FORMATS)) {
262 char * format_params = profile_get_format_strs(profile);
263 str_parms_add_str(result, AUDIO_PARAMETER_STREAM_SUP_FORMATS,
264 format_params);
265 free(format_params);
266 }
267 str_parms_destroy(query);
268
269 char* result_str = str_parms_to_str(result);
270 str_parms_destroy(result);
271
272 ALOGV("device_get_parameters = %s", result_str);
273
274 return result_str;
275 }
276
277 /*
278 * HAl Functions
279 */
280 /**
281 * NOTE: when multiple mutexes have to be acquired, always respect the
282 * following order: hw device > out stream
283 */
284
285 /*
286 * OUT functions
287 */
out_get_sample_rate(const struct audio_stream * stream)288 static uint32_t out_get_sample_rate(const struct audio_stream *stream)
289 {
290 uint32_t rate = proxy_get_sample_rate(&((struct stream_out*)stream)->proxy);
291 ALOGV("out_get_sample_rate() = %d", rate);
292 return rate;
293 }
294
out_set_sample_rate(struct audio_stream * stream,uint32_t rate)295 static int out_set_sample_rate(struct audio_stream *stream, uint32_t rate)
296 {
297 return 0;
298 }
299
out_get_buffer_size(const struct audio_stream * stream)300 static size_t out_get_buffer_size(const struct audio_stream *stream)
301 {
302 const struct stream_out* out = (const struct stream_out*)stream;
303 size_t buffer_size =
304 proxy_get_period_size(&out->proxy) * audio_stream_out_frame_size(&(out->stream));
305 return buffer_size;
306 }
307
out_get_channels(const struct audio_stream * stream)308 static uint32_t out_get_channels(const struct audio_stream *stream)
309 {
310 const struct stream_out *out = (const struct stream_out*)stream;
311 return out->hal_channel_mask;
312 }
313
out_get_format(const struct audio_stream * stream)314 static audio_format_t out_get_format(const struct audio_stream *stream)
315 {
316 /* Note: The HAL doesn't do any FORMAT conversion at this time. It
317 * Relies on the framework to provide data in the specified format.
318 * This could change in the future.
319 */
320 alsa_device_proxy * proxy = &((struct stream_out*)stream)->proxy;
321 audio_format_t format = audio_format_from_pcm_format(proxy_get_format(proxy));
322 return format;
323 }
324
out_set_format(struct audio_stream * stream,audio_format_t format)325 static int out_set_format(struct audio_stream *stream, audio_format_t format)
326 {
327 return 0;
328 }
329
out_standby(struct audio_stream * stream)330 static int out_standby(struct audio_stream *stream)
331 {
332 struct stream_out *out = (struct stream_out *)stream;
333
334 stream_lock(&out->lock);
335 if (!out->standby) {
336 device_lock(out->adev);
337 proxy_close(&out->proxy);
338 device_unlock(out->adev);
339 out->standby = true;
340 }
341 stream_unlock(&out->lock);
342 return 0;
343 }
344
out_dump(const struct audio_stream * stream,int fd)345 static int out_dump(const struct audio_stream *stream, int fd) {
346 const struct stream_out* out_stream = (const struct stream_out*) stream;
347
348 if (out_stream != NULL) {
349 dprintf(fd, "Output Profile:\n");
350 profile_dump(out_stream->profile, fd);
351
352 dprintf(fd, "Output Proxy:\n");
353 proxy_dump(&out_stream->proxy, fd);
354 }
355
356 return 0;
357 }
358
out_set_parameters(struct audio_stream * stream,const char * kvpairs)359 static int out_set_parameters(struct audio_stream *stream, const char *kvpairs)
360 {
361 ALOGV("out_set_parameters() keys:%s", kvpairs);
362
363 struct stream_out *out = (struct stream_out *)stream;
364
365 int routing = 0;
366 int ret_value = 0;
367 int card = -1;
368 int device = -1;
369
370 if (!parse_card_device_params(kvpairs, &card, &device)) {
371 // nothing to do
372 return ret_value;
373 }
374
375 stream_lock(&out->lock);
376 /* Lock the device because that is where the profile lives */
377 device_lock(out->adev);
378
379 if (!profile_is_cached_for(out->profile, card, device)) {
380 /* cannot read pcm device info if playback is active */
381 if (!out->standby)
382 ret_value = -ENOSYS;
383 else {
384 int saved_card = out->profile->card;
385 int saved_device = out->profile->device;
386 out->profile->card = card;
387 out->profile->device = device;
388 ret_value = profile_read_device_info(out->profile) ? 0 : -EINVAL;
389 if (ret_value != 0) {
390 out->profile->card = saved_card;
391 out->profile->device = saved_device;
392 }
393 }
394 }
395
396 device_unlock(out->adev);
397 stream_unlock(&out->lock);
398
399 return ret_value;
400 }
401
out_get_parameters(const struct audio_stream * stream,const char * keys)402 static char * out_get_parameters(const struct audio_stream *stream, const char *keys)
403 {
404 struct stream_out *out = (struct stream_out *)stream;
405 stream_lock(&out->lock);
406 device_lock(out->adev);
407
408 char * params_str = device_get_parameters(out->profile, keys);
409
410 device_unlock(out->adev);
411 stream_unlock(&out->lock);
412 return params_str;
413 }
414
out_get_latency(const struct audio_stream_out * stream)415 static uint32_t out_get_latency(const struct audio_stream_out *stream)
416 {
417 alsa_device_proxy * proxy = &((struct stream_out*)stream)->proxy;
418 return proxy_get_latency(proxy);
419 }
420
out_set_volume(struct audio_stream_out * stream,float left,float right)421 static int out_set_volume(struct audio_stream_out *stream, float left, float right)
422 {
423 return -ENOSYS;
424 }
425
426 /* must be called with hw device and output stream mutexes locked */
start_output_stream(struct stream_out * out)427 static int start_output_stream(struct stream_out *out)
428 {
429 ALOGV("start_output_stream(card:%d device:%d)", out->profile->card, out->profile->device);
430
431 return proxy_open(&out->proxy);
432 }
433
out_write(struct audio_stream_out * stream,const void * buffer,size_t bytes)434 static ssize_t out_write(struct audio_stream_out *stream, const void* buffer, size_t bytes)
435 {
436 int ret;
437 struct stream_out *out = (struct stream_out *)stream;
438
439 stream_lock(&out->lock);
440 if (out->standby) {
441 device_lock(out->adev);
442 ret = start_output_stream(out);
443 device_unlock(out->adev);
444 if (ret != 0) {
445 goto err;
446 }
447 out->standby = false;
448 }
449
450 alsa_device_proxy* proxy = &out->proxy;
451 const void * write_buff = buffer;
452 int num_write_buff_bytes = bytes;
453 const int num_device_channels = proxy_get_channel_count(proxy); /* what we told alsa */
454 const int num_req_channels = out->hal_channel_count; /* what we told AudioFlinger */
455 if (num_device_channels != num_req_channels) {
456 /* allocate buffer */
457 const size_t required_conversion_buffer_size =
458 bytes * num_device_channels / num_req_channels;
459 if (required_conversion_buffer_size > out->conversion_buffer_size) {
460 out->conversion_buffer_size = required_conversion_buffer_size;
461 out->conversion_buffer = realloc(out->conversion_buffer,
462 out->conversion_buffer_size);
463 }
464 /* convert data */
465 const audio_format_t audio_format = out_get_format(&(out->stream.common));
466 const unsigned sample_size_in_bytes = audio_bytes_per_sample(audio_format);
467 num_write_buff_bytes =
468 adjust_channels(write_buff, num_req_channels,
469 out->conversion_buffer, num_device_channels,
470 sample_size_in_bytes, num_write_buff_bytes);
471 write_buff = out->conversion_buffer;
472 }
473
474 if (write_buff != NULL && num_write_buff_bytes != 0) {
475 proxy_write(&out->proxy, write_buff, num_write_buff_bytes);
476 }
477
478 stream_unlock(&out->lock);
479
480 return bytes;
481
482 err:
483 stream_unlock(&out->lock);
484 if (ret != 0) {
485 usleep(bytes * 1000000 / audio_stream_out_frame_size(stream) /
486 out_get_sample_rate(&stream->common));
487 }
488
489 return bytes;
490 }
491
out_get_render_position(const struct audio_stream_out * stream,uint32_t * dsp_frames)492 static int out_get_render_position(const struct audio_stream_out *stream, uint32_t *dsp_frames)
493 {
494 return -EINVAL;
495 }
496
out_get_presentation_position(const struct audio_stream_out * stream,uint64_t * frames,struct timespec * timestamp)497 static int out_get_presentation_position(const struct audio_stream_out *stream,
498 uint64_t *frames, struct timespec *timestamp)
499 {
500 struct stream_out *out = (struct stream_out *)stream; // discard const qualifier
501 stream_lock(&out->lock);
502
503 const alsa_device_proxy *proxy = &out->proxy;
504 const int ret = proxy_get_presentation_position(proxy, frames, timestamp);
505
506 stream_unlock(&out->lock);
507 return ret;
508 }
509
out_add_audio_effect(const struct audio_stream * stream,effect_handle_t effect)510 static int out_add_audio_effect(const struct audio_stream *stream, effect_handle_t effect)
511 {
512 return 0;
513 }
514
out_remove_audio_effect(const struct audio_stream * stream,effect_handle_t effect)515 static int out_remove_audio_effect(const struct audio_stream *stream, effect_handle_t effect)
516 {
517 return 0;
518 }
519
out_get_next_write_timestamp(const struct audio_stream_out * stream,int64_t * timestamp)520 static int out_get_next_write_timestamp(const struct audio_stream_out *stream, int64_t *timestamp)
521 {
522 return -EINVAL;
523 }
524
adev_open_output_stream(struct audio_hw_device * hw_dev,audio_io_handle_t handle,audio_devices_t devicesSpec __unused,audio_output_flags_t flags,struct audio_config * config,struct audio_stream_out ** stream_out,const char * address)525 static int adev_open_output_stream(struct audio_hw_device *hw_dev,
526 audio_io_handle_t handle,
527 audio_devices_t devicesSpec __unused,
528 audio_output_flags_t flags,
529 struct audio_config *config,
530 struct audio_stream_out **stream_out,
531 const char *address /*__unused*/)
532 {
533 ALOGV("adev_open_output_stream() handle:0x%X, devicesSpec:0x%X, flags:0x%X, addr:%s",
534 handle, devicesSpec, flags, address);
535
536 struct stream_out *out;
537
538 out = (struct stream_out *)calloc(1, sizeof(struct stream_out));
539 if (out == NULL) {
540 return -ENOMEM;
541 }
542
543 /* setup function pointers */
544 out->stream.common.get_sample_rate = out_get_sample_rate;
545 out->stream.common.set_sample_rate = out_set_sample_rate;
546 out->stream.common.get_buffer_size = out_get_buffer_size;
547 out->stream.common.get_channels = out_get_channels;
548 out->stream.common.get_format = out_get_format;
549 out->stream.common.set_format = out_set_format;
550 out->stream.common.standby = out_standby;
551 out->stream.common.dump = out_dump;
552 out->stream.common.set_parameters = out_set_parameters;
553 out->stream.common.get_parameters = out_get_parameters;
554 out->stream.common.add_audio_effect = out_add_audio_effect;
555 out->stream.common.remove_audio_effect = out_remove_audio_effect;
556 out->stream.get_latency = out_get_latency;
557 out->stream.set_volume = out_set_volume;
558 out->stream.write = out_write;
559 out->stream.get_render_position = out_get_render_position;
560 out->stream.get_presentation_position = out_get_presentation_position;
561 out->stream.get_next_write_timestamp = out_get_next_write_timestamp;
562
563 stream_lock_init(&out->lock);
564
565 out->adev = (struct audio_device *)hw_dev;
566 device_lock(out->adev);
567 out->profile = &out->adev->out_profile;
568
569 // build this to hand to the alsa_device_proxy
570 struct pcm_config proxy_config;
571 memset(&proxy_config, 0, sizeof(proxy_config));
572
573 /* Pull out the card/device pair */
574 parse_card_device_params(address, &(out->profile->card), &(out->profile->device));
575
576 profile_read_device_info(out->profile);
577
578 int ret = 0;
579
580 /* Rate */
581 if (config->sample_rate == 0) {
582 proxy_config.rate = config->sample_rate = profile_get_default_sample_rate(out->profile);
583 } else if (profile_is_sample_rate_valid(out->profile, config->sample_rate)) {
584 proxy_config.rate = config->sample_rate;
585 } else {
586 proxy_config.rate = config->sample_rate = profile_get_default_sample_rate(out->profile);
587 ret = -EINVAL;
588 }
589
590 out->adev->device_sample_rate = config->sample_rate;
591 device_unlock(out->adev);
592
593 /* Format */
594 if (config->format == AUDIO_FORMAT_DEFAULT) {
595 proxy_config.format = profile_get_default_format(out->profile);
596 config->format = audio_format_from_pcm_format(proxy_config.format);
597 } else {
598 enum pcm_format fmt = pcm_format_from_audio_format(config->format);
599 if (profile_is_format_valid(out->profile, fmt)) {
600 proxy_config.format = fmt;
601 } else {
602 proxy_config.format = profile_get_default_format(out->profile);
603 config->format = audio_format_from_pcm_format(proxy_config.format);
604 ret = -EINVAL;
605 }
606 }
607
608 /* Channels */
609 bool calc_mask = false;
610 if (config->channel_mask == AUDIO_CHANNEL_NONE) {
611 /* query case */
612 out->hal_channel_count = profile_get_default_channel_count(out->profile);
613 calc_mask = true;
614 } else {
615 /* explicit case */
616 out->hal_channel_count = audio_channel_count_from_out_mask(config->channel_mask);
617 }
618
619 /* The Framework is currently limited to no more than this number of channels */
620 if (out->hal_channel_count > FCC_8) {
621 out->hal_channel_count = FCC_8;
622 calc_mask = true;
623 }
624
625 if (calc_mask) {
626 /* need to calculate the mask from channel count either because this is the query case
627 * or the specified mask isn't valid for this device, or is more then the FW can handle */
628 config->channel_mask = out->hal_channel_count <= FCC_2
629 /* position mask for mono and stereo*/
630 ? audio_channel_out_mask_from_count(out->hal_channel_count)
631 /* otherwise indexed */
632 : audio_channel_mask_for_index_assignment_from_count(out->hal_channel_count);
633 }
634
635 out->hal_channel_mask = config->channel_mask;
636
637 // Validate the "logical" channel count against support in the "actual" profile.
638 // if they differ, choose the "actual" number of channels *closest* to the "logical".
639 // and store THAT in proxy_config.channels
640 proxy_config.channels = profile_get_closest_channel_count(out->profile, out->hal_channel_count);
641 proxy_prepare(&out->proxy, out->profile, &proxy_config);
642
643 /* TODO The retry mechanism isn't implemented in AudioPolicyManager/AudioFlinger. */
644 ret = 0;
645
646 out->conversion_buffer = NULL;
647 out->conversion_buffer_size = 0;
648
649 out->standby = true;
650
651 /* Save the stream for adev_dump() */
652 adev_add_stream_to_list(out->adev, &out->adev->output_stream_list, &out->list_node);
653
654 *stream_out = &out->stream;
655
656 return ret;
657
658 err_open:
659 free(out);
660 *stream_out = NULL;
661 return -ENOSYS;
662 }
663
adev_close_output_stream(struct audio_hw_device * hw_dev,struct audio_stream_out * stream)664 static void adev_close_output_stream(struct audio_hw_device *hw_dev,
665 struct audio_stream_out *stream)
666 {
667 struct stream_out *out = (struct stream_out *)stream;
668 ALOGV("adev_close_output_stream(c:%d d:%d)", out->profile->card, out->profile->device);
669
670 adev_remove_stream_from_list(out->adev, &out->list_node);
671
672 /* Close the pcm device */
673 out_standby(&stream->common);
674
675 free(out->conversion_buffer);
676
677 out->conversion_buffer = NULL;
678 out->conversion_buffer_size = 0;
679
680 device_lock(out->adev);
681 out->adev->device_sample_rate = 0;
682 device_unlock(out->adev);
683
684 free(stream);
685 }
686
adev_get_input_buffer_size(const struct audio_hw_device * hw_dev,const struct audio_config * config)687 static size_t adev_get_input_buffer_size(const struct audio_hw_device *hw_dev,
688 const struct audio_config *config)
689 {
690 /* TODO This needs to be calculated based on format/channels/rate */
691 return 320;
692 }
693
694 /*
695 * IN functions
696 */
in_get_sample_rate(const struct audio_stream * stream)697 static uint32_t in_get_sample_rate(const struct audio_stream *stream)
698 {
699 uint32_t rate = proxy_get_sample_rate(&((const struct stream_in *)stream)->proxy);
700 ALOGV("in_get_sample_rate() = %d", rate);
701 return rate;
702 }
703
in_set_sample_rate(struct audio_stream * stream,uint32_t rate)704 static int in_set_sample_rate(struct audio_stream *stream, uint32_t rate)
705 {
706 ALOGV("in_set_sample_rate(%d) - NOPE", rate);
707 return -ENOSYS;
708 }
709
in_get_buffer_size(const struct audio_stream * stream)710 static size_t in_get_buffer_size(const struct audio_stream *stream)
711 {
712 const struct stream_in * in = ((const struct stream_in*)stream);
713 return proxy_get_period_size(&in->proxy) * audio_stream_in_frame_size(&(in->stream));
714 }
715
in_get_channels(const struct audio_stream * stream)716 static uint32_t in_get_channels(const struct audio_stream *stream)
717 {
718 const struct stream_in *in = (const struct stream_in*)stream;
719 return in->hal_channel_mask;
720 }
721
in_get_format(const struct audio_stream * stream)722 static audio_format_t in_get_format(const struct audio_stream *stream)
723 {
724 alsa_device_proxy *proxy = &((struct stream_in*)stream)->proxy;
725 audio_format_t format = audio_format_from_pcm_format(proxy_get_format(proxy));
726 return format;
727 }
728
in_set_format(struct audio_stream * stream,audio_format_t format)729 static int in_set_format(struct audio_stream *stream, audio_format_t format)
730 {
731 ALOGV("in_set_format(%d) - NOPE", format);
732
733 return -ENOSYS;
734 }
735
in_standby(struct audio_stream * stream)736 static int in_standby(struct audio_stream *stream)
737 {
738 struct stream_in *in = (struct stream_in *)stream;
739
740 stream_lock(&in->lock);
741 if (!in->standby) {
742 device_lock(in->adev);
743 proxy_close(&in->proxy);
744 device_unlock(in->adev);
745 in->standby = true;
746 }
747
748 stream_unlock(&in->lock);
749
750 return 0;
751 }
752
in_dump(const struct audio_stream * stream,int fd)753 static int in_dump(const struct audio_stream *stream, int fd)
754 {
755 const struct stream_in* in_stream = (const struct stream_in*)stream;
756 if (in_stream != NULL) {
757 dprintf(fd, "Input Profile:\n");
758 profile_dump(in_stream->profile, fd);
759
760 dprintf(fd, "Input Proxy:\n");
761 proxy_dump(&in_stream->proxy, fd);
762 }
763
764 return 0;
765 }
766
in_set_parameters(struct audio_stream * stream,const char * kvpairs)767 static int in_set_parameters(struct audio_stream *stream, const char *kvpairs)
768 {
769 ALOGV("in_set_parameters() keys:%s", kvpairs);
770
771 struct stream_in *in = (struct stream_in *)stream;
772
773 char value[32];
774 int param_val;
775 int routing = 0;
776 int ret_value = 0;
777 int card = -1;
778 int device = -1;
779
780 if (!parse_card_device_params(kvpairs, &card, &device)) {
781 // nothing to do
782 return ret_value;
783 }
784
785 stream_lock(&in->lock);
786 device_lock(in->adev);
787
788 if (card >= 0 && device >= 0 && !profile_is_cached_for(in->profile, card, device)) {
789 /* cannot read pcm device info if playback is active */
790 if (!in->standby)
791 ret_value = -ENOSYS;
792 else {
793 int saved_card = in->profile->card;
794 int saved_device = in->profile->device;
795 in->profile->card = card;
796 in->profile->device = device;
797 ret_value = profile_read_device_info(in->profile) ? 0 : -EINVAL;
798 if (ret_value != 0) {
799 in->profile->card = saved_card;
800 in->profile->device = saved_device;
801 }
802 }
803 }
804
805 device_unlock(in->adev);
806 stream_unlock(&in->lock);
807
808 return ret_value;
809 }
810
in_get_parameters(const struct audio_stream * stream,const char * keys)811 static char * in_get_parameters(const struct audio_stream *stream, const char *keys)
812 {
813 struct stream_in *in = (struct stream_in *)stream;
814
815 stream_lock(&in->lock);
816 device_lock(in->adev);
817
818 char * params_str = device_get_parameters(in->profile, keys);
819
820 device_unlock(in->adev);
821 stream_unlock(&in->lock);
822
823 return params_str;
824 }
825
in_add_audio_effect(const struct audio_stream * stream,effect_handle_t effect)826 static int in_add_audio_effect(const struct audio_stream *stream, effect_handle_t effect)
827 {
828 return 0;
829 }
830
in_remove_audio_effect(const struct audio_stream * stream,effect_handle_t effect)831 static int in_remove_audio_effect(const struct audio_stream *stream, effect_handle_t effect)
832 {
833 return 0;
834 }
835
in_set_gain(struct audio_stream_in * stream,float gain)836 static int in_set_gain(struct audio_stream_in *stream, float gain)
837 {
838 return 0;
839 }
840
841 /* must be called with hw device and output stream mutexes locked */
start_input_stream(struct stream_in * in)842 static int start_input_stream(struct stream_in *in)
843 {
844 ALOGV("start_input_stream(card:%d device:%d)", in->profile->card, in->profile->device);
845
846 return proxy_open(&in->proxy);
847 }
848
849 /* TODO mutex stuff here (see out_write) */
in_read(struct audio_stream_in * stream,void * buffer,size_t bytes)850 static ssize_t in_read(struct audio_stream_in *stream, void* buffer, size_t bytes)
851 {
852 size_t num_read_buff_bytes = 0;
853 void * read_buff = buffer;
854 void * out_buff = buffer;
855 int ret = 0;
856
857 struct stream_in * in = (struct stream_in *)stream;
858
859 stream_lock(&in->lock);
860 if (in->standby) {
861 device_lock(in->adev);
862 ret = start_input_stream(in);
863 device_unlock(in->adev);
864 if (ret != 0) {
865 goto err;
866 }
867 in->standby = false;
868 }
869
870 alsa_device_profile * profile = in->profile;
871
872 /*
873 * OK, we need to figure out how much data to read to be able to output the requested
874 * number of bytes in the HAL format (16-bit, stereo).
875 */
876 num_read_buff_bytes = bytes;
877 int num_device_channels = proxy_get_channel_count(&in->proxy); /* what we told Alsa */
878 int num_req_channels = in->hal_channel_count; /* what we told AudioFlinger */
879
880 if (num_device_channels != num_req_channels) {
881 num_read_buff_bytes = (num_device_channels * num_read_buff_bytes) / num_req_channels;
882 }
883
884 /* Setup/Realloc the conversion buffer (if necessary). */
885 if (num_read_buff_bytes != bytes) {
886 if (num_read_buff_bytes > in->conversion_buffer_size) {
887 /*TODO Remove this when AudioPolicyManger/AudioFlinger support arbitrary formats
888 (and do these conversions themselves) */
889 in->conversion_buffer_size = num_read_buff_bytes;
890 in->conversion_buffer = realloc(in->conversion_buffer, in->conversion_buffer_size);
891 }
892 read_buff = in->conversion_buffer;
893 }
894
895 ret = proxy_read(&in->proxy, read_buff, num_read_buff_bytes);
896 if (ret == 0) {
897 if (num_device_channels != num_req_channels) {
898 // ALOGV("chans dev:%d req:%d", num_device_channels, num_req_channels);
899
900 out_buff = buffer;
901 /* Num Channels conversion */
902 if (num_device_channels != num_req_channels) {
903 audio_format_t audio_format = in_get_format(&(in->stream.common));
904 unsigned sample_size_in_bytes = audio_bytes_per_sample(audio_format);
905
906 num_read_buff_bytes =
907 adjust_channels(read_buff, num_device_channels,
908 out_buff, num_req_channels,
909 sample_size_in_bytes, num_read_buff_bytes);
910 }
911 }
912
913 /* no need to acquire in->adev->lock to read mic_muted here as we don't change its state */
914 if (num_read_buff_bytes > 0 && in->adev->mic_muted)
915 memset(buffer, 0, num_read_buff_bytes);
916 } else {
917 num_read_buff_bytes = 0; // reset the value after USB headset is unplugged
918 }
919
920 err:
921 stream_unlock(&in->lock);
922 return num_read_buff_bytes;
923 }
924
in_get_input_frames_lost(struct audio_stream_in * stream)925 static uint32_t in_get_input_frames_lost(struct audio_stream_in *stream)
926 {
927 return 0;
928 }
929
adev_open_input_stream(struct audio_hw_device * hw_dev,audio_io_handle_t handle,audio_devices_t devicesSpec __unused,struct audio_config * config,struct audio_stream_in ** stream_in,audio_input_flags_t flags __unused,const char * address,audio_source_t source __unused)930 static int adev_open_input_stream(struct audio_hw_device *hw_dev,
931 audio_io_handle_t handle,
932 audio_devices_t devicesSpec __unused,
933 struct audio_config *config,
934 struct audio_stream_in **stream_in,
935 audio_input_flags_t flags __unused,
936 const char *address /*__unused*/,
937 audio_source_t source __unused)
938 {
939 ALOGV("adev_open_input_stream() rate:%" PRIu32 ", chanMask:0x%" PRIX32 ", fmt:%" PRIu8,
940 config->sample_rate, config->channel_mask, config->format);
941
942 struct stream_in *in = (struct stream_in *)calloc(1, sizeof(struct stream_in));
943 int ret = 0;
944
945 if (in == NULL) {
946 return -ENOMEM;
947 }
948
949 /* setup function pointers */
950 in->stream.common.get_sample_rate = in_get_sample_rate;
951 in->stream.common.set_sample_rate = in_set_sample_rate;
952 in->stream.common.get_buffer_size = in_get_buffer_size;
953 in->stream.common.get_channels = in_get_channels;
954 in->stream.common.get_format = in_get_format;
955 in->stream.common.set_format = in_set_format;
956 in->stream.common.standby = in_standby;
957 in->stream.common.dump = in_dump;
958 in->stream.common.set_parameters = in_set_parameters;
959 in->stream.common.get_parameters = in_get_parameters;
960 in->stream.common.add_audio_effect = in_add_audio_effect;
961 in->stream.common.remove_audio_effect = in_remove_audio_effect;
962
963 in->stream.set_gain = in_set_gain;
964 in->stream.read = in_read;
965 in->stream.get_input_frames_lost = in_get_input_frames_lost;
966
967 stream_lock_init(&in->lock);
968
969 in->adev = (struct audio_device *)hw_dev;
970 device_lock(in->adev);
971
972 in->profile = &in->adev->in_profile;
973
974 struct pcm_config proxy_config;
975 memset(&proxy_config, 0, sizeof(proxy_config));
976
977 /* Pull out the card/device pair */
978 parse_card_device_params(address, &(in->profile->card), &(in->profile->device));
979
980 profile_read_device_info(in->profile);
981
982 /* Rate */
983 if (config->sample_rate == 0) {
984 config->sample_rate = profile_get_default_sample_rate(in->profile);
985 }
986
987 if (in->adev->device_sample_rate != 0 && /* we are playing, so lock the rate */
988 in->adev->device_sample_rate >= RATELOCK_THRESHOLD) {/* but only for high sample rates */
989 ret = config->sample_rate != in->adev->device_sample_rate ? -EINVAL : 0;
990 proxy_config.rate = config->sample_rate = in->adev->device_sample_rate;
991 } else if (profile_is_sample_rate_valid(in->profile, config->sample_rate)) {
992 in->adev->device_sample_rate = proxy_config.rate = config->sample_rate;
993 } else {
994 proxy_config.rate = config->sample_rate = profile_get_default_sample_rate(in->profile);
995 ret = -EINVAL;
996 }
997 device_unlock(in->adev);
998
999 /* Format */
1000 if (config->format == AUDIO_FORMAT_DEFAULT) {
1001 proxy_config.format = profile_get_default_format(in->profile);
1002 config->format = audio_format_from_pcm_format(proxy_config.format);
1003 } else {
1004 enum pcm_format fmt = pcm_format_from_audio_format(config->format);
1005 if (profile_is_format_valid(in->profile, fmt)) {
1006 proxy_config.format = fmt;
1007 } else {
1008 proxy_config.format = profile_get_default_format(in->profile);
1009 config->format = audio_format_from_pcm_format(proxy_config.format);
1010 ret = -EINVAL;
1011 }
1012 }
1013
1014 /* Channels */
1015 bool calc_mask = false;
1016 if (config->channel_mask == AUDIO_CHANNEL_NONE) {
1017 /* query case */
1018 in->hal_channel_count = profile_get_default_channel_count(in->profile);
1019 calc_mask = true;
1020 } else {
1021 /* explicit case */
1022 in->hal_channel_count = audio_channel_count_from_in_mask(config->channel_mask);
1023 }
1024
1025 /* The Framework is currently limited to no more than this number of channels */
1026 if (in->hal_channel_count > FCC_8) {
1027 in->hal_channel_count = FCC_8;
1028 calc_mask = true;
1029 }
1030
1031 if (calc_mask) {
1032 /* need to calculate the mask from channel count either because this is the query case
1033 * or the specified mask isn't valid for this device, or is more then the FW can handle */
1034 in->hal_channel_mask = in->hal_channel_count <= FCC_2
1035 /* position mask for mono & stereo */
1036 ? audio_channel_in_mask_from_count(in->hal_channel_count)
1037 /* otherwise indexed */
1038 : audio_channel_mask_for_index_assignment_from_count(in->hal_channel_count);
1039
1040 // if we change the mask...
1041 if (in->hal_channel_mask != config->channel_mask &&
1042 config->channel_mask != AUDIO_CHANNEL_NONE) {
1043 config->channel_mask = in->hal_channel_mask;
1044 ret = -EINVAL;
1045 }
1046 } else {
1047 in->hal_channel_mask = config->channel_mask;
1048 }
1049
1050 if (ret == 0) {
1051 // Validate the "logical" channel count against support in the "actual" profile.
1052 // if they differ, choose the "actual" number of channels *closest* to the "logical".
1053 // and store THAT in proxy_config.channels
1054 proxy_config.channels =
1055 profile_get_closest_channel_count(in->profile, in->hal_channel_count);
1056 proxy_prepare(&in->proxy, in->profile, &proxy_config);
1057
1058 in->standby = true;
1059
1060 in->conversion_buffer = NULL;
1061 in->conversion_buffer_size = 0;
1062
1063 *stream_in = &in->stream;
1064
1065 /* Save this for adev_dump() */
1066 adev_add_stream_to_list(in->adev, &in->adev->input_stream_list, &in->list_node);
1067 } else {
1068 // Deallocate this stream on error, because AudioFlinger won't call
1069 // adev_close_input_stream() in this case.
1070 *stream_in = NULL;
1071 free(in);
1072 }
1073
1074 return ret;
1075 }
1076
adev_close_input_stream(struct audio_hw_device * hw_dev,struct audio_stream_in * stream)1077 static void adev_close_input_stream(struct audio_hw_device *hw_dev,
1078 struct audio_stream_in *stream)
1079 {
1080 struct stream_in *in = (struct stream_in *)stream;
1081 ALOGV("adev_close_input_stream(c:%d d:%d)", in->profile->card, in->profile->device);
1082
1083 adev_remove_stream_from_list(in->adev, &in->list_node);
1084
1085 /* Close the pcm device */
1086 in_standby(&stream->common);
1087
1088 free(in->conversion_buffer);
1089
1090 free(stream);
1091 }
1092
1093 /*
1094 * ADEV Functions
1095 */
adev_set_parameters(struct audio_hw_device * hw_dev,const char * kvpairs)1096 static int adev_set_parameters(struct audio_hw_device *hw_dev, const char *kvpairs)
1097 {
1098 return 0;
1099 }
1100
adev_get_parameters(const struct audio_hw_device * hw_dev,const char * keys)1101 static char * adev_get_parameters(const struct audio_hw_device *hw_dev, const char *keys)
1102 {
1103 return strdup("");
1104 }
1105
adev_init_check(const struct audio_hw_device * hw_dev)1106 static int adev_init_check(const struct audio_hw_device *hw_dev)
1107 {
1108 return 0;
1109 }
1110
adev_set_voice_volume(struct audio_hw_device * hw_dev,float volume)1111 static int adev_set_voice_volume(struct audio_hw_device *hw_dev, float volume)
1112 {
1113 return -ENOSYS;
1114 }
1115
adev_set_master_volume(struct audio_hw_device * hw_dev,float volume)1116 static int adev_set_master_volume(struct audio_hw_device *hw_dev, float volume)
1117 {
1118 return -ENOSYS;
1119 }
1120
adev_set_mode(struct audio_hw_device * hw_dev,audio_mode_t mode)1121 static int adev_set_mode(struct audio_hw_device *hw_dev, audio_mode_t mode)
1122 {
1123 return 0;
1124 }
1125
adev_set_mic_mute(struct audio_hw_device * hw_dev,bool state)1126 static int adev_set_mic_mute(struct audio_hw_device *hw_dev, bool state)
1127 {
1128 struct audio_device * adev = (struct audio_device *)hw_dev;
1129 device_lock(adev);
1130 adev->mic_muted = state;
1131 device_unlock(adev);
1132 return -ENOSYS;
1133 }
1134
adev_get_mic_mute(const struct audio_hw_device * hw_dev,bool * state)1135 static int adev_get_mic_mute(const struct audio_hw_device *hw_dev, bool *state)
1136 {
1137 return -ENOSYS;
1138 }
1139
adev_dump(const struct audio_hw_device * device,int fd)1140 static int adev_dump(const struct audio_hw_device *device, int fd)
1141 {
1142 dprintf(fd, "\nUSB audio module:\n");
1143
1144 struct audio_device* adev = (struct audio_device*)device;
1145 const int kNumRetries = 3;
1146 const int kSleepTimeMS = 500;
1147
1148 // use device_try_lock() in case we dumpsys during a deadlock
1149 int retry = kNumRetries;
1150 while (retry > 0 && device_try_lock(adev) != 0) {
1151 sleep(kSleepTimeMS);
1152 retry--;
1153 }
1154
1155 if (retry > 0) {
1156 if (list_empty(&adev->output_stream_list)) {
1157 dprintf(fd, " No output streams.\n");
1158 } else {
1159 struct listnode* node;
1160 list_for_each(node, &adev->output_stream_list) {
1161 struct audio_stream* stream =
1162 (struct audio_stream *)node_to_item(node, struct stream_out, list_node);
1163 out_dump(stream, fd);
1164 }
1165 }
1166
1167 if (list_empty(&adev->input_stream_list)) {
1168 dprintf(fd, "\n No input streams.\n");
1169 } else {
1170 struct listnode* node;
1171 list_for_each(node, &adev->input_stream_list) {
1172 struct audio_stream* stream =
1173 (struct audio_stream *)node_to_item(node, struct stream_in, list_node);
1174 in_dump(stream, fd);
1175 }
1176 }
1177
1178 device_unlock(adev);
1179 } else {
1180 // Couldn't lock
1181 dprintf(fd, " Could not obtain device lock.\n");
1182 }
1183
1184 return 0;
1185 }
1186
adev_close(hw_device_t * device)1187 static int adev_close(hw_device_t *device)
1188 {
1189 struct audio_device *adev = (struct audio_device *)device;
1190 free(device);
1191
1192 return 0;
1193 }
1194
adev_open(const hw_module_t * module,const char * name,hw_device_t ** device)1195 static int adev_open(const hw_module_t* module, const char* name, hw_device_t** device)
1196 {
1197 if (strcmp(name, AUDIO_HARDWARE_INTERFACE) != 0)
1198 return -EINVAL;
1199
1200 struct audio_device *adev = calloc(1, sizeof(struct audio_device));
1201 if (!adev)
1202 return -ENOMEM;
1203
1204 profile_init(&adev->out_profile, PCM_OUT);
1205 profile_init(&adev->in_profile, PCM_IN);
1206
1207 list_init(&adev->output_stream_list);
1208 list_init(&adev->input_stream_list);
1209
1210 adev->hw_device.common.tag = HARDWARE_DEVICE_TAG;
1211 adev->hw_device.common.version = AUDIO_DEVICE_API_VERSION_2_0;
1212 adev->hw_device.common.module = (struct hw_module_t *)module;
1213 adev->hw_device.common.close = adev_close;
1214
1215 adev->hw_device.init_check = adev_init_check;
1216 adev->hw_device.set_voice_volume = adev_set_voice_volume;
1217 adev->hw_device.set_master_volume = adev_set_master_volume;
1218 adev->hw_device.set_mode = adev_set_mode;
1219 adev->hw_device.set_mic_mute = adev_set_mic_mute;
1220 adev->hw_device.get_mic_mute = adev_get_mic_mute;
1221 adev->hw_device.set_parameters = adev_set_parameters;
1222 adev->hw_device.get_parameters = adev_get_parameters;
1223 adev->hw_device.get_input_buffer_size = adev_get_input_buffer_size;
1224 adev->hw_device.open_output_stream = adev_open_output_stream;
1225 adev->hw_device.close_output_stream = adev_close_output_stream;
1226 adev->hw_device.open_input_stream = adev_open_input_stream;
1227 adev->hw_device.close_input_stream = adev_close_input_stream;
1228 adev->hw_device.dump = adev_dump;
1229
1230 *device = &adev->hw_device.common;
1231
1232 return 0;
1233 }
1234
1235 static struct hw_module_methods_t hal_module_methods = {
1236 .open = adev_open,
1237 };
1238
1239 struct audio_module HAL_MODULE_INFO_SYM = {
1240 .common = {
1241 .tag = HARDWARE_MODULE_TAG,
1242 .module_api_version = AUDIO_MODULE_API_VERSION_0_1,
1243 .hal_api_version = HARDWARE_HAL_API_VERSION,
1244 .id = AUDIO_HARDWARE_MODULE_ID,
1245 .name = "USB audio HW HAL",
1246 .author = "The Android Open Source Project",
1247 .methods = &hal_module_methods,
1248 },
1249 };
1250