| /* |
| * Copyright (C) 2011 The Android Open Source Project |
| * Copyright (C) 2012 ARM Ltd |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| #define LOG_TAG "tiny_hw" |
| #define LOG_NDEBUG 0 |
| |
| #include <errno.h> |
| #include <pthread.h> |
| #include <stdint.h> |
| #include <sys/time.h> |
| #include <stdlib.h> |
| |
| #include <cutils/log.h> |
| #include <cutils/str_parms.h> |
| #include <cutils/properties.h> |
| |
| #include <hardware/hardware.h> |
| #include <system/audio.h> |
| #include <hardware/audio.h> |
| |
| #include <tinyalsa/asoundlib.h> |
| #include <audio_utils/resampler.h> |
| #include <audio_utils/echo_reference.h> |
| #include <hardware/audio_effect.h> |
| #include <audio_effects/effect_aec.h> |
| |
| #ifndef LOGE |
| /* JellyBean or higher */ |
| #define LOGE ALOGE |
| #define LOGI ALOGI |
| #define LOGV ALOGV |
| #define LOGW ALOGW |
| #endif |
| |
| #ifdef AUDIO_DEVICE_API_VERSION_0_0 |
| #define audio_format_t int |
| #endif |
| |
| /* Mixer control names Elba */ |
| #define MIXER_MASTER_PLAYBACK_SWITCH "Master Playback Switch" |
| #define MIXER_MASTER_PLAYBACK_VOLUME "Master Playback Volume" |
| |
| #define MIXER_PCM_PLAYBACK_SWITCH "PCM Playback Switch" |
| #define MIXER_PCM_PLAYBACK_VOLUME "PCM Playback Volume" |
| |
| #define MIXER_MIC_PLAYBACK_SWITCH "Mic Playback Switch" |
| #define MIXER_MIC_PLAYBACK_VOLUME "Mic Playback Volume" |
| |
| #define MIXER_MASTER_MONO_PLAYBACK_SWITCH "Master Mono Playback Switch" |
| #define MIXER_MASTER_MONO_PLAYBACK_VOLUME "Master Mono Playback Volume" |
| |
| |
| /* ALSA card */ |
| #define CARD_ELBA 0 |
| |
| /* ALSA ports for card0 */ |
| #define PORT_CODEC 0 /* CODEC port */ |
| |
| /* Minimum granularity - Arbitrary but small value */ |
| #define CODEC_BASE_FRAME_COUNT 32 |
| |
| /* number of base blocks in a short period (low latency) */ |
| #define PERIOD_MULTIPLIER 32 /* 11 ms */ |
| /* number of frames per short period (low latency) */ |
| #define PERIOD_SIZE (CODEC_BASE_FRAME_COUNT * PERIOD_MULTIPLIER) |
| /* number of pseudo periods for low latency playback */ |
| #define PLAYBACK_PERIOD_COUNT 4 |
| |
| /* number of periods for capture */ |
| #define CAPTURE_PERIOD_COUNT 2 |
| |
| /* minimum sleep time in out_write() when write threshold is not reached */ |
| #define MIN_WRITE_SLEEP_US 5000 |
| |
| #define RESAMPLER_BUFFER_FRAMES (PERIOD_SIZE * 2) |
| #define RESAMPLER_BUFFER_SIZE (4 * RESAMPLER_BUFFER_FRAMES) |
| |
| /* Sampling rate reported to Android */ |
| #define DEFAULT_ANDROID_SAMPLING_RATE 44100 |
| |
| /* sampling rate when using codec port */ |
| #define CODEC_SAMPLING_RATE 48000 |
| |
| /* conversion from % to codec gain */ |
| #define PERC_VOLUME(x) ( (int)((x) * 31 )) |
| |
| struct pcm_config pcm_config_out = { |
| .channels = 2, |
| .rate = CODEC_SAMPLING_RATE, |
| .period_size = PERIOD_SIZE, |
| .period_count = PLAYBACK_PERIOD_COUNT, |
| .format = PCM_FORMAT_S16_LE, |
| }; |
| |
| struct pcm_config pcm_config_in = { |
| .channels = 2, |
| .rate = CODEC_SAMPLING_RATE, |
| .period_size = PERIOD_SIZE, |
| .period_count = CAPTURE_PERIOD_COUNT, |
| .format = PCM_FORMAT_S16_LE, |
| }; |
| |
| struct route_setting |
| { |
| char *ctl_name; |
| int intval; |
| char *strval; |
| }; |
| |
| /* These are values that never change */ |
| struct route_setting defaults[] = { |
| /* general */ |
| { |
| .ctl_name = MIXER_MASTER_PLAYBACK_VOLUME, |
| .intval = PERC_VOLUME(1), |
| }, |
| { |
| .ctl_name = MIXER_PCM_PLAYBACK_VOLUME, |
| .intval = PERC_VOLUME(1), |
| }, |
| { |
| .ctl_name = MIXER_MASTER_MONO_PLAYBACK_VOLUME, |
| .intval = PERC_VOLUME(1), |
| }, |
| { |
| .ctl_name = MIXER_MIC_PLAYBACK_VOLUME, |
| .intval = PERC_VOLUME(1), |
| }, |
| { |
| .ctl_name = MIXER_MASTER_PLAYBACK_SWITCH, |
| .intval = 1, |
| }, |
| { |
| .ctl_name = MIXER_PCM_PLAYBACK_SWITCH, |
| .intval = 1, |
| }, |
| { |
| .ctl_name = MIXER_MASTER_MONO_PLAYBACK_SWITCH, |
| .intval = 1, |
| }, |
| { |
| .ctl_name = MIXER_MIC_PLAYBACK_SWITCH, |
| .intval = 1, |
| }, |
| { |
| .ctl_name = NULL, |
| }, |
| }; |
| |
| |
| struct mixer_ctls |
| { |
| struct mixer_ctl *mic_volume; |
| struct mixer_ctl *pcm_volume; |
| struct mixer_ctl *headset_volume; |
| struct mixer_ctl *speaker_volume; |
| struct mixer_ctl *mic_switch; |
| struct mixer_ctl *headset_switch; |
| struct mixer_ctl *speaker_switch; |
| struct mixer_ctl *LHPMux; |
| struct mixer_ctl *RHPMux; |
| struct mixer_ctl *SpkMux; |
| struct mixer_ctl *HPEnDAC; |
| struct mixer_ctl *SpkEnDAC; |
| }; |
| |
| struct alsa_audio_device { |
| struct audio_hw_device hw_device; |
| |
| pthread_mutex_t lock; /* see note below on mutex acquisition order */ |
| struct mixer *mixer; |
| struct mixer_ctls mixer_ctls; |
| int mode; |
| int devices; |
| int in_call; |
| struct alsa_stream_in *active_input; |
| struct alsa_stream_out *active_output; |
| bool mic_mute; |
| struct echo_reference_itfe *echo_reference; |
| }; |
| |
| struct alsa_stream_out { |
| struct audio_stream_out stream; |
| |
| pthread_mutex_t lock; /* see note below on mutex acquisition order */ |
| struct pcm_config config; |
| struct pcm *pcm; |
| struct resampler_itfe *resampler; |
| char *buffer; |
| int standby; |
| struct echo_reference_itfe *echo_reference; |
| struct alsa_audio_device *dev; |
| int write_threshold; |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| audio_format_t format; |
| uint32_t channels; |
| uint32_t sample_rate; |
| #endif |
| }; |
| |
| #define MAX_PREPROCESSORS 3 /* maximum one AGC + one NS + one AEC per input stream */ |
| |
| struct alsa_stream_in { |
| struct audio_stream_in stream; |
| |
| pthread_mutex_t lock; /* see note below on mutex acquisition order */ |
| struct pcm_config config; |
| struct pcm *pcm; |
| int device; |
| struct resampler_itfe *resampler; |
| struct resampler_buffer_provider buf_provider; |
| int16_t *buffer; |
| size_t frames_in; |
| unsigned int requested_rate; /* the android requested sample rate */ |
| int standby; |
| int source; |
| struct echo_reference_itfe *echo_reference; |
| bool need_echo_reference; |
| effect_handle_t preprocessors[MAX_PREPROCESSORS]; |
| int num_preprocessors; |
| int16_t *proc_buf; |
| size_t proc_buf_size; |
| size_t proc_frames_in; |
| int16_t *ref_buf; |
| size_t ref_buf_size; |
| size_t ref_frames_in; |
| int read_status; |
| |
| struct alsa_audio_device *dev; |
| }; |
| |
| /** |
| * NOTE: when multiple mutexes have to be acquired, always respect the |
| * following order: hw device > in stream > out stream |
| */ |
| |
| static int adev_set_voice_volume(struct audio_hw_device *dev, float volume); |
| static int do_input_standby(struct alsa_stream_in *in); |
| static int do_output_standby(struct alsa_stream_out *out); |
| |
| /* The enable flag when 0 makes the assumption that enums are disabled by |
| * "Off" and integers/booleans by 0 */ |
| static int set_route_by_array(struct mixer *mixer, struct route_setting *route, |
| int enable) |
| { |
| struct mixer_ctl *ctl; |
| unsigned int i, j; |
| |
| /* Go through the route array and set each value */ |
| i = 0; |
| while (route[i].ctl_name) { |
| ctl = mixer_get_ctl_by_name(mixer, route[i].ctl_name); |
| if (!ctl) |
| return -EINVAL; |
| |
| if (route[i].strval) { |
| if (enable) |
| mixer_ctl_set_enum_by_string(ctl, route[i].strval); |
| else |
| mixer_ctl_set_enum_by_string(ctl, "Off"); |
| } else { |
| /* This ensures multiple (i.e. stereo) values are set jointly */ |
| for (j = 0; j < mixer_ctl_get_num_values(ctl); j++) { |
| if (enable) |
| mixer_ctl_set_value(ctl, j, route[i].intval); |
| else |
| mixer_ctl_set_value(ctl, j, 0); |
| } |
| } |
| i++; |
| } |
| |
| return 0; |
| } |
| |
| static void force_all_standby(struct alsa_audio_device *adev) |
| { |
| struct alsa_stream_in *in; |
| struct alsa_stream_out *out; |
| |
| if (adev->active_output) { |
| out = adev->active_output; |
| pthread_mutex_lock(&out->lock); |
| do_output_standby(out); |
| pthread_mutex_unlock(&out->lock); |
| } |
| |
| if (adev->active_input) { |
| in = adev->active_input; |
| pthread_mutex_lock(&in->lock); |
| do_input_standby(in); |
| pthread_mutex_unlock(&in->lock); |
| } |
| } |
| |
| /* alsa Example: Tipically the device is in MODE_NORMAL. When you receive a call |
| * MODE_RINGTONE and when you engage in a call MODE_IN_CALL. In MODE_NORMAL the |
| * output is routed to speakers or headset. |
| */ |
| static void select_mode(struct alsa_audio_device *adev) |
| { |
| |
| if (adev->mode == AUDIO_MODE_IN_CALL) { |
| LOGI("Entering IN_CALL state, in_call=%d", adev->in_call); |
| if (!adev->in_call) { |
| force_all_standby(adev); |
| adev->in_call = 1; |
| } |
| } else { |
| LOGI("Leaving IN_CALL state, in_call=%d, mode=%d", |
| adev->in_call, adev->mode); |
| if (adev->in_call) { |
| adev->in_call = 0; |
| force_all_standby(adev); |
| } |
| } |
| } |
| |
| /* must be called with hw device and output stream mutexes locked */ |
| static int start_output_stream(struct alsa_stream_out *out) |
| { |
| struct alsa_audio_device *adev = out->dev; |
| unsigned int card = CARD_ELBA; |
| unsigned int port = PORT_CODEC; |
| |
| adev->active_output = out; |
| |
| /* default to low power: will be corrected in out_write if necessary before first write to |
| * tinyalsa. |
| */ |
| out->write_threshold = PLAYBACK_PERIOD_COUNT * PERIOD_SIZE; |
| out->config.start_threshold = PERIOD_SIZE * 2; |
| out->config.avail_min = PERIOD_SIZE; |
| |
| out->pcm = pcm_open(card, port, PCM_OUT | PCM_MMAP | PCM_NOIRQ, &out->config); |
| |
| if (!pcm_is_ready(out->pcm)) { |
| LOGE("cannot open pcm_out driver: %s", pcm_get_error(out->pcm)); |
| pcm_close(out->pcm); |
| adev->active_output = NULL; |
| return -ENOMEM; |
| } |
| |
| if (adev->echo_reference != NULL) |
| out->echo_reference = adev->echo_reference; |
| |
| out->resampler->reset(out->resampler); |
| |
| return 0; |
| } |
| |
| /* fails if the parameters are not in range */ |
| static int check_input_parameters(uint32_t sample_rate, int format, int channel_count) |
| { |
| if (format != AUDIO_FORMAT_PCM_16_BIT) |
| return -EINVAL; |
| |
| if ((channel_count < 1) || (channel_count > 2)) |
| return -EINVAL; |
| |
| switch(sample_rate) { |
| case 8000: |
| case 11025: |
| case 16000: |
| case 22050: |
| case 24000: |
| case 32000: |
| case 44100: |
| case 48000: |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| /* Returns audio input buffer size according to parameters passed or |
| * 0 if one of the parameters is not supported |
| */ |
| static size_t get_input_buffer_size(uint32_t sample_rate, int format, int channel_count) |
| { |
| size_t size; |
| |
| if (check_input_parameters(sample_rate, format, channel_count) != 0) |
| return 0; |
| |
| /* take resampling into account and return the closest majoring |
| multiple of 16 frames, as audioflinger expects audio buffers to |
| be a multiple of 16 frames */ |
| size = (pcm_config_in.period_size * sample_rate) / pcm_config_in.rate; |
| size = ((size + 15) / 16) * 16; |
| |
| return size * channel_count * sizeof(short); |
| } |
| |
| static void add_echo_reference(struct alsa_stream_out *out, |
| struct echo_reference_itfe *reference) |
| { |
| pthread_mutex_lock(&out->lock); |
| out->echo_reference = reference; |
| pthread_mutex_unlock(&out->lock); |
| } |
| |
| static void remove_echo_reference(struct alsa_stream_out *out, |
| struct echo_reference_itfe *reference) |
| { |
| pthread_mutex_lock(&out->lock); |
| if (out->echo_reference == reference) { |
| /* stop writing to echo reference */ |
| reference->write(reference, NULL); |
| out->echo_reference = NULL; |
| } |
| pthread_mutex_unlock(&out->lock); |
| } |
| |
| static void put_echo_reference(struct alsa_audio_device *adev, |
| struct echo_reference_itfe *reference) |
| { |
| if (adev->echo_reference != NULL && |
| reference == adev->echo_reference) { |
| if (adev->active_output != NULL) |
| remove_echo_reference(adev->active_output, reference); |
| release_echo_reference(reference); |
| adev->echo_reference = NULL; |
| } |
| } |
| |
| static struct echo_reference_itfe *get_echo_reference(struct alsa_audio_device *adev, |
| audio_format_t format, |
| uint32_t channel_count, |
| uint32_t sampling_rate) |
| { |
| put_echo_reference(adev, adev->echo_reference); |
| if (adev->active_output != NULL) { |
| struct audio_stream *stream = &adev->active_output->stream.common; |
| uint32_t wr_channel_count = popcount(stream->get_channels(stream)); |
| uint32_t wr_sampling_rate = stream->get_sample_rate(stream); |
| |
| int status = create_echo_reference(AUDIO_FORMAT_PCM_16_BIT, |
| channel_count, |
| sampling_rate, |
| AUDIO_FORMAT_PCM_16_BIT, |
| wr_channel_count, |
| wr_sampling_rate, |
| &adev->echo_reference); |
| if (status == 0) |
| add_echo_reference(adev->active_output, adev->echo_reference); |
| } |
| return adev->echo_reference; |
| } |
| |
| static int get_playback_delay(struct alsa_stream_out *out, |
| size_t frames, |
| struct echo_reference_buffer *buffer) |
| { |
| size_t kernel_frames; |
| int status; |
| |
| status = pcm_get_htimestamp(out->pcm, &kernel_frames, &buffer->time_stamp); |
| if (status < 0) { |
| buffer->time_stamp.tv_sec = 0; |
| buffer->time_stamp.tv_nsec = 0; |
| buffer->delay_ns = 0; |
| LOGV("get_playback_delay(): pcm_get_htimestamp error," |
| "setting playbackTimestamp to 0"); |
| return status; |
| } |
| |
| kernel_frames = pcm_get_buffer_size(out->pcm) - kernel_frames; |
| |
| /* adjust render time stamp with delay added by current driver buffer. |
| * Add the duration of current frame as we want the render time of the last |
| * sample being written. */ |
| buffer->delay_ns = (long)(((int64_t)(kernel_frames + frames)* 1000000000)/ |
| CODEC_SAMPLING_RATE); |
| |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t out_get_sample_rate(const struct audio_stream *stream) |
| { |
| return DEFAULT_ANDROID_SAMPLING_RATE; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_set_sample_rate(struct audio_stream *stream, uint32_t rate) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static size_t out_get_buffer_size(const struct audio_stream *stream) |
| { |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| |
| /* take resampling into account and return the closest majoring |
| multiple of 16 frames, as audioflinger expects audio buffers to |
| be a multiple of 16 frames */ |
| size_t size = (PERIOD_SIZE * DEFAULT_ANDROID_SAMPLING_RATE) / out->config.rate; |
| size = ((size + 15) / 16) * 16; |
| return size * audio_stream_frame_size((struct audio_stream *)stream); |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t out_get_channels(const struct audio_stream *stream) |
| { |
| return AUDIO_CHANNEL_OUT_STEREO; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static audio_format_t out_get_format(const struct audio_stream *stream) |
| { |
| return AUDIO_FORMAT_PCM_16_BIT; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_set_format(struct audio_stream *stream, audio_format_t format) |
| { |
| return 0; |
| } |
| |
| /*Adam Example: must be called with hw device and output stream mutexes locked */ |
| static int do_output_standby(struct alsa_stream_out *out) |
| { |
| struct alsa_audio_device *adev = out->dev; |
| |
| if (!out->standby) { |
| pcm_close(out->pcm); |
| out->pcm = NULL; |
| |
| adev->active_output = 0; |
| |
| /* stop writing to echo reference */ |
| if (out->echo_reference != NULL) { |
| out->echo_reference->write(out->echo_reference, NULL); |
| out->echo_reference = NULL; |
| } |
| |
| out->standby = 1; |
| } |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_standby(struct audio_stream *stream) |
| { |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| int status; |
| |
| pthread_mutex_lock(&out->dev->lock); |
| pthread_mutex_lock(&out->lock); |
| status = do_output_standby(out); |
| pthread_mutex_unlock(&out->lock); |
| pthread_mutex_unlock(&out->dev->lock); |
| return status; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_dump(const struct audio_stream *stream, int fd) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_set_parameters(struct audio_stream *stream, const char *kvpairs) |
| { |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| struct alsa_audio_device *adev = out->dev; |
| struct alsa_stream_in *in; |
| struct str_parms *parms; |
| char *str; |
| char value[32]; |
| int ret, val = 0; |
| |
| parms = str_parms_create_str(kvpairs); |
| |
| ret = str_parms_get_str(parms, AUDIO_PARAMETER_STREAM_ROUTING, value, sizeof(value)); |
| if (ret >= 0) { |
| val = atoi(value); |
| pthread_mutex_lock(&adev->lock); |
| pthread_mutex_lock(&out->lock); |
| if (((adev->devices & AUDIO_DEVICE_OUT_ALL) != val) && (val != 0)) { |
| adev->devices &= ~AUDIO_DEVICE_OUT_ALL; |
| adev->devices |= val; |
| } |
| pthread_mutex_unlock(&out->lock); |
| pthread_mutex_unlock(&adev->lock); |
| } |
| |
| str_parms_destroy(parms); |
| return ret; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static char * out_get_parameters(const struct audio_stream *stream, const char *keys) |
| { |
| return strdup(""); |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t out_get_latency(const struct audio_stream_out *stream) |
| { |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| |
| return (PERIOD_SIZE * PLAYBACK_PERIOD_COUNT * 1000) / out->config.rate; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_set_volume(struct audio_stream_out *stream, float left, |
| float right) |
| { |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| struct alsa_audio_device *adev = out->dev; |
| |
| mixer_ctl_set_value(adev->mixer_ctls.speaker_volume, 0, |
| PERC_VOLUME(left)); |
| mixer_ctl_set_value(adev->mixer_ctls.speaker_volume, 1, |
| PERC_VOLUME(right)); |
| |
| mixer_ctl_set_value(adev->mixer_ctls.headset_volume, 0, |
| PERC_VOLUME(left)); |
| mixer_ctl_set_value(adev->mixer_ctls.headset_volume, 1, |
| PERC_VOLUME(right)); |
| |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h |
| */ |
| static ssize_t out_write(struct audio_stream_out *stream, const void* buffer, |
| size_t bytes) |
| { |
| int ret; |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| struct alsa_audio_device *adev = out->dev; |
| size_t frame_size = audio_stream_frame_size(&out->stream.common); |
| size_t in_frames = bytes / frame_size; |
| size_t out_frames = RESAMPLER_BUFFER_SIZE / frame_size; |
| struct alsa_stream_in *in; |
| int kernel_frames; |
| void *buf; |
| |
| /* acquiring hw device mutex systematically is useful if a low priority thread is waiting |
| * on the output stream mutex - e.g. executing select_mode() while holding the hw device |
| * mutex |
| */ |
| pthread_mutex_lock(&adev->lock); |
| pthread_mutex_lock(&out->lock); |
| if (out->standby) { |
| ret = start_output_stream(out); |
| if (ret != 0) { |
| pthread_mutex_unlock(&adev->lock); |
| goto exit; |
| } |
| out->standby = 0; |
| } |
| |
| pthread_mutex_unlock(&adev->lock); |
| |
| /* only use resampler if required */ |
| if (out->config.rate != DEFAULT_ANDROID_SAMPLING_RATE) { |
| out->resampler->resample_from_input(out->resampler, |
| (int16_t *)buffer, |
| &in_frames, |
| (int16_t *)out->buffer, |
| &out_frames); |
| buf = out->buffer; |
| } else { |
| out_frames = in_frames; |
| buf = (void *)buffer; |
| } |
| if (out->echo_reference != NULL) { |
| struct echo_reference_buffer b; |
| b.raw = (void *)buffer; |
| b.frame_count = in_frames; |
| |
| get_playback_delay(out, out_frames, &b); |
| out->echo_reference->write(out->echo_reference, &b); |
| } |
| |
| /* do not allow more than out->write_threshold frames in kernel pcm driver buffer */ |
| do { |
| struct timespec time_stamp; |
| |
| if (pcm_get_htimestamp(out->pcm, (unsigned int *)&kernel_frames, &time_stamp) < 0) |
| break; |
| kernel_frames = pcm_get_buffer_size(out->pcm) - kernel_frames; |
| |
| if (kernel_frames > out->write_threshold) { |
| unsigned long time = (unsigned long) |
| (((int64_t)(kernel_frames - out->write_threshold) * 1000000) / |
| CODEC_SAMPLING_RATE); |
| if (time < MIN_WRITE_SLEEP_US) |
| time = MIN_WRITE_SLEEP_US; |
| usleep(time); |
| } |
| } while (kernel_frames > out->write_threshold); |
| |
| ret = pcm_mmap_write(out->pcm, (void *)buf, out_frames * frame_size); |
| |
| exit: |
| pthread_mutex_unlock(&out->lock); |
| |
| if (ret != 0) { |
| usleep(bytes * 1000000 / audio_stream_frame_size(&stream->common) / |
| out_get_sample_rate(&stream->common)); |
| } |
| |
| return bytes; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_get_render_position(const struct audio_stream_out *stream, |
| uint32_t *dsp_frames) |
| { |
| return -EINVAL; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_add_audio_effect(const struct audio_stream *stream, effect_handle_t effect) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int out_remove_audio_effect(const struct audio_stream *stream, effect_handle_t effect) |
| { |
| return 0; |
| } |
| |
| /** audio_stream_in implementation **/ |
| |
| /* must be called with hw device and input stream mutexes locked */ |
| static int start_input_stream(struct alsa_stream_in *in) |
| { |
| int ret = 0; |
| struct alsa_audio_device *adev = in->dev; |
| |
| adev->active_input = in; |
| |
| if (adev->mode != AUDIO_MODE_IN_CALL) { |
| adev->devices &= ~AUDIO_DEVICE_IN_ALL; |
| adev->devices |= in->device; |
| } |
| |
| if (in->need_echo_reference && in->echo_reference == NULL) |
| in->echo_reference = get_echo_reference(adev, |
| AUDIO_FORMAT_PCM_16_BIT, |
| in->config.channels, |
| in->requested_rate); |
| |
| /* this assumes routing is done previously */ |
| in->pcm = pcm_open(0, PORT_CODEC, PCM_IN, &in->config); |
| if (!pcm_is_ready(in->pcm)) { |
| LOGE("cannot open pcm_in driver: %s", pcm_get_error(in->pcm)); |
| pcm_close(in->pcm); |
| adev->active_input = NULL; |
| return -ENOMEM; |
| } |
| |
| /* if no supported sample rate is available, use the resampler */ |
| if (in->resampler) { |
| in->resampler->reset(in->resampler); |
| in->frames_in = 0; |
| } |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t in_get_sample_rate(const struct audio_stream *stream) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| |
| return in->requested_rate; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_set_sample_rate(struct audio_stream *stream, uint32_t rate) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static size_t in_get_buffer_size(const struct audio_stream *stream) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| |
| return get_input_buffer_size(in->requested_rate, |
| AUDIO_FORMAT_PCM_16_BIT, |
| in->config.channels); |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t in_get_channels(const struct audio_stream *stream) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| |
| if (in->config.channels == 1) { |
| return AUDIO_CHANNEL_IN_MONO; |
| } else { |
| return AUDIO_CHANNEL_IN_STEREO; |
| } |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_get_format(const struct audio_stream *stream) |
| { |
| return AUDIO_FORMAT_PCM_16_BIT; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_set_format(struct audio_stream *stream, int format) |
| { |
| return 0; |
| } |
| |
| /* must be called with hw device and input stream mutexes locked */ |
| static int do_input_standby(struct alsa_stream_in *in) |
| { |
| struct alsa_audio_device *adev = in->dev; |
| |
| if (!in->standby) { |
| pcm_close(in->pcm); |
| in->pcm = NULL; |
| |
| adev->active_input = 0; |
| if (adev->mode != AUDIO_MODE_IN_CALL) { |
| adev->devices &= ~AUDIO_DEVICE_IN_ALL; |
| } |
| |
| if (in->echo_reference != NULL) { |
| /* stop reading from echo reference */ |
| in->echo_reference->read(in->echo_reference, NULL); |
| put_echo_reference(adev, in->echo_reference); |
| in->echo_reference = NULL; |
| } |
| |
| in->standby = 1; |
| } |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_standby(struct audio_stream *stream) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| int status; |
| |
| pthread_mutex_lock(&in->dev->lock); |
| pthread_mutex_lock(&in->lock); |
| status = do_input_standby(in); |
| pthread_mutex_unlock(&in->lock); |
| pthread_mutex_unlock(&in->dev->lock); |
| return status; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_dump(const struct audio_stream *stream, int fd) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_set_parameters(struct audio_stream *stream, const char *kvpairs) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| struct alsa_audio_device *adev = in->dev; |
| struct str_parms *parms; |
| char *str; |
| char value[32]; |
| int ret, val = 0; |
| bool do_standby = false; |
| |
| parms = str_parms_create_str(kvpairs); |
| |
| ret = str_parms_get_str(parms, AUDIO_PARAMETER_STREAM_INPUT_SOURCE, value, sizeof(value)); |
| |
| pthread_mutex_lock(&adev->lock); |
| pthread_mutex_lock(&in->lock); |
| if (ret >= 0) { |
| val = atoi(value); |
| /* no audio source uses val == 0 */ |
| if ((in->source != val) && (val != 0)) { |
| in->source = val; |
| do_standby = true; |
| } |
| } |
| |
| ret = str_parms_get_str(parms, AUDIO_PARAMETER_STREAM_ROUTING, value, sizeof(value)); |
| if (ret >= 0) { |
| val = atoi(value); |
| if ((in->device != val) && (val != 0)) { |
| in->device = val; |
| do_standby = true; |
| } |
| } |
| |
| if (do_standby) |
| do_input_standby(in); |
| pthread_mutex_unlock(&in->lock); |
| pthread_mutex_unlock(&adev->lock); |
| |
| str_parms_destroy(parms); |
| return ret; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static char * in_get_parameters(const struct audio_stream *stream, |
| const char *keys) |
| { |
| return strdup(""); |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_set_gain(struct audio_stream_in *stream, float gain) |
| { |
| return 0; |
| } |
| |
| static void get_capture_delay(struct alsa_stream_in *in, |
| size_t frames, |
| struct echo_reference_buffer *buffer) |
| { |
| |
| /* read frames available in kernel driver buffer */ |
| size_t kernel_frames; |
| struct timespec tstamp; |
| long buf_delay; |
| long rsmp_delay; |
| long kernel_delay; |
| long delay_ns; |
| |
| if (pcm_get_htimestamp(in->pcm, &kernel_frames, &tstamp) < 0) { |
| buffer->time_stamp.tv_sec = 0; |
| buffer->time_stamp.tv_nsec = 0; |
| buffer->delay_ns = 0; |
| LOGW("read get_capture_delay(): pcm_htimestamp error"); |
| return; |
| } |
| |
| /* read frames available in audio HAL input buffer |
| * add number of frames being read as we want the capture time of first sample |
| * in current buffer */ |
| buf_delay = (long)(((int64_t)(in->frames_in + in->proc_frames_in) * 1000000000) |
| / in->config.rate); |
| /* add delay introduced by resampler */ |
| rsmp_delay = 0; |
| if (in->resampler) { |
| rsmp_delay = in->resampler->delay_ns(in->resampler); |
| } |
| |
| kernel_delay = (long)(((int64_t)kernel_frames * 1000000000) / in->config.rate); |
| |
| delay_ns = kernel_delay + buf_delay + rsmp_delay; |
| |
| buffer->time_stamp = tstamp; |
| buffer->delay_ns = delay_ns; |
| LOGV("get_capture_delay time_stamp = [%ld].[%ld], delay_ns: [%d]," |
| " kernel_delay:[%ld], buf_delay:[%ld], rsmp_delay:[%ld], kernel_frames:[%d], " |
| "in->frames_in:[%d], in->proc_frames_in:[%d], frames:[%d]", |
| buffer->time_stamp.tv_sec , buffer->time_stamp.tv_nsec, buffer->delay_ns, |
| kernel_delay, buf_delay, rsmp_delay, kernel_frames, |
| in->frames_in, in->proc_frames_in, frames); |
| |
| } |
| |
| static int32_t update_echo_reference(struct alsa_stream_in *in, size_t frames) |
| { |
| struct echo_reference_buffer b; |
| b.delay_ns = 0; |
| |
| LOGV("update_echo_reference, frames = [%d], in->ref_frames_in = [%d], " |
| "b.frame_count = [%d]", |
| frames, in->ref_frames_in, frames - in->ref_frames_in); |
| if (in->ref_frames_in < frames) { |
| if (in->ref_buf_size < frames) { |
| in->ref_buf_size = frames; |
| in->ref_buf = (int16_t *)realloc(in->ref_buf, |
| in->ref_buf_size * |
| in->config.channels * sizeof(int16_t)); |
| } |
| |
| b.frame_count = frames - in->ref_frames_in; |
| b.raw = (void *)(in->ref_buf + in->ref_frames_in * in->config.channels); |
| |
| get_capture_delay(in, frames, &b); |
| |
| if (in->echo_reference->read(in->echo_reference, &b) == 0) |
| { |
| in->ref_frames_in += b.frame_count; |
| LOGV("update_echo_reference: in->ref_frames_in:[%d], " |
| "in->ref_buf_size:[%d], frames:[%d], b.frame_count:[%d]", |
| in->ref_frames_in, in->ref_buf_size, frames, b.frame_count); |
| } |
| } else |
| LOGW("update_echo_reference: NOT enough frames to read ref buffer"); |
| return b.delay_ns; |
| } |
| |
| static int set_preprocessor_param(effect_handle_t handle, |
| effect_param_t *param) |
| { |
| uint32_t size = sizeof(int); |
| uint32_t psize = ((param->psize - 1) / sizeof(int) + 1) * sizeof(int) + |
| param->vsize; |
| |
| int status = (*handle)->command(handle, |
| EFFECT_CMD_SET_PARAM, |
| sizeof (effect_param_t) + psize, |
| param, |
| &size, |
| ¶m->status); |
| if (status == 0) |
| status = param->status; |
| |
| return status; |
| } |
| |
| static int set_preprocessor_echo_delay(effect_handle_t handle, |
| int32_t delay_us) |
| { |
| return 0; |
| } |
| |
| static void push_echo_reference(struct alsa_stream_in *in, size_t frames) |
| { |
| /* read frames from echo reference buffer and update echo delay |
| * in->ref_frames_in is updated with frames available in in->ref_buf */ |
| int32_t delay_us = update_echo_reference(in, frames)/1000; |
| int i; |
| audio_buffer_t buf; |
| |
| if (in->ref_frames_in < frames) |
| frames = in->ref_frames_in; |
| |
| buf.frameCount = frames; |
| buf.raw = in->ref_buf; |
| |
| for (i = 0; i < in->num_preprocessors; i++) { |
| if ((*in->preprocessors[i])->process_reverse == NULL) |
| continue; |
| |
| (*in->preprocessors[i])->process_reverse(in->preprocessors[i], |
| &buf, |
| NULL); |
| set_preprocessor_echo_delay(in->preprocessors[i], delay_us); |
| } |
| |
| in->ref_frames_in -= buf.frameCount; |
| if (in->ref_frames_in) { |
| memcpy(in->ref_buf, |
| in->ref_buf + buf.frameCount * in->config.channels, |
| in->ref_frames_in * in->config.channels * sizeof(int16_t)); |
| } |
| } |
| |
| static int get_next_buffer(struct resampler_buffer_provider *buffer_provider, |
| struct resampler_buffer* buffer) |
| { |
| struct alsa_stream_in *in; |
| |
| if (buffer_provider == NULL || buffer == NULL) |
| return -EINVAL; |
| |
| in = (struct alsa_stream_in *)((char *)buffer_provider - |
| offsetof(struct alsa_stream_in, buf_provider)); |
| |
| if (in->pcm == NULL) { |
| buffer->raw = NULL; |
| buffer->frame_count = 0; |
| in->read_status = -ENODEV; |
| return -ENODEV; |
| } |
| |
| if (in->frames_in == 0) { |
| in->read_status = pcm_read(in->pcm, |
| (void*)in->buffer, |
| in->config.period_size * |
| audio_stream_frame_size(&in->stream.common)); |
| if (in->read_status != 0) { |
| LOGE("get_next_buffer() pcm_read error %d", in->read_status); |
| buffer->raw = NULL; |
| buffer->frame_count = 0; |
| return in->read_status; |
| } |
| in->frames_in = in->config.period_size; |
| } |
| |
| buffer->frame_count = (buffer->frame_count > in->frames_in) ? |
| in->frames_in : buffer->frame_count; |
| buffer->i16 = in->buffer + (in->config.period_size - in->frames_in) * |
| in->config.channels; |
| |
| return in->read_status; |
| |
| } |
| |
| static void release_buffer(struct resampler_buffer_provider *buffer_provider, |
| struct resampler_buffer* buffer) |
| { |
| struct alsa_stream_in *in; |
| |
| if (buffer_provider == NULL || buffer == NULL) |
| return; |
| |
| in = (struct alsa_stream_in *)((char *)buffer_provider - |
| offsetof(struct alsa_stream_in, buf_provider)); |
| |
| in->frames_in -= buffer->frame_count; |
| } |
| |
| /* read_frames() reads frames from kernel driver, down samples to capture rate |
| * if necessary and output the number of frames requested to the buffer specified */ |
| static ssize_t read_frames(struct alsa_stream_in *in, void *buffer, ssize_t frames) |
| { |
| ssize_t frames_wr = 0; |
| |
| while (frames_wr < frames) { |
| size_t frames_rd = frames - frames_wr; |
| if (in->resampler != NULL) { |
| in->resampler->resample_from_provider(in->resampler, |
| (int16_t *)((char *)buffer + |
| frames_wr * audio_stream_frame_size(&in->stream.common)), |
| &frames_rd); |
| } else { |
| struct resampler_buffer buf = { |
| { raw : NULL, }, |
| frame_count : frames_rd, |
| }; |
| get_next_buffer(&in->buf_provider, &buf); |
| if (buf.raw != NULL) { |
| memcpy((char *)buffer + |
| frames_wr * audio_stream_frame_size(&in->stream.common), |
| buf.raw, |
| buf.frame_count * audio_stream_frame_size(&in->stream.common)); |
| frames_rd = buf.frame_count; |
| } |
| release_buffer(&in->buf_provider, &buf); |
| } |
| /* in->read_status is updated by getNextBuffer() also called by |
| * in->resampler->resample_from_provider() */ |
| if (in->read_status != 0) |
| return in->read_status; |
| |
| frames_wr += frames_rd; |
| } |
| return frames_wr; |
| } |
| |
| /* process_frames() reads frames from kernel driver (via read_frames()), |
| * calls the active audio pre processings and output the number of frames requested |
| * to the buffer specified */ |
| static ssize_t process_frames(struct alsa_stream_in *in, void* buffer, ssize_t frames) |
| { |
| ssize_t frames_wr = 0; |
| audio_buffer_t in_buf; |
| audio_buffer_t out_buf; |
| int i; |
| |
| while (frames_wr < frames) { |
| /* first reload enough frames at the end of process input buffer */ |
| if (in->proc_frames_in < (size_t)frames) { |
| ssize_t frames_rd; |
| |
| if (in->proc_buf_size < (size_t)frames) { |
| in->proc_buf_size = (size_t)frames; |
| in->proc_buf = (int16_t *)realloc(in->proc_buf, |
| in->proc_buf_size * |
| in->config.channels * sizeof(int16_t)); |
| LOGV("process_frames(): in->proc_buf %p size extended to %d frames", |
| in->proc_buf, in->proc_buf_size); |
| } |
| frames_rd = read_frames(in, |
| in->proc_buf + |
| in->proc_frames_in * in->config.channels, |
| frames - in->proc_frames_in); |
| if (frames_rd < 0) { |
| frames_wr = frames_rd; |
| break; |
| } |
| in->proc_frames_in += frames_rd; |
| } |
| |
| if (in->echo_reference != NULL) |
| push_echo_reference(in, in->proc_frames_in); |
| |
| /* in_buf.frameCount and out_buf.frameCount indicate respectively |
| * the maximum number of frames to be consumed and produced by process() */ |
| in_buf.frameCount = in->proc_frames_in; |
| in_buf.s16 = in->proc_buf; |
| out_buf.frameCount = frames - frames_wr; |
| out_buf.s16 = (int16_t *)buffer + frames_wr * in->config.channels; |
| |
| for (i = 0; i < in->num_preprocessors; i++) |
| (*in->preprocessors[i])->process(in->preprocessors[i], |
| &in_buf, |
| &out_buf); |
| |
| /* process() has updated the number of frames consumed and produced in |
| * in_buf.frameCount and out_buf.frameCount respectively |
| * move remaining frames to the beginning of in->proc_buf */ |
| in->proc_frames_in -= in_buf.frameCount; |
| if (in->proc_frames_in) { |
| memcpy(in->proc_buf, |
| in->proc_buf + in_buf.frameCount * in->config.channels, |
| in->proc_frames_in * in->config.channels * sizeof(int16_t)); |
| } |
| |
| /* if not enough frames were passed to process(), read more and retry. */ |
| if (out_buf.frameCount == 0) |
| continue; |
| |
| frames_wr += out_buf.frameCount; |
| } |
| return frames_wr; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static ssize_t in_read(struct audio_stream_in *stream, void* buffer, |
| size_t bytes) |
| { |
| int ret = 0; |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| struct alsa_audio_device *adev = in->dev; |
| size_t frames_rq = bytes / audio_stream_frame_size(&stream->common); |
| |
| /* acquiring hw device mutex systematically is useful if a low priority thread is waiting |
| * on the input stream mutex - e.g. executing select_mode() while holding the hw device |
| * mutex |
| */ |
| pthread_mutex_lock(&adev->lock); |
| pthread_mutex_lock(&in->lock); |
| if (in->standby) { |
| ret = start_input_stream(in); |
| if (ret == 0) |
| in->standby = 0; |
| } |
| pthread_mutex_unlock(&adev->lock); |
| |
| if (ret < 0) |
| goto exit; |
| |
| if (in->num_preprocessors != 0) |
| ret = process_frames(in, buffer, frames_rq); |
| else if (in->resampler != NULL) |
| ret = read_frames(in, buffer, frames_rq); |
| else |
| ret = pcm_read(in->pcm, buffer, bytes); |
| |
| if (ret > 0) |
| ret = 0; |
| |
| if (ret == 0 && adev->mic_mute) |
| memset(buffer, 0, bytes); |
| |
| exit: |
| if (ret < 0) |
| usleep(bytes * 1000000 / audio_stream_frame_size(&stream->common) / |
| in_get_sample_rate(&stream->common)); |
| |
| pthread_mutex_unlock(&in->lock); |
| return bytes; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t in_get_input_frames_lost(struct audio_stream_in *stream) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_add_audio_effect(const struct audio_stream *stream, |
| effect_handle_t effect) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| int status; |
| effect_descriptor_t desc; |
| |
| pthread_mutex_lock(&in->dev->lock); |
| pthread_mutex_lock(&in->lock); |
| if (in->num_preprocessors >= MAX_PREPROCESSORS) { |
| status = -ENOSYS; |
| goto exit; |
| } |
| |
| status = (*effect)->get_descriptor(effect, &desc); |
| if (status != 0) |
| goto exit; |
| |
| in->preprocessors[in->num_preprocessors++] = effect; |
| |
| if (memcmp(&desc.type, FX_IID_AEC, sizeof(effect_uuid_t)) == 0) { |
| in->need_echo_reference = true; |
| do_input_standby(in); |
| } |
| |
| exit: |
| |
| pthread_mutex_unlock(&in->lock); |
| pthread_mutex_unlock(&in->dev->lock); |
| return status; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int in_remove_audio_effect(const struct audio_stream *stream, |
| effect_handle_t effect) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| int i; |
| int status = -EINVAL; |
| bool found = false; |
| effect_descriptor_t desc; |
| |
| pthread_mutex_lock(&in->dev->lock); |
| pthread_mutex_lock(&in->lock); |
| if (in->num_preprocessors <= 0) { |
| status = -ENOSYS; |
| goto exit; |
| } |
| |
| for (i = 0; i < in->num_preprocessors; i++) { |
| if (found) { |
| in->preprocessors[i - 1] = in->preprocessors[i]; |
| continue; |
| } |
| if (in->preprocessors[i] == effect) { |
| in->preprocessors[i] = NULL; |
| status = 0; |
| found = true; |
| } |
| } |
| |
| if (status != 0) |
| goto exit; |
| |
| in->num_preprocessors--; |
| |
| status = (*effect)->get_descriptor(effect, &desc); |
| if (status != 0) |
| goto exit; |
| if (memcmp(&desc.type, FX_IID_AEC, sizeof(effect_uuid_t)) == 0) { |
| in->need_echo_reference = false; |
| do_input_standby(in); |
| } |
| |
| exit: |
| |
| pthread_mutex_unlock(&in->lock); |
| pthread_mutex_unlock(&in->dev->lock); |
| return status; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| static int adev_open_output_stream(struct audio_hw_device *dev, |
| audio_io_handle_t handle, |
| audio_devices_t devices, |
| audio_output_flags_t flags, |
| struct audio_config *config, |
| struct audio_stream_out **stream_out) |
| #else |
| static int adev_open_output_stream(struct audio_hw_device *dev, |
| uint32_t devices, int *format, |
| uint32_t *channels, uint32_t *sample_rate, |
| struct audio_stream_out **stream_out) |
| #endif |
| { |
| struct alsa_audio_device *ladev = (struct alsa_audio_device *)dev; |
| struct alsa_stream_out *out; |
| int ret = 0; |
| |
| out = (struct alsa_stream_out *)calloc(1, sizeof(struct alsa_stream_out)); |
| if (!out) |
| return -ENOMEM; |
| |
| ret = create_resampler(DEFAULT_ANDROID_SAMPLING_RATE, |
| CODEC_SAMPLING_RATE, |
| 2, |
| RESAMPLER_QUALITY_DEFAULT, |
| NULL, |
| &out->resampler); |
| if (ret != 0) |
| goto err_open; |
| out->buffer = malloc(RESAMPLER_BUFFER_SIZE); /* todo: allow for reallocing */ |
| |
| out->stream.common.get_sample_rate = out_get_sample_rate; |
| out->stream.common.set_sample_rate = out_set_sample_rate; |
| out->stream.common.get_buffer_size = out_get_buffer_size; |
| out->stream.common.get_channels = out_get_channels; |
| out->stream.common.get_format = out_get_format; |
| out->stream.common.set_format = out_set_format; |
| out->stream.common.standby = out_standby; |
| out->stream.common.dump = out_dump; |
| out->stream.common.set_parameters = out_set_parameters; |
| out->stream.common.get_parameters = out_get_parameters; |
| out->stream.common.add_audio_effect = out_add_audio_effect; |
| out->stream.common.remove_audio_effect = out_remove_audio_effect; |
| out->stream.get_latency = out_get_latency; |
| out->stream.set_volume = out_set_volume; |
| out->stream.write = out_write; |
| out->stream.get_render_position = out_get_render_position; |
| |
| /* adev_open_input_stream() */ |
| memcpy(&out->config, &pcm_config_out, sizeof(pcm_config_out)); |
| |
| out->dev = ladev; |
| out->standby = 1; |
| |
| /* FIXME: when we support multiple output devices, we will want to |
| * do the following: |
| * adev->devices &= ~AUDIO_DEVICE_OUT_ALL; |
| * adev->devices |= out->device; |
| * This is because out_set_parameters() with a route is not |
| * guaranteed to be called after an output stream is opened. */ |
| |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| config->format = out_get_format(&out->stream.common); |
| config->channel_mask = out_get_channels(&out->stream.common); |
| config->sample_rate = out_get_sample_rate(&out->stream.common); |
| #else |
| *format = out_get_format(&out->stream.common); |
| *channels = out_get_channels(&out->stream.common); |
| *sample_rate = out_get_sample_rate(&out->stream.common); |
| #endif |
| |
| *stream_out = &out->stream; |
| |
| return 0; |
| |
| err_open: |
| free(out); |
| *stream_out = NULL; |
| return ret; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static void adev_close_output_stream(struct audio_hw_device *dev, |
| struct audio_stream_out *stream) |
| { |
| struct alsa_stream_out *out = (struct alsa_stream_out *)stream; |
| |
| out_standby(&stream->common); |
| if (out->buffer) |
| free(out->buffer); |
| if (out->resampler) |
| release_resampler(out->resampler); |
| free(stream); |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_set_parameters(struct audio_hw_device *dev, const char *kvpairs) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static char * adev_get_parameters(const struct audio_hw_device *dev, |
| const char *keys) |
| { |
| return strdup(""); |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_init_check(const struct audio_hw_device *dev) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_set_voice_volume(struct audio_hw_device *dev, float volume) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_set_master_volume(struct audio_hw_device *dev, float volume) |
| { |
| struct alsa_audio_device *adev = (struct alsa_audio_device *)dev; |
| int ret=0; |
| |
| ret=mixer_ctl_set_value(adev->mixer_ctls.pcm_volume, 0, |
| PERC_VOLUME(volume)); |
| if(ret != 0) |
| goto exit; |
| ret=mixer_ctl_set_value(adev->mixer_ctls.pcm_volume, 1, |
| PERC_VOLUME(volume)); |
| if(ret != 0) |
| goto exit; |
| |
| return ret; |
| |
| exit: |
| return -ENOSYS; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_set_mode(struct audio_hw_device *dev, int mode) |
| { |
| struct alsa_audio_device *adev = (struct alsa_audio_device *)dev; |
| |
| pthread_mutex_lock(&adev->lock); |
| if (adev->mode != mode) { |
| adev->mode = mode; |
| select_mode(adev); |
| } |
| pthread_mutex_unlock(&adev->lock); |
| |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_set_mic_mute(struct audio_hw_device *dev, bool state) |
| { |
| struct alsa_audio_device *adev = (struct alsa_audio_device *)dev; |
| |
| adev->mic_mute = state; |
| |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_get_mic_mute(const struct audio_hw_device *dev, bool *state) |
| { |
| struct alsa_audio_device *adev = (struct alsa_audio_device *)dev; |
| |
| *state = adev->mic_mute; |
| |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| static size_t adev_get_input_buffer_size(const struct audio_hw_device *dev, |
| const struct audio_config *config) |
| #else |
| static size_t adev_get_input_buffer_size(const struct audio_hw_device *dev, |
| uint32_t sample_rate, int format, |
| int channel_count) |
| #endif |
| { |
| size_t size; |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| int channel_count = popcount(config->channel_mask); |
| if (check_input_parameters(config->sample_rate, config->format, |
| channel_count) != 0) |
| return 0; |
| |
| return get_input_buffer_size(config->sample_rate, config->format, |
| channel_count); |
| #else |
| if (check_input_parameters(sample_rate, format, channel_count) != 0) |
| return 0; |
| |
| return get_input_buffer_size(sample_rate, format, channel_count); |
| #endif |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| static int adev_open_input_stream(struct audio_hw_device *dev, |
| audio_io_handle_t handle, |
| audio_devices_t devices, |
| struct audio_config *config, |
| struct audio_stream_in **stream_in) |
| #else |
| static int adev_open_input_stream(struct audio_hw_device *dev, uint32_t devices, |
| int *format, uint32_t *channel_mask, |
| uint32_t *sample_rate, |
| audio_in_acoustics_t acoustics, |
| struct audio_stream_in **stream_in) |
| #endif |
| { |
| struct alsa_audio_device *ladev = (struct alsa_audio_device *)dev; |
| struct alsa_stream_in *in; |
| int ret; |
| |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| int channel_count = popcount(config->channel_mask); |
| if (check_input_parameters(config->sample_rate, config->format, |
| channel_count) != 0) |
| #else |
| int channel_count = popcount(*channel_mask); |
| if (check_input_parameters(*sample_rate, *format, channel_count) != 0) |
| #endif |
| return -EINVAL; |
| |
| in = (struct alsa_stream_in *)calloc(1, sizeof(struct alsa_stream_in)); |
| if (!in) |
| return -ENOMEM; |
| |
| in->stream.common.get_sample_rate = in_get_sample_rate; |
| in->stream.common.set_sample_rate = in_set_sample_rate; |
| in->stream.common.get_buffer_size = in_get_buffer_size; |
| in->stream.common.get_channels = in_get_channels; |
| in->stream.common.get_format = in_get_format; |
| in->stream.common.set_format = in_set_format; |
| in->stream.common.standby = in_standby; |
| in->stream.common.dump = in_dump; |
| in->stream.common.set_parameters = in_set_parameters; |
| in->stream.common.get_parameters = in_get_parameters; |
| in->stream.common.add_audio_effect = in_add_audio_effect; |
| in->stream.common.remove_audio_effect = in_remove_audio_effect; |
| in->stream.set_gain = in_set_gain; |
| in->stream.read = in_read; |
| in->stream.get_input_frames_lost = in_get_input_frames_lost; |
| |
| #ifdef AUDIO_DEVICE_API_VERSION_1_0 |
| in->requested_rate = config->sample_rate; |
| #else |
| in->requested_rate = *sample_rate; |
| #endif |
| |
| memcpy(&in->config, &pcm_config_in, sizeof(pcm_config_in)); |
| in->config.channels = channel_count; |
| |
| in->buffer = malloc(in->config.period_size * |
| audio_stream_frame_size(&in->stream.common)); |
| if (!in->buffer) { |
| ret = -ENOMEM; |
| goto err; |
| } |
| |
| if (in->requested_rate != in->config.rate) { |
| in->buf_provider.get_next_buffer = get_next_buffer; |
| in->buf_provider.release_buffer = release_buffer; |
| |
| ret = create_resampler(in->config.rate, |
| in->requested_rate, |
| in->config.channels, |
| RESAMPLER_QUALITY_DEFAULT, |
| &in->buf_provider, |
| &in->resampler); |
| if (ret != 0) { |
| ret = -EINVAL; |
| goto err; |
| } |
| } |
| |
| in->dev = ladev; |
| in->standby = 1; |
| in->device = devices; |
| |
| *stream_in = &in->stream; |
| return 0; |
| |
| err: |
| if (in->resampler) |
| release_resampler(in->resampler); |
| |
| free(in); |
| *stream_in = NULL; |
| return ret; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static void adev_close_input_stream(struct audio_hw_device *dev, |
| struct audio_stream_in *stream) |
| { |
| struct alsa_stream_in *in = (struct alsa_stream_in *)stream; |
| |
| in_standby(&stream->common); |
| |
| if (in->resampler) { |
| free(in->buffer); |
| release_resampler(in->resampler); |
| } |
| if (in->proc_buf) |
| free(in->proc_buf); |
| if (in->ref_buf) |
| free(in->ref_buf); |
| |
| free(stream); |
| return; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_dump(const audio_hw_device_t *device, int fd) |
| { |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static int adev_close(hw_device_t *device) |
| { |
| struct alsa_audio_device *adev = (struct alsa_audio_device *)device; |
| |
| mixer_close(adev->mixer); |
| free(device); |
| return 0; |
| } |
| |
| /* interface libhardware/include/hardware/audio.h */ |
| static uint32_t adev_get_supported_devices(const struct audio_hw_device *dev) |
| { |
| return (/* OUT */ |
| AUDIO_DEVICE_OUT_SPEAKER | |
| AUDIO_DEVICE_OUT_WIRED_HEADPHONE | |
| AUDIO_DEVICE_OUT_DEFAULT | |
| /* IN */ |
| AUDIO_DEVICE_IN_BUILTIN_MIC | |
| AUDIO_DEVICE_IN_DEFAULT); |
| } |
| |
| static int adev_open(const hw_module_t* module, const char* name, |
| hw_device_t** device) |
| { |
| struct alsa_audio_device *adev; |
| int ret; |
| |
| if (strcmp(name, AUDIO_HARDWARE_INTERFACE) != 0) |
| return -EINVAL; |
| |
| adev = calloc(1, sizeof(struct alsa_audio_device)); |
| if (!adev) |
| return -ENOMEM; |
| |
| adev->hw_device.common.tag = HARDWARE_DEVICE_TAG; |
| adev->hw_device.common.version = AUDIO_DEVICE_API_VERSION_CURRENT; |
| adev->hw_device.common.module = (struct hw_module_t *) module; |
| adev->hw_device.common.close = adev_close; |
| |
| adev->hw_device.get_supported_devices = adev_get_supported_devices; |
| adev->hw_device.init_check = adev_init_check; |
| adev->hw_device.set_voice_volume = adev_set_voice_volume; |
| adev->hw_device.set_master_volume = adev_set_master_volume; |
| adev->hw_device.set_mode = adev_set_mode; |
| adev->hw_device.set_mic_mute = adev_set_mic_mute; |
| adev->hw_device.get_mic_mute = adev_get_mic_mute; |
| adev->hw_device.set_parameters = adev_set_parameters; |
| adev->hw_device.get_parameters = adev_get_parameters; |
| adev->hw_device.get_input_buffer_size = adev_get_input_buffer_size; |
| adev->hw_device.open_output_stream = adev_open_output_stream; |
| adev->hw_device.close_output_stream = adev_close_output_stream; |
| adev->hw_device.open_input_stream = adev_open_input_stream; |
| adev->hw_device.close_input_stream = adev_close_input_stream; |
| adev->hw_device.dump = adev_dump; |
| |
| adev->mixer = mixer_open(0); |
| if (!adev->mixer) { |
| free(adev); |
| LOGE("Unable to open the mixer, aborting."); |
| return -EINVAL; |
| } |
| |
| |
| adev->mixer_ctls.mic_volume = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_MASTER_PLAYBACK_SWITCH); |
| if (!adev->mixer_ctls.mic_volume) { |
| LOGE("Error mixer control: '%s' not found",MIXER_MASTER_PLAYBACK_SWITCH); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.pcm_volume = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_MASTER_PLAYBACK_VOLUME); |
| if (!adev->mixer_ctls.pcm_volume) { |
| LOGE("Error mixer control: '%s' not found",MIXER_MASTER_PLAYBACK_VOLUME); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.headset_volume = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_PCM_PLAYBACK_SWITCH); |
| if (!adev->mixer_ctls.headset_volume) { |
| LOGE("Error mixer control: '%s' not found",MIXER_PCM_PLAYBACK_SWITCH); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.speaker_volume = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_PCM_PLAYBACK_VOLUME); |
| if (!adev->mixer_ctls.speaker_volume) { |
| LOGE("Error mixer control: '%s' not found",MIXER_PCM_PLAYBACK_VOLUME); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.mic_switch = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_MIC_PLAYBACK_SWITCH); |
| if (!adev->mixer_ctls.mic_switch) { |
| LOGE("Error mixer control: '%s' not found",MIXER_MIC_PLAYBACK_SWITCH); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.headset_switch = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_MIC_PLAYBACK_VOLUME); |
| if (!adev->mixer_ctls.headset_switch) { |
| LOGE("Error mixer control: '%s' not found",MIXER_MIC_PLAYBACK_VOLUME); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.speaker_switch = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_MASTER_MONO_PLAYBACK_SWITCH); |
| if (!adev->mixer_ctls.speaker_switch) { |
| LOGE("Error mixer control: '%s' not found",MIXER_MASTER_MONO_PLAYBACK_SWITCH); |
| goto error_out; |
| } |
| |
| adev->mixer_ctls.speaker_switch = mixer_get_ctl_by_name(adev->mixer, |
| MIXER_MASTER_MONO_PLAYBACK_VOLUME); |
| if (!adev->mixer_ctls.speaker_switch) { |
| LOGE("Error mixer control: '%s' not found",MIXER_MASTER_MONO_PLAYBACK_VOLUME); |
| goto error_out; |
| } |
| |
| |
| /* Set the default route before the PCM stream is opened */ |
| pthread_mutex_lock(&adev->lock); |
| set_route_by_array(adev->mixer, defaults, 1); |
| adev->mode = AUDIO_MODE_NORMAL; |
| adev->devices = AUDIO_DEVICE_OUT_DEFAULT | AUDIO_DEVICE_IN_DEFAULT; |
| |
| pthread_mutex_unlock(&adev->lock); |
| |
| *device = &adev->hw_device.common; |
| |
| return 0; |
| |
| error_out: |
| mixer_close(adev->mixer); |
| free(adev); |
| return -EINVAL; |
| } |
| |
| static struct hw_module_methods_t hal_module_methods = { |
| .open = adev_open, |
| }; |
| |
| struct audio_module HAL_MODULE_INFO_SYM = { |
| .common = { |
| .tag = HARDWARE_MODULE_TAG, |
| .version_major = 1, |
| .version_minor = 0, |
| .id = AUDIO_HARDWARE_MODULE_ID, |
| .name = "ARM VExpress audio HW HAL", |
| .author = "The Android Open Source Project", |
| .methods = &hal_module_methods, |
| }, |
| }; |