zenxfi2: implement headphones detection

Change-Id: Ifbc8b10cebb3b7b126f1d6a212f6731f91e234e4

1 files changed, 9 insertions, 0 deletions

diff --git a/firmware/target/arm/imx233/creative-zenxfi2/button-zenxfi2.c b/firmware/target/arm/imx233/creative-zenxfi2/button-zenxfi2.c
index 4f2a2775bf..2e72eabdb4 100644
--- a/firmware/target/arm/imx233/creative-zenxfi2/button-zenxfi2.c
+++ b/firmware/target/arm/imx233/creative-zenxfi2/button-zenxfi2.c
@@ -78,6 +78,10 @@ void button_init_device(void)
     imx233_pinctrl_acquire(0, 14, "select");
     imx233_pinctrl_set_function(0, 14, PINCTRL_FUNCTION_GPIO);
     imx233_pinctrl_enable_gpio(0, 14, false);
+    /* jack detect */
+    imx233_pinctrl_acquire(2, 7, "jack_detect");
+    imx233_pinctrl_set_function(2, 7, PINCTRL_FUNCTION_GPIO);
+    imx233_pinctrl_enable_gpio(2, 7, false);
 }
 
 static int touch_to_pixels(int *val_x, int *val_y)
@@ -119,6 +123,11 @@ static int touchscreen_read_device(int *data)
     return touchscreen_to_pixels(x, y, data);
 }
 
+bool headphones_inserted(void)
+{
+    return imx233_pinctrl_get_gpio(2, 7);
+}
+
 int button_read_device(int *data)
 {
     int res = 0;