|
@@ -26,6 +26,7 @@
|
|
#include <linux/delay.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
+#include <linux/gpio/consumer.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
#include <sound/core.h>
|
|
#include <sound/core.h>
|
|
#include <sound/jack.h>
|
|
#include <sound/jack.h>
|
|
@@ -38,15 +39,6 @@
|
|
|
|
|
|
#include "omap-mcbsp.h"
|
|
#include "omap-mcbsp.h"
|
|
|
|
|
|
-#define RX51_TVOUT_SEL_GPIO 40
|
|
|
|
-#define RX51_JACK_DETECT_GPIO 177
|
|
|
|
-#define RX51_ECI_SW_GPIO 182
|
|
|
|
-/*
|
|
|
|
- * REVISIT: TWL4030 GPIO base in RX-51. Now statically defined to 192. This
|
|
|
|
- * gpio is reserved in arch/arm/mach-omap2/board-rx51-peripherals.c
|
|
|
|
- */
|
|
|
|
-#define RX51_SPEAKER_AMP_TWL_GPIO (192 + 7)
|
|
|
|
-
|
|
|
|
enum {
|
|
enum {
|
|
RX51_JACK_DISABLED,
|
|
RX51_JACK_DISABLED,
|
|
RX51_JACK_TVOUT, /* tv-out with stereo output */
|
|
RX51_JACK_TVOUT, /* tv-out with stereo output */
|
|
@@ -54,12 +46,21 @@ enum {
|
|
RX51_JACK_HS, /* headset: stereo output with mic */
|
|
RX51_JACK_HS, /* headset: stereo output with mic */
|
|
};
|
|
};
|
|
|
|
|
|
|
|
+struct rx51_audio_pdata {
|
|
|
|
+ struct gpio_desc *tvout_selection_gpio;
|
|
|
|
+ struct gpio_desc *jack_detection_gpio;
|
|
|
|
+ struct gpio_desc *eci_sw_gpio;
|
|
|
|
+ struct gpio_desc *speaker_amp_gpio;
|
|
|
|
+};
|
|
|
|
+
|
|
static int rx51_spk_func;
|
|
static int rx51_spk_func;
|
|
static int rx51_dmic_func;
|
|
static int rx51_dmic_func;
|
|
static int rx51_jack_func;
|
|
static int rx51_jack_func;
|
|
|
|
|
|
static void rx51_ext_control(struct snd_soc_dapm_context *dapm)
|
|
static void rx51_ext_control(struct snd_soc_dapm_context *dapm)
|
|
{
|
|
{
|
|
|
|
+ struct snd_soc_card *card = dapm->card;
|
|
|
|
+ struct rx51_audio_pdata *pdata = snd_soc_card_get_drvdata(card);
|
|
int hp = 0, hs = 0, tvout = 0;
|
|
int hp = 0, hs = 0, tvout = 0;
|
|
|
|
|
|
switch (rx51_jack_func) {
|
|
switch (rx51_jack_func) {
|
|
@@ -93,7 +94,7 @@ static void rx51_ext_control(struct snd_soc_dapm_context *dapm)
|
|
else
|
|
else
|
|
snd_soc_dapm_disable_pin_unlocked(dapm, "HS Mic");
|
|
snd_soc_dapm_disable_pin_unlocked(dapm, "HS Mic");
|
|
|
|
|
|
- gpio_set_value(RX51_TVOUT_SEL_GPIO, tvout);
|
|
|
|
|
|
+ gpiod_set_value(pdata->tvout_selection_gpio, tvout);
|
|
|
|
|
|
snd_soc_dapm_sync_unlocked(dapm);
|
|
snd_soc_dapm_sync_unlocked(dapm);
|
|
|
|
|
|
@@ -154,10 +155,12 @@ static int rx51_set_spk(struct snd_kcontrol *kcontrol,
|
|
static int rx51_spk_event(struct snd_soc_dapm_widget *w,
|
|
static int rx51_spk_event(struct snd_soc_dapm_widget *w,
|
|
struct snd_kcontrol *k, int event)
|
|
struct snd_kcontrol *k, int event)
|
|
{
|
|
{
|
|
- if (SND_SOC_DAPM_EVENT_ON(event))
|
|
|
|
- gpio_set_value_cansleep(RX51_SPEAKER_AMP_TWL_GPIO, 1);
|
|
|
|
- else
|
|
|
|
- gpio_set_value_cansleep(RX51_SPEAKER_AMP_TWL_GPIO, 0);
|
|
|
|
|
|
+ struct snd_soc_dapm_context *dapm = w->dapm;
|
|
|
|
+ struct snd_soc_card *card = dapm->card;
|
|
|
|
+ struct rx51_audio_pdata *pdata = snd_soc_card_get_drvdata(card);
|
|
|
|
+
|
|
|
|
+ gpiod_set_raw_value_cansleep(pdata->speaker_amp_gpio,
|
|
|
|
+ !!SND_SOC_DAPM_EVENT_ON(event));
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
@@ -223,7 +226,6 @@ static struct snd_soc_jack rx51_av_jack;
|
|
|
|
|
|
static struct snd_soc_jack_gpio rx51_av_jack_gpios[] = {
|
|
static struct snd_soc_jack_gpio rx51_av_jack_gpios[] = {
|
|
{
|
|
{
|
|
- .gpio = RX51_JACK_DETECT_GPIO,
|
|
|
|
.name = "avdet-gpio",
|
|
.name = "avdet-gpio",
|
|
.report = SND_JACK_HEADSET,
|
|
.report = SND_JACK_HEADSET,
|
|
.invert = 1,
|
|
.invert = 1,
|
|
@@ -284,6 +286,9 @@ static const struct snd_kcontrol_new aic34_rx51_controls[] = {
|
|
static int rx51_aic34_init(struct snd_soc_pcm_runtime *rtd)
|
|
static int rx51_aic34_init(struct snd_soc_pcm_runtime *rtd)
|
|
{
|
|
{
|
|
struct snd_soc_codec *codec = rtd->codec;
|
|
struct snd_soc_codec *codec = rtd->codec;
|
|
|
|
+ struct snd_soc_card *card = codec->card;
|
|
|
|
+ struct rx51_audio_pdata *pdata = snd_soc_card_get_drvdata(card);
|
|
|
|
+
|
|
struct snd_soc_dapm_context *dapm = &codec->dapm;
|
|
struct snd_soc_dapm_context *dapm = &codec->dapm;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
@@ -307,6 +312,11 @@ static int rx51_aic34_init(struct snd_soc_pcm_runtime *rtd)
|
|
&rx51_av_jack);
|
|
&rx51_av_jack);
|
|
if (err)
|
|
if (err)
|
|
return err;
|
|
return err;
|
|
|
|
+
|
|
|
|
+ /* prepare gpio for snd_soc_jack_add_gpios */
|
|
|
|
+ rx51_av_jack_gpios[0].gpio = desc_to_gpio(pdata->jack_detection_gpio);
|
|
|
|
+ devm_gpiod_put(card->dev, pdata->jack_detection_gpio);
|
|
|
|
+
|
|
err = snd_soc_jack_add_gpios(&rx51_av_jack,
|
|
err = snd_soc_jack_add_gpios(&rx51_av_jack,
|
|
ARRAY_SIZE(rx51_av_jack_gpios),
|
|
ARRAY_SIZE(rx51_av_jack_gpios),
|
|
rx51_av_jack_gpios);
|
|
rx51_av_jack_gpios);
|
|
@@ -365,37 +375,74 @@ static struct snd_soc_card rx51_sound_card = {
|
|
|
|
|
|
static int rx51_soc_probe(struct platform_device *pdev)
|
|
static int rx51_soc_probe(struct platform_device *pdev)
|
|
{
|
|
{
|
|
|
|
+ struct rx51_audio_pdata *pdata;
|
|
struct snd_soc_card *card = &rx51_sound_card;
|
|
struct snd_soc_card *card = &rx51_sound_card;
|
|
int err;
|
|
int err;
|
|
|
|
|
|
if (!machine_is_nokia_rx51() && !of_machine_is_compatible("nokia,omap3-n900"))
|
|
if (!machine_is_nokia_rx51() && !of_machine_is_compatible("nokia,omap3-n900"))
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
|
|
|
|
- err = gpio_request_one(RX51_TVOUT_SEL_GPIO,
|
|
|
|
- GPIOF_DIR_OUT | GPIOF_INIT_LOW, "tvout_sel");
|
|
|
|
- if (err)
|
|
|
|
- goto err_gpio_tvout_sel;
|
|
|
|
- err = gpio_request_one(RX51_ECI_SW_GPIO,
|
|
|
|
- GPIOF_DIR_OUT | GPIOF_INIT_HIGH, "eci_sw");
|
|
|
|
- if (err)
|
|
|
|
- goto err_gpio_eci_sw;
|
|
|
|
-
|
|
|
|
card->dev = &pdev->dev;
|
|
card->dev = &pdev->dev;
|
|
|
|
|
|
|
|
+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
|
|
|
|
+ if (pdata == NULL) {
|
|
|
|
+ dev_err(card->dev, "failed to create private data\n");
|
|
|
|
+ return -ENOMEM;
|
|
|
|
+ }
|
|
|
|
+ snd_soc_card_set_drvdata(card, pdata);
|
|
|
|
+
|
|
|
|
+ pdata->tvout_selection_gpio = devm_gpiod_get(card->dev,
|
|
|
|
+ "tvout-selection");
|
|
|
|
+ if (IS_ERR(pdata->tvout_selection_gpio)) {
|
|
|
|
+ dev_err(card->dev, "could not get tvout selection gpio\n");
|
|
|
|
+ return PTR_ERR(pdata->tvout_selection_gpio);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ err = gpiod_direction_output(pdata->tvout_selection_gpio, 0);
|
|
|
|
+ if (err) {
|
|
|
|
+ dev_err(card->dev, "could not setup tvout selection gpio\n");
|
|
|
|
+ return err;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ pdata->jack_detection_gpio = devm_gpiod_get(card->dev,
|
|
|
|
+ "jack-detection");
|
|
|
|
+ if (IS_ERR(pdata->jack_detection_gpio)) {
|
|
|
|
+ dev_err(card->dev, "could not get jack detection gpio\n");
|
|
|
|
+ return PTR_ERR(pdata->jack_detection_gpio);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ pdata->eci_sw_gpio = devm_gpiod_get(card->dev, "eci-switch");
|
|
|
|
+ if (IS_ERR(pdata->eci_sw_gpio)) {
|
|
|
|
+ dev_err(card->dev, "could not get eci switch gpio\n");
|
|
|
|
+ return PTR_ERR(pdata->eci_sw_gpio);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ err = gpiod_direction_output(pdata->eci_sw_gpio, 1);
|
|
|
|
+ if (err) {
|
|
|
|
+ dev_err(card->dev, "could not setup eci switch gpio\n");
|
|
|
|
+ return err;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ pdata->speaker_amp_gpio = devm_gpiod_get(card->dev,
|
|
|
|
+ "speaker-amplifier");
|
|
|
|
+ if (IS_ERR(pdata->speaker_amp_gpio)) {
|
|
|
|
+ dev_err(card->dev, "could not get speaker enable gpio\n");
|
|
|
|
+ return PTR_ERR(pdata->speaker_amp_gpio);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ err = gpiod_direction_output(pdata->speaker_amp_gpio, 0);
|
|
|
|
+ if (err) {
|
|
|
|
+ dev_err(card->dev, "could not setup speaker enable gpio\n");
|
|
|
|
+ return err;
|
|
|
|
+ }
|
|
|
|
+
|
|
err = devm_snd_soc_register_card(card->dev, card);
|
|
err = devm_snd_soc_register_card(card->dev, card);
|
|
if (err) {
|
|
if (err) {
|
|
dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", err);
|
|
dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", err);
|
|
- goto err_snd;
|
|
|
|
|
|
+ return err;
|
|
}
|
|
}
|
|
|
|
|
|
return 0;
|
|
return 0;
|
|
-err_snd:
|
|
|
|
- gpio_free(RX51_ECI_SW_GPIO);
|
|
|
|
-err_gpio_eci_sw:
|
|
|
|
- gpio_free(RX51_TVOUT_SEL_GPIO);
|
|
|
|
-err_gpio_tvout_sel:
|
|
|
|
-
|
|
|
|
- return err;
|
|
|
|
}
|
|
}
|
|
|
|
|
|
static int rx51_soc_remove(struct platform_device *pdev)
|
|
static int rx51_soc_remove(struct platform_device *pdev)
|
|
@@ -403,9 +450,6 @@ static int rx51_soc_remove(struct platform_device *pdev)
|
|
snd_soc_jack_free_gpios(&rx51_av_jack, ARRAY_SIZE(rx51_av_jack_gpios),
|
|
snd_soc_jack_free_gpios(&rx51_av_jack, ARRAY_SIZE(rx51_av_jack_gpios),
|
|
rx51_av_jack_gpios);
|
|
rx51_av_jack_gpios);
|
|
|
|
|
|
- gpio_free(RX51_ECI_SW_GPIO);
|
|
|
|
- gpio_free(RX51_TVOUT_SEL_GPIO);
|
|
|
|
-
|
|
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|