From db8f1eba9154789c45c6a92413bbbd94f5d9c7f5 Mon Sep 17 00:00:00 2001 From: Tim Yamin Date: Wed, 29 Apr 2009 17:30:25 -0700 Subject: [PATCH] Touch Book: turn on/off the class D amplifier depending on whether the headphones are plugged into the jack or not. Signed-off-by: Tim Yamin --- sound/soc/omap/omap3beagle.c | 33 +++++++++++++++++++++++++++++++++ 1 files changed, 33 insertions(+), 0 deletions(-) diff --git a/sound/soc/omap/omap3beagle.c b/sound/soc/omap/omap3beagle.c index fd24a4a..1236638 100644 --- a/sound/soc/omap/omap3beagle.c +++ b/sound/soc/omap/omap3beagle.c @@ -20,7 +20,10 @@ */ #include +#include +#include #include + #include #include #include @@ -35,6 +38,9 @@ #include "omap-pcm.h" #include "../codecs/twl4030.h" +#define TB_HEADPHONE_GPIO 56 +#define TB_HEADPHONE_IRQ OMAP_GPIO_IRQ(TB_HEADPHONE_GPIO) + static int omap3beagle_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params) { @@ -103,6 +109,33 @@ static struct snd_soc_device omap3beagle_snd_devdata = { static struct platform_device *omap3beagle_snd_device; +static void jack_work_func(struct work_struct *wq) +{ + struct snd_soc_device *socdev = platform_get_drvdata(omap3beagle_snd_device); + struct snd_soc_codec *codec = socdev->codec; + + snd_soc_dapm_sync(codec); +} +DECLARE_WORK(jack_work, jack_work_func); + +static irqreturn_t touchbook_headphone_event(int irq, void *snd) +{ + int status = gpio_get_value(TB_HEADPHONE_GPIO); + struct snd_soc_device *socdev = platform_get_drvdata(omap3beagle_snd_device); + struct snd_soc_codec *codec = socdev->codec; + + if(status) { + snd_soc_dapm_disable_pin(codec, "HFL"); + snd_soc_dapm_disable_pin(codec, "HFR"); + } else { + snd_soc_dapm_enable_pin(codec, "HFL"); + snd_soc_dapm_enable_pin(codec, "HFR"); + } + + schedule_work(&jack_work); + return IRQ_HANDLED; +} + static int __init omap3beagle_soc_init(void) { int ret; @@ -123,10 +156,22 @@ static int __init omap3beagle_soc_init(void) omap3beagle_snd_devdata.dev = &omap3beagle_snd_device->dev; *(unsigned int *)omap3beagle_dai.cpu_dai->private_data = 1; /* McBSP2 */ + /* Touch Book -- headphone jack sensor */ + omap_set_gpio_debounce(TB_HEADPHONE_GPIO, 1); + omap_set_gpio_debounce_time(TB_HEADPHONE_GPIO, 0xff); + + ret = request_irq(TB_HEADPHONE_IRQ, touchbook_headphone_event, IRQF_TRIGGER_RISING | + IRQF_TRIGGER_FALLING, "touchbook_headphone", omap3beagle_snd_device); + if (ret < 0) + goto err1; + ret = platform_device_add(omap3beagle_snd_device); if (ret) goto err1; + /* Detect headphone status */ + touchbook_headphone_event(0, omap3beagle_snd_device); + return 0; err1: