summaryrefslogtreecommitdiffstats
path: root/firmware/drivers/audio/erosqlinux_codec.c
diff options
context:
space:
mode:
Diffstat (limited to 'firmware/drivers/audio/erosqlinux_codec.c')
-rw-r--r--firmware/drivers/audio/erosqlinux_codec.c181
1 files changed, 181 insertions, 0 deletions
diff --git a/firmware/drivers/audio/erosqlinux_codec.c b/firmware/drivers/audio/erosqlinux_codec.c
new file mode 100644
index 0000000000..deb3bb4b87
--- /dev/null
+++ b/firmware/drivers/audio/erosqlinux_codec.c
@@ -0,0 +1,181 @@
+/***************************************************************************
+ * __________ __ ___.
+ * Open \______ \ ____ ____ | | _\_ |__ _______ ___
+ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
+ * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
+ * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
+ * \/ \/ \/ \/ \/
+ * $Id$
+ *
+ *
+ * Copyright (c) 2018 Marcin Bukat
+ * Copyright (c) 2020 Solomon Peachy
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+//#define LOGF_ENABLE
+
+#include "config.h"
+#include "audio.h"
+#include "audiohw.h"
+#include "button.h"
+#include "system.h"
+#include "kernel.h"
+#include "panic.h"
+#include "sysfs.h"
+#include "alsa-controls.h"
+#include "pcm-alsa.h"
+#include "pcm_sw_volume.h"
+
+#include "logf.h"
+
+static int fd_hw;
+static int inited = 0;
+
+static long int vol_l_hw = 255;
+static long int vol_r_hw = 255;
+static long int last_ps = 0;
+
+static void hw_open(void)
+{
+ fd_hw = open("/dev/snd/controlC0", O_RDWR);
+ if(fd_hw < 0)
+ panicf("Cannot open '/dev/snd/controlC0'");
+}
+
+static void hw_close(void)
+{
+ close(fd_hw);
+}
+
+void audiohw_mute(int mute)
+{
+ logf("mute %d", mute);
+
+ if(mute)
+ {
+ long int ps0 = 0;
+ alsa_controls_set_ints("Output Port Switch", 1, &ps0);
+ }
+ else
+ {
+ last_ps = 0;
+ erosq_get_outputs();
+ }
+}
+
+int erosq_get_outputs(void) {
+ long int ps = 0; // Muted, if nothing is plugged in!
+
+ int status = 0;
+
+ if (!inited) return ps;
+
+ const char * const sysfs_lo_switch = "/sys/class/switch/lineout/state";
+ const char * const sysfs_hs_switch = "/sys/class/switch/headset/state";
+
+ sysfs_get_int(sysfs_lo_switch, &status);
+ if (status) ps = 1; // lineout
+
+ sysfs_get_int(sysfs_hs_switch, &status);
+ if (status) ps = 2; // headset
+
+ erosq_set_output(ps);
+
+ return ps;
+}
+
+void erosq_set_output(int ps)
+{
+ if (!inited) return;
+
+ if (last_ps != ps)
+ {
+ logf("set out %d/%d", ps, last_ps);
+ /* Output port switch */
+ last_ps = ps;
+ alsa_controls_set_ints("Output Port Switch", 1, &last_ps);
+ audiohw_set_volume(vol_l_hw, vol_r_hw);
+ }
+}
+
+void audiohw_preinit(void)
+{
+ logf("hw preinit");
+ alsa_controls_init();
+ hw_open();
+ audiohw_mute(true); /* Start muted to avoid the POP */
+ inited = 1;
+}
+
+void audiohw_postinit(void)
+{
+ logf("hw postinit");
+ erosq_set_output(erosq_get_outputs()); /* Unmute */
+}
+
+void audiohw_close(void)
+{
+ logf("hw close");
+ inited = 0;
+ hw_close();
+ alsa_controls_close();
+}
+
+void audiohw_set_frequency(int fsel)
+{
+ (void)fsel;
+}
+
+void audiohw_set_volume(int vol_l, int vol_r)
+{
+ logf("hw vol %d %d", vol_l, vol_r);
+
+ long l,r;
+
+ vol_l_hw = vol_l;
+ vol_r_hw = vol_r;
+
+ if (lineout_inserted()) {
+ l = 0;
+ r = 0;
+ } else {
+ l = vol_l_hw;
+ r = vol_r_hw;
+ }
+
+ /* SW volume for <= 1.0 gain, HW at unity, < -740 == MUTE */
+ int sw_volume_l = l <= -740 ? PCM_MUTE_LEVEL : MIN(l, 0);
+ int sw_volume_r = r <= -740 ? PCM_MUTE_LEVEL : MIN(r, 0);
+ pcm_set_master_volume(sw_volume_l, sw_volume_r);
+}
+
+void audiohw_set_lineout_volume(int vol_l, int vol_r)
+{
+ long l,r;
+
+ logf("lo vol %d %d", vol_l, vol_r);
+
+ (void)vol_l;
+ (void)vol_r;
+
+ if (lineout_inserted()) {
+ l = 0;
+ r = 0;
+ } else {
+ l = vol_l_hw;
+ r = vol_r_hw;
+ }
+
+ int sw_volume_l = l <= -740 ? PCM_MUTE_LEVEL : MIN(l, 0);
+ int sw_volume_r = r <= -740 ? PCM_MUTE_LEVEL : MIN(r, 0);
+ pcm_set_master_volume(sw_volume_l, sw_volume_r);
+}