| /* |
| ** Copyright (c) 2019-2021, The Linux Foundation. All rights reserved. |
| ** |
| ** Redistribution and use in source and binary forms, with or without |
| ** modification, are permitted provided that the following conditions are |
| ** met: |
| ** * Redistributions of source code must retain the above copyright |
| ** notice, this list of conditions and the following disclaimer. |
| ** * Redistributions in binary form must reproduce the above |
| ** copyright notice, this list of conditions and the following |
| ** disclaimer in the documentation and/or other materials provided |
| ** with the distribution. |
| ** * Neither the name of The Linux Foundation nor the names of its |
| ** contributors may be used to endorse or promote products derived |
| ** from this software without specific prior written permission. |
| ** |
| ** THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| ** WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| ** MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| ** ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| ** BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| ** CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| ** SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| ** BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| ** WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| ** OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| ** IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| **/ |
| |
| #define LOG_TAG "AGM: device" |
| |
| #include <errno.h> |
| #include <pthread.h> |
| #include <sched.h> |
| #include <stdio.h> |
| #include <fcntl.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <unistd.h> |
| #include <limits.h> |
| #include <stdbool.h> |
| #include <agm/device.h> |
| #include <agm/metadata.h> |
| #include <agm/utils.h> |
| #ifdef DEVICE_USES_ALSALIB |
| #include <alsa/asoundlib.h> |
| #else |
| #include <tinyalsa/asoundlib.h> |
| #endif |
| |
| #define PCM_DEVICE_FILE "/proc/asound/pcm" |
| #define MAX_RETRY 100 /*Device will try these many times before return an error*/ |
| #define RETRY_INTERVAL 1 /*Retry interval in seconds*/ |
| |
| #ifdef DYNAMIC_LOG_ENABLED |
| #include <log_xml_parser.h> |
| #define LOG_MASK AGM_MOD_FILE_DEVICE |
| #include <log_utils.h> |
| #endif |
| |
| #define TRUE 1 |
| #define FALSE 0 |
| |
| #define DEVICE_ENABLE 1 |
| #define DEVICE_DISABLE 0 |
| |
| /* Global list to store supported devices */ |
| static struct listnode device_list; |
| static struct listnode device_group_data_list; |
| static uint32_t num_audio_intfs; |
| static uint32_t num_group_devices; |
| |
| #ifdef DEVICE_USES_ALSALIB |
| static snd_ctl_t *mixer; |
| #else |
| static struct mixer *mixer = NULL; |
| #endif |
| |
| #define SYSFS_FD_PATH "/sys/kernel/aud_dev/state" |
| static int sysfs_fd = -1; |
| |
| #define MAX_BUF_SIZE 2048 |
| /** |
| * The maximum period bytes for dummy dai is 8192 bytes. |
| * Hard coding of period size to 960 frames was leading |
| * to bigger period bytes for multi channels. |
| * So, now based on frame size, Period size is being calculated. |
| * 1 frame = bytes_per_sample * channels |
| * period size = 8192/(bytes_per_sample * channels) |
| */ |
| #define MAX_PERIOD_BUFFER 8192 |
| #define DEFAULT_PERIOD_COUNT 2 |
| |
| #define MAX_USR_INPUT 9 |
| |
| int get_pcm_bits_per_sample(enum agm_media_format fmt_id) |
| { |
| int bits_per_sample = 16; |
| |
| switch(fmt_id) { |
| case AGM_FORMAT_PCM_S8: /**< 8-bit signed */ |
| bits_per_sample = 8; |
| break; |
| case AGM_FORMAT_PCM_S24_LE: /**< 24-bits in 4-bytes, 8_24 form*/ |
| bits_per_sample = 32; |
| break; |
| case AGM_FORMAT_PCM_S24_3LE: /**< 24-bits in 3-bytes */ |
| bits_per_sample = 24; |
| break; |
| case AGM_FORMAT_PCM_S32_LE: /**< 32-bit signed */ |
| bits_per_sample = 32; |
| break; |
| case AGM_FORMAT_PCM_S16_LE: /**< 16-bit signed */ |
| default: |
| bits_per_sample = 16; |
| break; |
| } |
| return bits_per_sample; |
| } |
| |
| static void update_sysfs_fd (int8_t pcm_id, int8_t state) |
| { |
| char buf[MAX_USR_INPUT]={0}; |
| snprintf(buf, MAX_USR_INPUT,"%d %d", pcm_id, state); |
| if (sysfs_fd >= 0) |
| write(sysfs_fd, buf, MAX_USR_INPUT); |
| else { |
| /*AGM service and sysfs file creation are async events. |
| *Also when the syfs node is first created the default |
| *user attribute for the sysfs file is root. |
| *To change the same we need to execute a command from |
| *init scripts, which again are async and there is no |
| *deterministic way of scheduling this command only after |
| *the sysfs node is created. And all this should happen before |
| *we try to open the file from agm context, otherwise the open |
| *call would fail with permission denied error. |
| *Hence we try to open the file first time when we access it instead |
| *of doing it from agm_init. |
| *This gives the system enough time for the file attributes to |
| *be changed. |
| */ |
| sysfs_fd = open(SYSFS_FD_PATH, O_WRONLY); |
| if (sysfs_fd >= 0) { |
| write(sysfs_fd, buf, MAX_USR_INPUT); |
| } else { |
| AGM_LOGE("invalid file handle\n"); |
| } |
| } |
| } |
| |
| int device_get_snd_card_id() |
| { |
| struct device_obj *dev_obj = node_to_item(list_head(&device_list), |
| struct device_obj, list_node); |
| |
| if (dev_obj == NULL) { |
| AGM_LOGE("%s: Invalid device object\n", __func__); |
| return -EINVAL; |
| } |
| return dev_obj->card_id; |
| } |
| |
| static struct device_obj *device_get_pcm_obj(struct device_obj *dev_obj) |
| { |
| if (dev_obj->parent_dev) |
| return dev_obj->parent_dev; |
| else |
| return dev_obj; |
| } |
| |
| #ifdef DEVICE_USES_ALSALIB |
| snd_pcm_format_t agm_to_alsa_format(enum agm_media_format format) |
| { |
| switch (format) { |
| case AGM_FORMAT_PCM_S32_LE: |
| return SND_PCM_FORMAT_S32_LE; |
| case AGM_FORMAT_PCM_S8: |
| return SND_PCM_FORMAT_S8; |
| case AGM_FORMAT_PCM_S24_3LE: |
| return SND_PCM_FORMAT_S24_3LE; |
| case AGM_FORMAT_PCM_S24_LE: |
| return SND_PCM_FORMAT_S24_LE; |
| default: |
| case AGM_FORMAT_PCM_S16_LE: |
| return SND_PCM_FORMAT_S16_LE; |
| }; |
| } |
| |
| int device_open(struct device_obj *dev_obj) |
| { |
| int ret = 0; |
| snd_pcm_t *pcm; |
| char pcm_name[80]; |
| snd_pcm_stream_t stream; |
| snd_pcm_hw_params_t *hwparams; |
| snd_pcm_format_t format; |
| snd_pcm_uframes_t period_size; |
| unsigned int rate, channels, period_count; |
| struct device_group_data *grp_data = NULL; |
| struct agm_media_config *media_config = NULL; |
| struct device_obj *obj = NULL; |
| |
| if (dev_obj == NULL) { |
| AGM_LOGE("%s: Invalid device object\n", __func__); |
| return -EINVAL; |
| } |
| |
| obj = device_get_pcm_obj(dev_obj); |
| |
| snprintf(pcm_name, sizeof(pcm_name), "hw:%u,%u", obj->card_id, obj->pcm_id); |
| |
| stream = (obj->hw_ep_info.dir == AUDIO_OUTPUT) ? |
| SND_PCM_STREAM_PLAYBACK : SND_PCM_STREAM_CAPTURE; |
| |
| pthread_mutex_lock(&obj->lock); |
| |
| if (obj->group_data) |
| grp_data = obj->group_data; |
| |
| if (obj->refcnt.open) { |
| AGM_LOGE("%s: PCM device %u already opened\n", |
| __func__, obj->pcm_id); |
| obj->refcnt.open++; |
| if (grp_data) |
| grp_data->refcnt.open++; |
| goto done; |
| } |
| |
| if (grp_data && !grp_data->has_multiple_dai_link) |
| media_config = &grp_data->media_config.config; |
| else |
| media_config = &dev_obj->media_config; |
| |
| channels = media_config->channels; |
| rate = media_config->rate; |
| format = agm_to_alsa_format(media_config->format); |
| period_size = (MAX_PERIOD_BUFFER)/(channels * |
| (get_pcm_bits_per_sample(media_config->format)/8)); |
| period_count = DEFAULT_PERIOD_COUNT; |
| |
| ret = snd_pcm_open(&pcm, pcm_name, stream, 0); |
| if (ret < 0) { |
| AGM_LOGE("%s: Unable to open PCM device %s", __func__, pcm_name); |
| goto done; |
| } |
| |
| snd_pcm_hw_params_alloca(&hwparams); |
| |
| ret = snd_pcm_hw_params_any(pcm, hwparams); |
| if (ret < 0) { |
| AGM_LOGE("Default config not available for %s, exiting", pcm_name); |
| goto done; |
| } |
| snd_pcm_hw_params_set_access(pcm, hwparams, SND_PCM_ACCESS_RW_INTERLEAVED); |
| snd_pcm_hw_params_set_format(pcm, hwparams, format); |
| snd_pcm_hw_params_set_channels(pcm, hwparams, channels); |
| snd_pcm_hw_params_set_rate(pcm, hwparams, rate, 0); |
| snd_pcm_hw_params_set_period_size(pcm, hwparams, period_size, 0); |
| snd_pcm_hw_params_set_periods(pcm, hwparams, period_count, 0); |
| |
| ret = snd_pcm_hw_params(pcm, hwparams); |
| if (ret < 0) { |
| AGM_LOGE("%s unable to set hw params for %s, rate[%u], ch[%u], fmt[%u]", |
| __func__, pcm_name, rate, channels, format); |
| goto done; |
| } |
| |
| update_sysfs_fd(obj->pcm_id, DEVICE_ENABLE); |
| obj->pcm = pcm; |
| obj->state = DEV_OPENED; |
| obj->refcnt.open++; |
| if (grp_data) |
| grp_data->refcnt.open++; |
| done: |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| #else |
| enum pcm_format agm_to_pcm_format(enum agm_media_format format) |
| { |
| switch (format) { |
| case AGM_FORMAT_PCM_S32_LE: |
| return PCM_FORMAT_S32_LE; |
| case AGM_FORMAT_PCM_S8: |
| return PCM_FORMAT_S8; |
| case AGM_FORMAT_PCM_S24_3LE: |
| return PCM_FORMAT_S24_3LE; |
| case AGM_FORMAT_PCM_S24_LE: |
| return PCM_FORMAT_S24_LE; |
| default: |
| case AGM_FORMAT_PCM_S16_LE: |
| return PCM_FORMAT_S16_LE; |
| }; |
| } |
| |
| int device_open(struct device_obj *dev_obj) |
| { |
| int ret = 0; |
| struct pcm *pcm = NULL; |
| struct pcm_config config; |
| uint32_t pcm_flags; |
| struct device_group_data *grp_data = NULL; |
| struct agm_media_config *media_config = NULL; |
| struct device_obj *obj = NULL; |
| |
| if (dev_obj == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return -EINVAL; |
| } |
| |
| obj = device_get_pcm_obj(dev_obj); |
| pthread_mutex_lock(&obj->lock); |
| |
| if (obj->group_data) |
| grp_data = obj->group_data; |
| |
| if (obj->refcnt.open) { |
| AGM_LOGI("PCM device %u already opened\n", |
| obj->pcm_id); |
| obj->refcnt.open++; |
| if (grp_data) |
| grp_data->refcnt.open++; |
| goto done; |
| } |
| |
| memset(&config, 0, sizeof(struct pcm_config)); |
| if (grp_data && !grp_data->has_multiple_dai_link) |
| media_config = &grp_data->media_config.config; |
| else |
| media_config = &dev_obj->media_config; |
| |
| config.channels = media_config->channels; |
| config.rate = media_config->rate; |
| config.format = agm_to_pcm_format(media_config->format); |
| config.period_size = (MAX_PERIOD_BUFFER)/(config.channels * |
| (get_pcm_bits_per_sample(media_config->format)/8)); |
| |
| config.period_count = DEFAULT_PERIOD_COUNT; |
| config.start_threshold = config.period_size / 4; |
| config.stop_threshold = INT_MAX; |
| |
| pcm_flags = (obj->hw_ep_info.dir == AUDIO_OUTPUT) ? PCM_OUT : PCM_IN; |
| pcm = pcm_open(obj->card_id, obj->pcm_id, pcm_flags, |
| &config); |
| if (!pcm || !pcm_is_ready(pcm)) { |
| AGM_LOGE("Unable to open PCM device %u (%s) rate %u ch %d fmt %u", |
| obj->pcm_id, pcm_get_error(pcm), config.rate, |
| config.channels, config.format); |
| AGM_LOGE("Period Size %d \n", config.period_size); |
| ret = -EIO; |
| goto done; |
| } |
| update_sysfs_fd(obj->pcm_id, DEVICE_ENABLE); |
| obj->pcm = pcm; |
| obj->state = DEV_OPENED; |
| obj->refcnt.open++; |
| if (grp_data) |
| grp_data->refcnt.open++; |
| done: |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| #endif |
| |
| int device_prepare(struct device_obj *dev_obj) |
| { |
| int ret = 0; |
| struct device_group_data *grp_data = NULL; |
| struct device_obj *obj = NULL; |
| |
| if (dev_obj == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return -EINVAL; |
| } |
| |
| obj = device_get_pcm_obj(dev_obj); |
| |
| pthread_mutex_lock(&obj->lock); |
| |
| if (obj->group_data) |
| grp_data = obj->group_data; |
| |
| if (obj->refcnt.prepare) { |
| AGM_LOGD("PCM device %u already in prepare state\n", |
| obj->pcm_id); |
| obj->refcnt.prepare++; |
| if (grp_data) |
| grp_data->refcnt.prepare++; |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| #ifdef DEVICE_USES_ALSALIB |
| ret = snd_pcm_prepare(obj->pcm); |
| #else |
| ret = pcm_prepare(obj->pcm); |
| #endif |
| if (ret) { |
| AGM_LOGE("PCM device %u prepare failed, ret = %d\n", |
| obj->pcm_id, ret); |
| goto done; |
| } |
| |
| obj->state = DEV_PREPARED; |
| obj->refcnt.prepare++; |
| |
| done: |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| |
| int device_start(struct device_obj *dev_obj) |
| { |
| int ret = 0; |
| struct device_group_data *grp_data = NULL; |
| struct device_obj *obj = NULL; |
| |
| if (dev_obj == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return -EINVAL; |
| } |
| |
| obj = device_get_pcm_obj(dev_obj); |
| |
| pthread_mutex_lock(&obj->lock); |
| if (obj->state < DEV_PREPARED) { |
| AGM_LOGE("PCM device %u not yet prepared, exiting\n", |
| obj->pcm_id); |
| ret = -1; |
| goto done; |
| } |
| |
| if (obj->group_data) |
| grp_data = obj->group_data; |
| |
| if (obj->refcnt.start) { |
| AGM_LOGI("PCM device %u already in start state\n", |
| obj->pcm_id); |
| obj->refcnt.start++; |
| if (grp_data) |
| grp_data->refcnt.start++; |
| goto done; |
| } |
| |
| obj->state = DEV_STARTED; |
| obj->refcnt.start++; |
| if (grp_data) |
| grp_data->refcnt.start++; |
| |
| done: |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| |
| int device_stop(struct device_obj *dev_obj) |
| { |
| int ret = 0; |
| struct device_group_data *grp_data = NULL; |
| struct device_obj *obj = NULL; |
| |
| if(dev_obj == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return -EINVAL; |
| } |
| |
| obj = device_get_pcm_obj(dev_obj); |
| |
| pthread_mutex_lock(&obj->lock); |
| if (!obj->refcnt.start) { |
| AGM_LOGE("PCM device %u already stopped\n", |
| obj->pcm_id); |
| goto done; |
| } |
| |
| if (obj->group_data) { |
| grp_data = obj->group_data; |
| grp_data->refcnt.start--; |
| } |
| |
| obj->refcnt.start--; |
| if (obj->refcnt.start == 0) { |
| #ifdef DEVICE_USES_ALSALIB |
| ret = snd_pcm_drop(obj->pcm); |
| #else |
| ret = pcm_stop(obj->pcm); |
| #endif |
| if (ret) { |
| AGM_LOGE("PCM device %u stop failed, ret = %d\n", |
| obj->pcm_id, ret); |
| } |
| obj->state = DEV_STOPPED; |
| } |
| |
| done: |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| |
| int device_close(struct device_obj *dev_obj) |
| { |
| int ret = 0; |
| struct device_group_data *grp_data = NULL; |
| struct device_obj *obj = NULL; |
| |
| if (dev_obj == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return -EINVAL; |
| } |
| |
| obj = device_get_pcm_obj(dev_obj); |
| |
| pthread_mutex_lock(&obj->lock); |
| if (!obj->refcnt.open) { |
| AGM_LOGE("PCM device %u already closed\n", |
| obj->pcm_id); |
| goto done; |
| } |
| |
| if (obj->group_data) { |
| grp_data = obj->group_data; |
| if (--grp_data->refcnt.open == 0) { |
| grp_data->refcnt.prepare = 0; |
| grp_data->refcnt.start = 0; |
| } |
| } |
| |
| if (--obj->refcnt.open == 0) { |
| update_sysfs_fd(obj->pcm_id, DEVICE_DISABLE); |
| #ifdef DEVICE_USES_ALSALIB |
| ret = snd_pcm_close(obj->pcm); |
| #else |
| ret = pcm_close(obj->pcm); |
| #endif |
| if (ret) { |
| AGM_LOGE("PCM device %u close failed, ret = %d\n", |
| obj->pcm_id, ret); |
| } |
| obj->state = DEV_CLOSED; |
| obj->refcnt.prepare = 0; |
| obj->refcnt.start = 0; |
| } |
| |
| done: |
| pthread_mutex_unlock(&obj->lock); |
| return ret; |
| } |
| |
| enum device_state device_current_state(struct device_obj *dev_obj) |
| { |
| return dev_obj->state; |
| } |
| |
| int device_get_aif_info_list(struct aif_info *aif_list, size_t *audio_intfs) |
| { |
| struct device_obj *dev_obj; |
| uint32_t copied = 0; |
| uint32_t requested = *audio_intfs; |
| struct listnode *dev_node, *temp; |
| |
| if (*audio_intfs == 0){ |
| *audio_intfs = num_audio_intfs; |
| } else { |
| list_for_each_safe(dev_node, temp, &device_list) { |
| dev_obj = node_to_item(dev_node, struct device_obj, list_node); |
| strlcpy(aif_list[copied].aif_name, dev_obj->name, |
| AIF_NAME_MAX_LEN); |
| aif_list[copied].dir = dev_obj->hw_ep_info.dir; |
| copied++; |
| if (copied == requested) |
| break; |
| } |
| *audio_intfs = copied; |
| } |
| return 0; |
| } |
| |
| int device_get_group_list(struct aif_info *aif_list, size_t *num_groups) |
| { |
| struct device_group_data *grp_data; |
| uint32_t copied = 0; |
| uint32_t requested = *num_groups; |
| struct listnode *grp_node, *temp; |
| |
| if (*num_groups == 0){ |
| *num_groups = num_group_devices; |
| } else { |
| list_for_each_safe(grp_node, temp, &device_group_data_list) { |
| grp_data = node_to_item(grp_node, struct device_group_data, list_node); |
| strlcpy(aif_list[copied].aif_name, grp_data->name, |
| AIF_NAME_MAX_LEN); |
| copied++; |
| if (copied == requested) |
| break; |
| } |
| *num_groups = copied; |
| } |
| return 0; |
| } |
| |
| int device_get_obj(uint32_t device_idx, struct device_obj **dev_obj) |
| { |
| int i = 0; |
| struct listnode *dev_node, *temp; |
| struct device_obj *obj; |
| |
| if (device_idx > num_audio_intfs) { |
| AGM_LOGE("Invalid device_id %u, max_supported device id: %d\n", |
| device_idx, num_audio_intfs); |
| return -EINVAL; |
| } |
| |
| list_for_each_safe(dev_node, temp, &device_list) { |
| if (i++ == device_idx) { |
| obj = node_to_item(dev_node, struct device_obj, list_node); |
| *dev_obj = obj; |
| return 0; |
| } |
| } |
| return -EINVAL; |
| } |
| |
| int device_get_group_data(uint32_t group_id , struct device_group_data **grp_data) |
| { |
| int i = 0; |
| struct listnode *group_node, *temp; |
| struct device_group_data *data; |
| |
| if (group_id >= num_group_devices) { |
| AGM_LOGE("Invalid group_id %u, max_supported device id: %d\n", |
| group_id, num_group_devices); |
| return -EINVAL; |
| } |
| |
| list_for_each_safe(group_node, temp, &device_group_data_list) { |
| if (i++ == group_id) { |
| data = node_to_item(group_node, struct device_group_data, list_node); |
| *grp_data = data; |
| return 0; |
| } |
| } |
| return -EINVAL; |
| } |
| |
| int device_set_media_config(struct device_obj *dev_obj, |
| struct agm_media_config *device_media_config) |
| { |
| if (dev_obj == NULL || device_media_config == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return -EINVAL; |
| } |
| |
| pthread_mutex_lock(&dev_obj->lock); |
| dev_obj->media_config.channels = device_media_config->channels; |
| dev_obj->media_config.rate = device_media_config->rate; |
| dev_obj->media_config.format = device_media_config->format; |
| dev_obj->media_config.data_format = device_media_config->data_format; |
| pthread_mutex_unlock(&dev_obj->lock); |
| |
| return 0; |
| } |
| |
| int device_group_set_media_config(struct device_group_data *grp_data, |
| struct agm_group_media_config *media_config) |
| { |
| if (grp_data == NULL || media_config == NULL) { |
| AGM_LOGE("Invalid input\n"); |
| return -EINVAL; |
| } |
| memcpy(&grp_data->media_config, media_config, sizeof(*media_config)); |
| |
| return 0; |
| } |
| |
| int device_set_metadata(struct device_obj *dev_obj, uint32_t size, |
| uint8_t *metadata) |
| { |
| int ret = 0; |
| |
| pthread_mutex_lock(&dev_obj->lock); |
| metadata_free(&dev_obj->metadata); |
| ret = metadata_copy(&(dev_obj->metadata), size, metadata); |
| pthread_mutex_unlock(&dev_obj->lock); |
| |
| return ret; |
| } |
| |
| int device_set_params(struct device_obj *dev_obj, |
| void *payload, size_t size) |
| { |
| int ret = 0; |
| |
| pthread_mutex_lock(&dev_obj->lock); |
| |
| if (dev_obj->params) { |
| free(dev_obj->params); |
| dev_obj->params = NULL; |
| dev_obj->params_size = 0; |
| } |
| |
| dev_obj->params = calloc(1, size); |
| if (!dev_obj->params) { |
| AGM_LOGE("No memory for dev params on dev_id:%d\n", |
| dev_obj->pcm_id); |
| ret = -EINVAL; |
| goto done; |
| } |
| |
| memcpy(dev_obj->params, payload, size); |
| dev_obj->params_size = size; |
| |
| done: |
| pthread_mutex_unlock(&dev_obj->lock); |
| return ret; |
| } |
| |
| #ifdef DEVICE_USES_ALSALIB |
| int device_get_channel_map(struct device_obj *dev_obj, uint32_t **chmap) |
| { |
| snd_ctl_elem_id_t *id; |
| snd_ctl_elem_info_t *info; |
| snd_ctl_elem_value_t *control; |
| char *mixer_str = NULL; |
| int i, ctl_len = 0, ret = 0, card_id; |
| uint8_t *payload = NULL; |
| char card[16]; |
| char *dev_name = NULL; |
| |
| if (mixer == NULL) { |
| card_id = device_get_snd_card_id(); |
| if (card_id < 0) { |
| AGM_LOGE("%s: failed to get card_id", __func__); |
| return -EINVAL; |
| } |
| |
| snprintf(card, 16, "hw:%u", card_id); |
| if ((ret = snd_ctl_open(&mixer, card, 0)) < 0) { |
| AGM_LOGE("Control device %s open error: %s", card, snd_strerror(ret)); |
| return ret; |
| } |
| |
| } |
| |
| if (dev_obj->parent_dev) |
| dev_name = dev_obj->parent_dev->name; |
| else |
| dev_name = dev_obj->name; |
| |
| ctl_len = strlen(dev_name) + 1 + strlen("Channel Map") + 1; |
| mixer_str = calloc(1, ctl_len); |
| if (!mixer_str) { |
| AGM_LOGE("%s: Failed to allocate memory for mixer_str", __func__); |
| return -ENOMEM; |
| } |
| |
| payload = calloc(16, sizeof(uint32_t)); |
| if (!payload) { |
| AGM_LOGE("%s: Failed to allocate memory for payload", __func__); |
| ret = -ENOMEM; |
| goto done; |
| } |
| |
| snprintf(mixer_str, ctl_len, "%s %s", dev_name, "Channel Map"); |
| |
| snd_ctl_elem_id_alloca(&id); |
| snd_ctl_elem_info_alloca(&info); |
| snd_ctl_elem_value_alloca(&control); |
| |
| snd_ctl_elem_id_set_interface(id, SND_CTL_ELEM_IFACE_MIXER); |
| snd_ctl_elem_id_set_name(id, (const char *)mixer_str); |
| |
| snd_ctl_elem_info_set_id(info, id); |
| ret = snd_ctl_elem_info(mixer, info); |
| if (ret < 0) { |
| AGM_LOGE("Cannot get element info for %s\n", mixer_str); |
| goto done; |
| } |
| snd_ctl_elem_info_get_id(info, id); |
| |
| snd_ctl_elem_value_set_id(control, id); |
| ret = snd_ctl_elem_read(mixer, control); |
| if (ret < 0) { |
| AGM_LOGE("Failed to mixer_ctl_get_array\n"); |
| goto err_get_ctl; |
| } |
| |
| for (i = 0; i < 16 * sizeof(uint32_t); i++) |
| payload[i] = snd_ctl_elem_value_get_byte(control, i); |
| |
| *chmap = payload; |
| goto done; |
| |
| err_get_ctl: |
| done: |
| free(mixer_str); |
| return ret; |
| } |
| #else |
| int device_get_channel_map(struct device_obj *dev_obj, uint32_t **chmap) |
| { |
| struct mixer_ctl *ctl = NULL; |
| char *mixer_str = NULL; |
| int ctl_len = 0, ret = 0, card_id; |
| void *payload = NULL; |
| char *dev_name = NULL; |
| |
| if (mixer == NULL) { |
| card_id = device_get_snd_card_id(); |
| if (card_id < 0) { |
| AGM_LOGE("failed to get card_id"); |
| return -EINVAL; |
| } |
| |
| mixer = mixer_open(card_id); |
| if (!mixer) { |
| AGM_LOGE("failed to get mixer handle"); |
| return -EINVAL; |
| } |
| } |
| |
| if (dev_obj->parent_dev) |
| dev_name = dev_obj->parent_dev->name; |
| else |
| dev_name = dev_obj->name; |
| |
| ctl_len = strlen(dev_name) + 1 + strlen("Channel Map") + 1; |
| mixer_str = calloc(1, ctl_len); |
| if (!mixer_str) { |
| AGM_LOGE("Failed to allocate memory for mixer_str"); |
| return -ENOMEM; |
| } |
| |
| payload = calloc(16, sizeof(uint32_t)); |
| if (!payload) { |
| AGM_LOGE("Failed to allocate memory for payload"); |
| ret = -ENOMEM; |
| goto done; |
| } |
| |
| snprintf(mixer_str, ctl_len, "%s %s", dev_name, "Channel Map"); |
| |
| ctl = mixer_get_ctl_by_name(mixer, mixer_str); |
| if (!ctl) { |
| AGM_LOGE("Invalid mixer control: %s\n", mixer_str); |
| ret = -ENOENT; |
| goto err_get_ctl; |
| } |
| |
| ret = mixer_ctl_get_array(ctl, payload, 16 * sizeof(uint32_t)); |
| if (ret < 0) { |
| AGM_LOGE("Failed to mixer_ctl_get_array\n"); |
| goto err_get_ctl; |
| } |
| *chmap = payload; |
| goto done; |
| |
| err_get_ctl: |
| free(payload); |
| done: |
| free(mixer_str); |
| return ret; |
| } |
| #endif |
| |
| int device_get_start_refcnt(struct device_obj *dev_obj) |
| { |
| if (dev_obj == NULL) { |
| AGM_LOGE("Invalid device object\n"); |
| return 0; |
| } |
| |
| if (dev_obj->group_data) |
| return dev_obj->group_data->refcnt.start; |
| else |
| return dev_obj->refcnt.start; |
| |
| } |
| |
| static struct device_group_data* device_get_group_data_by_name(char *dev_name) |
| { |
| struct device_group_data *grp_data = NULL; |
| char group_name[MAX_DEV_NAME_LEN]; |
| char *ptr = NULL; |
| int pos = 0; |
| struct listnode *grp_node, *temp; |
| |
| memset(group_name, 0, MAX_DEV_NAME_LEN); |
| |
| ptr = strstr(dev_name, "-VIRT"); |
| pos = ptr - dev_name + 1; |
| strlcpy(group_name, dev_name, pos); |
| |
| list_for_each_safe(grp_node, temp, &device_group_data_list) { |
| grp_data = node_to_item(grp_node, struct device_group_data, list_node); |
| if (!strncmp(group_name, grp_data->name, MAX_DEV_NAME_LEN)) { |
| grp_data->has_multiple_dai_link = true; |
| goto done; |
| } |
| } |
| |
| grp_data = calloc(1, sizeof(struct device_group_data)); |
| if (grp_data == NULL) { |
| AGM_LOGE("memory allocation for group_data failed\n"); |
| return NULL; |
| } |
| |
| strlcpy(grp_data->name, group_name, pos); |
| list_add_tail(&device_group_data_list, &grp_data->list_node); |
| num_group_devices++; |
| |
| done: |
| return grp_data; |
| } |
| |
| int parse_snd_card() |
| { |
| char buffer[MAX_BUF_SIZE]; |
| unsigned int count = 0, i = 0; |
| FILE *fp; |
| int ret = 0; |
| struct listnode *dev_node, *temp; |
| struct device_obj *dev_obj = NULL; |
| |
| fp = fopen(PCM_DEVICE_FILE, "r"); |
| if (!fp) { |
| AGM_LOGE("ERROR. %s file open failed\n", |
| PCM_DEVICE_FILE); |
| return -ENODEV; |
| } |
| |
| list_init(&device_list); |
| list_init(&device_group_data_list); |
| num_group_devices = 0; |
| while (fgets(buffer, MAX_BUF_SIZE - 1, fp) != NULL) |
| { |
| dev_obj = calloc(1, sizeof(struct device_obj)); |
| |
| if (!dev_obj) { |
| AGM_LOGE("failed to allocate device_obj mem\n"); |
| ret = -ENOMEM; |
| goto free_device; |
| } |
| |
| AGM_LOGV("buffer: %s\n", buffer); |
| /* For Non-DPCM Dai-links, it is in the format of: |
| * <card_num>-<pcm_device_id>: <pcm->idname> : <pcm->name> : |
| <playback/capture> 1 |
| * Here, pcm->idname is in the form of "<dai_link->stream_name> |
| <codec_name>-<num_codecs>" |
| */ |
| sscanf(buffer, "%02u-%02u: %80s", &dev_obj->card_id, |
| &dev_obj->pcm_id, dev_obj->name); |
| AGM_LOGD("%d:%d:%s\n", dev_obj->card_id, dev_obj->pcm_id, dev_obj->name); |
| |
| /* populate the hw_ep_info for all the available pcm-id's*/ |
| ret = populate_device_hw_ep_info(dev_obj); |
| if (ret) { |
| AGM_LOGE("hw_ep_info parsing failed %s\n", |
| dev_obj->name); |
| free(dev_obj); |
| ret = 0; |
| continue; |
| } |
| |
| pthread_mutex_init(&dev_obj->lock, (const pthread_mutexattr_t *) NULL); |
| list_add_tail(&device_list, &dev_obj->list_node); |
| count++; |
| if (dev_obj->num_virtual_child) { |
| dev_obj->group_data = device_get_group_data_by_name(dev_obj->name); |
| |
| /* Enumerate virtual backends */ |
| for (int i = 0; i < dev_obj->num_virtual_child; i++) { |
| struct device_obj *child_dev_obj = populate_virtual_device_hw_ep_info(dev_obj, i); |
| if (child_dev_obj) { |
| list_add_tail(&device_list, &child_dev_obj->list_node); |
| count++; |
| } |
| child_dev_obj = NULL; |
| } |
| } |
| |
| dev_obj = NULL; |
| } |
| /* |
| * count 0 indicates that expected sound card was not registered |
| * inform the upper layers to try again after sometime. |
| */ |
| if (count == 0) { |
| ret = -EAGAIN; |
| goto free_device; |
| } |
| |
| num_audio_intfs = count; |
| goto close_file; |
| |
| free_device: |
| list_for_each_safe(dev_node, temp, &device_list) { |
| dev_obj = node_to_item(dev_node, struct device_obj, list_node); |
| list_remove(dev_node); |
| free(dev_obj); |
| dev_obj = NULL; |
| } |
| |
| list_remove(&device_group_data_list); |
| list_remove(&device_list); |
| close_file: |
| fclose(fp); |
| return ret; |
| } |
| |
| int device_init() |
| { |
| int ret = 0; |
| uint32_t retries = MAX_RETRY; |
| |
| do { |
| ret = parse_snd_card(); |
| if (ret == -EAGAIN) { |
| AGM_LOGE("no valid snd device found retry %d times\n", retries); |
| retries--; |
| sleep(RETRY_INTERVAL); |
| } else |
| break; |
| } while ( retries > 0); |
| |
| return ret; |
| } |
| |
| void device_deinit() |
| { |
| unsigned int list_count = 0; |
| struct device_obj *dev_obj = NULL; |
| struct device_group_data *grp_data = NULL; |
| struct listnode *dev_node, *grp_node, *temp; |
| |
| AGM_LOGE("device deinit called\n"); |
| list_for_each_safe(dev_node, temp, &device_list) { |
| dev_obj = node_to_item(dev_node, struct device_obj, list_node); |
| list_remove(dev_node); |
| |
| metadata_free(&dev_obj->metadata); |
| |
| if (dev_obj->params) |
| free(dev_obj->params); |
| |
| free(dev_obj); |
| dev_obj = NULL; |
| } |
| |
| list_for_each_safe(grp_node, temp, &device_group_data_list) { |
| grp_data = node_to_item(grp_node, struct device_group_data, list_node); |
| list_remove(grp_node); |
| free(grp_data); |
| grp_data = NULL; |
| } |
| |
| list_remove(&device_group_data_list); |
| list_remove(&device_list); |
| if (sysfs_fd >= 0) |
| close(sysfs_fd); |
| sysfs_fd = -1; |
| |
| #ifdef DEVICE_USES_ALSALIB |
| if (mixer) |
| snd_ctl_close(mixer); |
| #else |
| if (mixer) |
| mixer_close(mixer); |
| #endif |
| } |