audio: Add audio amplifier

* Based on Ham

4 files changed, 189 insertions, 2 deletions

diff --git a/audio_amplifier/Android.mk b/audio_amplifier/Android.mk
new file mode 100644
index 0000000..de6900a
--- /dev/null
+++ b/audio_amplifier/Android.mk
@@ -0,0 +1,24 @@
+LOCAL_PATH := $(call my-dir)
+
+include $(CLEAR_VARS)
+
+LOCAL_C_FLAGS += -DPLATFORM_MSM8996
+
+LOCAL_C_INCLUDES += \
+     $(call project-path-for,qcom-audio)/hal/msm8974/ \
+     $(TARGET_OUT_INTERMEDIATES)/KERNEL_OBJ/usr/include \
+     hardware/libhardware/include
+
+LOCAL_ADDITIONAL_DEPENDENCIES += $(TARGET_OUT_INTERMEDIATES)/KERNEL_OBJ/usr
+
+LOCAL_SHARED_LIBRARIES := liblog libutils libcutils libdl
+
+LOCAL_SRC_FILES := audio_amplifier.c
+
+LOCAL_MODULE := audio_amplifier.$(TARGET_BOARD_PLATFORM)
+
+LOCAL_MODULE_RELATIVE_PATH := hw
+
+LOCAL_MODULE_TAGS := optional
+
+include $(BUILD_SHARED_LIBRARY)
diff --git a/audio_amplifier/audio_amplifier.c b/audio_amplifier/audio_amplifier.c
new file mode 100644
index 0000000..feb47a7
--- /dev/null
+++ b/audio_amplifier/audio_amplifier.c
@@ -0,0 +1,162 @@
+/*
+ * Copyright (C) 2013-2016, The CyanogenMod Project
+ *
+ * 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.
+ */
+
+
+#include <time.h>
+#include <system/audio.h>
+#include <platform.h>
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <ctype.h>
+#include <dlfcn.h>
+#include <sys/ioctl.h>
+
+#define LOG_TAG "ailsa_ii-tfa98xx"
+#include <log/log.h>
+
+#include <hardware/audio_amplifier.h>
+
+typedef struct tfa9890_device {
+    amplifier_device_t amp_dev;
+    void *lib_ptr;
+    int (*init)(int);
+    int (*speaker_needed)(int, int);
+    void (*speaker_on)(void);
+    void (*speaker_off)(void);
+} tfa9890_device_t;
+
+static tfa9890_device_t *tfa9890_dev = NULL;
+
+static int is_spkr_needed(uint32_t snd_device) {
+    int spkr_needed = 0;
+
+    switch (snd_device) {
+        case SND_DEVICE_OUT_SPEAKER:
+        case SND_DEVICE_OUT_VOICE_SPEAKER:
+            spkr_needed = 1;
+            break;
+    }
+
+    return spkr_needed;
+}
+
+static int amp_enable_output_devices(hw_device_t *device, uint32_t devices, bool enable) {
+    tfa9890_device_t *tfa9890 = (tfa9890_device_t*) device;
+
+    if (is_spkr_needed(devices)) {
+        if (enable) {
+            tfa9890->speaker_needed(1, 1);
+            tfa9890->speaker_on();
+            } else {
+               tfa9890->speaker_needed(0, 0);
+               tfa9890->speaker_off();
+            }
+    }
+    return 0;
+}
+
+static int amp_dev_close(hw_device_t *device) {
+    tfa9890_device_t *tfa9890 = (tfa9890_device_t*) device;
+
+    if (tfa9890) {
+        dlclose(tfa9890->lib_ptr);
+        free(tfa9890);
+    }
+
+    return 0;
+}
+
+static int amp_init(tfa9890_device_t *tfa9890) {
+
+    tfa9890->init;
+
+    return 0;
+}
+
+static int amp_module_open(const hw_module_t *module,
+        __attribute__((unused)) const char *name, hw_device_t **device)
+{
+    if (tfa9890_dev) {
+        ALOGE("%s:%d: Unable to open second instance of TFA9890 amplifier\n",
+                __func__, __LINE__);
+        return -EBUSY;
+    }
+
+    tfa9890_dev = calloc(1, sizeof(tfa9890_device_t));
+    if (!tfa9890_dev) {
+        ALOGE("%s:%d: Unable to allocate memory for amplifier device\n",
+                __func__, __LINE__);
+        return -ENOMEM;
+    }
+
+    tfa9890_dev->amp_dev.common.tag = HARDWARE_DEVICE_TAG;
+    tfa9890_dev->amp_dev.common.module = (hw_module_t *) module;
+    tfa9890_dev->amp_dev.common.version = HARDWARE_DEVICE_API_VERSION(1, 0);
+    tfa9890_dev->amp_dev.common.close = amp_dev_close;
+
+    tfa9890_dev->amp_dev.enable_output_devices = amp_enable_output_devices;
+
+    tfa9890_dev->lib_ptr = dlopen("libtfa9890.so", RTLD_NOW);
+    if (!tfa9890_dev->lib_ptr) {
+        ALOGE("%s:%d: Unable to open libtfa9890.so: %s",
+                __func__, __LINE__, dlerror());
+        free(tfa9890_dev);
+        return -ENODEV;
+    }
+
+    *(void **)&tfa9890_dev->init = dlsym(tfa9890_dev->lib_ptr, "tfa98xx_init");
+    *(void **)&tfa9890_dev->speaker_needed = dlsym(tfa9890_dev->lib_ptr, "tfa9890_Set_Stereo_SpeakerNeeded");
+    *(void **)&tfa9890_dev->speaker_on = dlsym(tfa9890_dev->lib_ptr, "tfa9890_Stereo_SpeakerOn_bypass");
+    *(void **)&tfa9890_dev->speaker_off = dlsym(tfa9890_dev->lib_ptr, "tfa9890_Stereo_SpeakerOff_bypass");
+
+    if (!tfa9890_dev->init || !tfa9890_dev->speaker_needed || !tfa9890_dev->speaker_on || !tfa9890_dev->speaker_off ) {
+        ALOGE("%s:%d: Unable to find required symbols", __func__, __LINE__);
+        dlclose(tfa9890_dev->lib_ptr);
+        free(tfa9890_dev);
+        return -ENODEV;
+    }
+
+    if (amp_init(tfa9890_dev)) {
+        dlclose(tfa9890_dev->lib_ptr);
+        free(tfa9890_dev);
+        return -ENODEV;
+    }
+
+    *device = (hw_device_t *) tfa9890_dev;
+
+    return 0;
+}
+
+static struct hw_module_methods_t hal_module_methods = {
+    .open = amp_module_open,
+};
+
+amplifier_module_t HAL_MODULE_INFO_SYM = {
+    .common = {
+        .tag = HARDWARE_MODULE_TAG,
+        .module_api_version = AMPLIFIER_MODULE_API_VERSION_0_1,
+        .hal_api_version = HARDWARE_HAL_API_VERSION,
+        .id = AMPLIFIER_HARDWARE_MODULE_ID,
+        .name = "Ailsa_II amplifier HAL",
+        .author = "The CyanogenMod Open Source Project",
+        .methods = &hal_module_methods,
+    },
+};
diff --git a/product/qcom-audio.mk b/product/qcom-audio.mk
index fc2400e..ea4df3a 100644
--- a/product/qcom-audio.mk
+++ b/product/qcom-audio.mk
@@ -1,5 +1,6 @@
 # Audio
 PRODUCT_PACKAGES += \
+    audio_amplifier.msm8996 \
     audiod \
     audio.primary.msm8996 \
     libqcompostprocbundle \
diff --git a/proprietary-files.txt b/proprietary-files.txt
index 89ebb42..e3f1f4e 100644
--- a/proprietary-files.txt
+++ b/proprietary-files.txt
@@ -48,8 +48,8 @@ etc/settings/mono_qcom_spk_r.cnt
 etc/settings/stereo_qcom_spk.cnt
 etc/settings/stereo_qcom_spk_l.cnt
 etc/settings/stereo_qcom_spk_r.cnt
--lib64/libtfa9890.so
--lib/libtfa9890.so
+lib64/libtfa9890.so
+lib/libtfa9890.so
 
 # Camera
 bin/mm-qcamera-daemon