imx233: add support for speaker on stmp3780

Change-Id: I990ca2bd43e12047e257f85ff06f046dfa3f94b3

1 files changed, 18 insertions, 0 deletions

diff --git a/firmware/target/arm/imx233/audioout-imx233.c b/firmware/target/arm/imx233/audioout-imx233.c
index c92804c2d4..3b6203ea44 100644
--- a/firmware/target/arm/imx233/audioout-imx233.c
+++ b/firmware/target/arm/imx233/audioout-imx233.c
@@ -261,6 +261,24 @@ void imx233_audioout_set_3d_effect(int val)
     }
 }
 
+void imx233_audioout_enable_spkr(bool en)
+{
+#if IMX233_SUBTARGET >= 3780
+    if(en)
+    {
+        BF_CLR(AUDIOOUT_PWRDN, SPEAKER);
+        BF_CLR(AUDIOOUT_SPEAKERCTRL, MUTE);
+    }
+    else
+    {
+        BF_SET(AUDIOOUT_SPEAKERCTRL, MUTE);
+        BF_SET(AUDIOOUT_PWRDN, SPEAKER);
+    }
+#else
+    (void) en;
+#endif
+}
+
 struct imx233_audioout_info_t imx233_audioout_get_info(void)
 {
     struct imx233_audioout_info_t info;