| /* Copyright (c) 2015, 2017, 2019 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 "audio_pp_asphere" |
| /*#define LOG_NDEBUG 0*/ |
| |
| #include <errno.h> |
| #include <fcntl.h> |
| #include <stdlib.h> |
| #include <unistd.h> |
| #include <stdbool.h> |
| #include <sys/stat.h> |
| #include <log/log.h> |
| #include <cutils/list.h> |
| #include <cutils/str_parms.h> |
| #include <cutils/properties.h> |
| #include <hardware/audio_effect.h> |
| #include <pthread.h> |
| #include "bundle.h" |
| #include "equalizer.h" |
| #include "bass_boost.h" |
| #include "virtualizer.h" |
| #include "reverb.h" |
| #include "asphere.h" |
| |
| #define ASPHERE_MIXER_NAME "MSM ASphere Set Param" |
| |
| #define AUDIO_PARAMETER_KEY_ASPHERE_STATUS "asphere_status" |
| #define AUDIO_PARAMETER_KEY_ASPHERE_ENABLE "asphere_enable" |
| #define AUDIO_PARAMETER_KEY_ASPHERE_STRENGTH "asphere_strength" |
| |
| #define AUDIO_ASPHERE_EVENT_NODE "/data/misc/audio_pp/event_node" |
| |
| enum { |
| ASPHERE_ACTIVE = 0, |
| ASPHERE_SUSPENDED, |
| ASPHERE_ERROR |
| }; |
| |
| #ifdef AUDIO_FEATURE_ENABLED_GCOV |
| extern void __gcov_flush(); |
| static void enable_gcov() |
| { |
| __gcov_flush(); |
| } |
| #else |
| static void enable_gcov() |
| { |
| } |
| #endif |
| |
| struct asphere_module { |
| bool enabled; |
| int status; |
| int strength; |
| pthread_mutex_t lock; |
| int init_status; |
| }; |
| |
| static struct asphere_module asphere; |
| pthread_once_t asphere_once = PTHREAD_ONCE_INIT; |
| |
| static int asphere_create_app_notification_node(void) |
| { |
| int fd; |
| if ((fd = open(AUDIO_ASPHERE_EVENT_NODE, O_CREAT|O_TRUNC|O_WRONLY, |
| S_IRUSR|S_IWUSR|S_IRGRP|S_IROTH)) < 0) { |
| ALOGE("creating notification node failed %d", errno); |
| return -EINVAL; |
| } |
| chmod(AUDIO_ASPHERE_EVENT_NODE, S_IRWXU|S_IRGRP|S_IXGRP|S_IROTH); |
| close(fd); |
| ALOGD("%s: successfully created notification node %s", |
| __func__, AUDIO_ASPHERE_EVENT_NODE); |
| return 0; |
| } |
| |
| static int asphere_notify_app(void) |
| { |
| int fd; |
| if ((fd = open(AUDIO_ASPHERE_EVENT_NODE, O_TRUNC|O_WRONLY)) < 0) { |
| ALOGE("opening notification node failed %d", errno); |
| return -EINVAL; |
| } |
| close(fd); |
| ALOGD("%s: successfully opened notification node", __func__); |
| return 0; |
| } |
| |
| static int asphere_get_values_from_mixer(void) |
| { |
| int ret = 0; |
| long val[2] = {-1, -1}; |
| struct mixer_ctl *ctl = NULL; |
| struct mixer *mixer = mixer_open(MIXER_CARD); |
| if (mixer) |
| ctl = mixer_get_ctl_by_name(mixer, ASPHERE_MIXER_NAME); |
| if (!ctl) { |
| ALOGE("%s: could not get ctl for mixer cmd - %s", |
| __func__, ASPHERE_MIXER_NAME); |
| return -EINVAL; |
| } |
| ret = mixer_ctl_get_array(ctl, val, sizeof(val)/sizeof(val[0])); |
| if (!ret) { |
| asphere.enabled = (val[0] == 0) ? false : true; |
| asphere.strength = val[1]; |
| } |
| ALOGD("%s: returned %d, enabled:%ld, strength:%ld", |
| __func__, ret, val[0], val[1]); |
| |
| return ret; |
| } |
| |
| static int asphere_set_values_to_mixer(void) |
| { |
| int ret = 0; |
| long val[2] = {-1, -1}; |
| struct mixer_ctl *ctl = NULL; |
| struct mixer *mixer = mixer_open(MIXER_CARD); |
| if (mixer) |
| ctl = mixer_get_ctl_by_name(mixer, ASPHERE_MIXER_NAME); |
| if (!ctl) { |
| ALOGE("%s: could not get ctl for mixer cmd - %s", |
| __func__, ASPHERE_MIXER_NAME); |
| return -EINVAL; |
| } |
| val[0] = ((asphere.status == ASPHERE_ACTIVE) && asphere.enabled) ? 1 : 0; |
| val[1] = asphere.strength; |
| |
| ret = mixer_ctl_set_array(ctl, val, sizeof(val)/sizeof(val[0])); |
| ALOGD("%s: returned %d, enabled:%ld, strength:%ld", |
| __func__, ret, val[0], val[1]); |
| |
| return ret; |
| } |
| |
| static void asphere_init_once() { |
| ALOGD("%s", __func__); |
| pthread_mutex_init(&asphere.lock, NULL); |
| |
| if (property_get_bool("vendor.audio.feature.audio_sphere.enable", false)) { |
| asphere.init_status = 1; |
| asphere_get_values_from_mixer(); |
| asphere_create_app_notification_node(); |
| return; |
| } else { |
| ALOGW("%s: asphere feature not enabled", __func__); |
| } |
| |
| asphere.init_status = 0; |
| } |
| |
| static int asphere_init() { |
| pthread_once(&asphere_once, asphere_init_once); |
| enable_gcov(); |
| return asphere.init_status; |
| } |
| |
| static bool asphere_parms_allowed(struct str_parms *parms) |
| { |
| if (str_parms_has_key(parms, AUDIO_PARAMETER_KEY_ASPHERE_ENABLE)) |
| return true; |
| if (str_parms_has_key(parms, AUDIO_PARAMETER_KEY_ASPHERE_STRENGTH)) |
| return true; |
| if (str_parms_has_key(parms, AUDIO_PARAMETER_KEY_ASPHERE_STATUS)) |
| return true; |
| |
| return false; |
| } |
| |
| void asphere_set_parameters(struct str_parms *parms) |
| { |
| int ret = 0; |
| bool enable = false; |
| int strength = -1; |
| char value[32] = {0}; |
| bool set_enable = false, set_strength = false; |
| |
| if (!asphere_parms_allowed(parms)) { |
| return; |
| } |
| |
| if (asphere_init() != 1) { |
| ALOGW("%s: init check failed!!!", __func__); |
| return; |
| } |
| |
| ret = str_parms_get_str(parms, AUDIO_PARAMETER_KEY_ASPHERE_ENABLE, |
| value, sizeof(value)); |
| if (ret > 0) { |
| enable = (atoi(value) == 1) ? true : false; |
| set_enable = true; |
| } |
| |
| ret = str_parms_get_str(parms, AUDIO_PARAMETER_KEY_ASPHERE_STRENGTH, |
| value, sizeof(value)); |
| if (ret > 0) { |
| strength = atoi(value); |
| if (strength >= 0 && strength <= 1000) |
| set_strength = true; |
| } |
| |
| if (set_enable || set_strength) { |
| pthread_mutex_lock(&asphere.lock); |
| asphere.enabled = set_enable ? enable : asphere.enabled; |
| asphere.strength = set_strength ? strength : asphere.strength; |
| ret = asphere_set_values_to_mixer(); |
| pthread_mutex_unlock(&asphere.lock); |
| ALOGV("%s: exit ret %d", __func__, ret); |
| } |
| } |
| |
| void asphere_get_parameters(struct str_parms *query, |
| struct str_parms *reply) |
| { |
| char value[32] = {0}; |
| int ret; |
| |
| if (asphere_init() != 1) { |
| ALOGW("%s: init check failed!!!", __func__); |
| return; |
| } |
| |
| ret = str_parms_get_str(query, AUDIO_PARAMETER_KEY_ASPHERE_STATUS, |
| value, sizeof(value)); |
| if (ret >= 0) { |
| str_parms_add_int(reply, AUDIO_PARAMETER_KEY_ASPHERE_STATUS, |
| asphere.status); |
| } |
| |
| ret = str_parms_get_str(query, AUDIO_PARAMETER_KEY_ASPHERE_ENABLE, |
| value, sizeof(value)); |
| if (ret >= 0) { |
| str_parms_add_int(reply, AUDIO_PARAMETER_KEY_ASPHERE_ENABLE, |
| asphere.enabled ? 1 : 0); |
| } |
| |
| ret = str_parms_get_str(query, AUDIO_PARAMETER_KEY_ASPHERE_STRENGTH, |
| value, sizeof(value)); |
| if (ret >= 0) { |
| str_parms_add_int(reply, AUDIO_PARAMETER_KEY_ASPHERE_STRENGTH, |
| asphere.strength); |
| } |
| } |
| |
| static bool effect_needs_asphere_concurrency_handling(effect_context_t *context) |
| { |
| if (memcmp(&context->desc->type, |
| &equalizer_descriptor.type, sizeof(effect_uuid_t)) == 0 || |
| memcmp(&context->desc->type, |
| &bassboost_descriptor.type, sizeof(effect_uuid_t)) == 0 || |
| memcmp(&context->desc->type, |
| &virtualizer_descriptor.type, sizeof(effect_uuid_t)) == 0 || |
| memcmp(&context->desc->type, |
| &ins_preset_reverb_descriptor.type, sizeof(effect_uuid_t)) == 0 || |
| memcmp(&context->desc->type, |
| &ins_env_reverb_descriptor.type, sizeof(effect_uuid_t)) == 0) |
| return true; |
| |
| return false; |
| } |
| |
| void handle_asphere_on_effect_enabled(bool enable, |
| effect_context_t *context, |
| struct listnode *created_effects) |
| { |
| struct listnode *node; |
| |
| ALOGV("%s: effect %0x", __func__, context->desc->type.timeLow); |
| if (asphere_init() != 1) { |
| ALOGW("%s: init check failed!!!", __func__); |
| return; |
| } |
| |
| if (!effect_needs_asphere_concurrency_handling(context)) { |
| ALOGV("%s: effect %0x, do not need concurrency handling", |
| __func__, context->desc->type.timeLow); |
| return; |
| } |
| |
| list_for_each(node, created_effects) { |
| effect_context_t *fx_ctxt = node_to_item(node, |
| effect_context_t, |
| effects_list_node); |
| if (fx_ctxt != NULL && |
| effect_needs_asphere_concurrency_handling(fx_ctxt) == true && |
| fx_ctxt != context && effect_is_active(fx_ctxt) == true) { |
| ALOGV("%s: found another effect %0x, skip processing %0x", __func__, |
| fx_ctxt->desc->type.timeLow, context->desc->type.timeLow); |
| return; |
| } |
| } |
| pthread_mutex_lock(&asphere.lock); |
| asphere.status = enable ? ASPHERE_SUSPENDED : ASPHERE_ACTIVE; |
| asphere_set_values_to_mixer(); |
| asphere_notify_app(); |
| pthread_mutex_unlock(&asphere.lock); |
| } |