Commit 8ca2aa9c authored by Mark Brown's avatar Mark Brown
Browse files

ASoC: Put WM8962 GPIO2/3 into GPIO mode when configuring platform data too 



GPIO2 and GPIO3 on the WM8962 are MFPs and need to be put into GPIO mode
before the GPIO block can be used to control them. We're already doing
this when used via gpiolib, factor out the code for use when setting static
configurations via platform data as well.

Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
Acked-by: default avatarLiam Girdwood <lrg@slimlogic.co.uk>
parent 7711308a

sound/soc/codecs/wm8962.c

+29 −13
Original line number Original line Diff line number Diff line
@@ -1733,6 +1733,31 @@ static void wm8962_free_beep(struct snd_soc_codec *codec) 
}

}

#endif

#endif





static void wm8962_set_gpio_mode(struct snd_soc_codec *codec, int gpio)

{

	int mask = 0;

	int val = 0;



	/* Some of the GPIOs are behind MFP configuration and need to

	 * be put into GPIO mode. */

	switch (gpio) {

	case 2:

		mask = WM8962_CLKOUT2_SEL_MASK;

		val = 1 << WM8962_CLKOUT2_SEL_SHIFT;

		break;

	case 3:

		mask = WM8962_CLKOUT3_SEL_MASK;

		val = 1 << WM8962_CLKOUT3_SEL_SHIFT;

		break;

	default:

		break;

	}



	if (mask)

		snd_soc_update_bits(codec, WM8962_ANALOGUE_CLOCKING1,

				    mask, val);

}



#ifdef CONFIG_GPIOLIB

#ifdef CONFIG_GPIOLIB

static inline struct wm8962_priv *gpio_to_wm8962(struct gpio_chip *chip)

static inline struct wm8962_priv *gpio_to_wm8962(struct gpio_chip *chip)

{

{
@@ -1743,8 +1768,6 @@ static int wm8962_gpio_request(struct gpio_chip *chip, unsigned offset) 
{

{

	struct wm8962_priv *wm8962 = gpio_to_wm8962(chip);

	struct wm8962_priv *wm8962 = gpio_to_wm8962(chip);

	struct snd_soc_codec *codec = wm8962->codec;

	struct snd_soc_codec *codec = wm8962->codec;

	int mask = 0;

	int val;





	/* The WM8962 GPIOs aren't linearly numbered.  For simplicity

	/* The WM8962 GPIOs aren't linearly numbered.  For simplicity

	 * we export linear numbers and error out if the unsupported

	 * we export linear numbers and error out if the unsupported
@@ -1752,13 +1775,7 @@ static int wm8962_gpio_request(struct gpio_chip *chip, unsigned offset) 
	 */

	 */

	switch (offset + 1) {

	switch (offset + 1) {

	case 2:

	case 2:

		mask = WM8962_CLKOUT2_SEL_MASK;

		val = 1 << WM8962_CLKOUT2_SEL_SHIFT;

		break;

	case 3:

	case 3:

		mask = WM8962_CLKOUT3_SEL_MASK;

		val = 1 << WM8962_CLKOUT3_SEL_SHIFT;

		break;

	case 5:

	case 5:

	case 6:

	case 6:

		break;

		break;
@@ -1766,10 +1783,7 @@ static int wm8962_gpio_request(struct gpio_chip *chip, unsigned offset) 
		return -EINVAL;

		return -EINVAL;

	}

	}





	/* Some of the GPIOs are behind MFP configuration */

	wm8962_set_gpio_mode(codec, offset + 1);

	if (mask)

		snd_soc_update_bits(codec, WM8962_ANALOGUE_CLOCKING1,

				    mask, val);





	return 0;

	return 0;

}

}
@@ -1943,9 +1957,11 @@ static int wm8962_probe(struct snd_soc_codec *codec) 
	if (pdata) {

	if (pdata) {

		/* Apply static configuration for GPIOs */

		/* Apply static configuration for GPIOs */

		for (i = 0; i < ARRAY_SIZE(pdata->gpio_init); i++)

		for (i = 0; i < ARRAY_SIZE(pdata->gpio_init); i++)

			if (pdata->gpio_init[i])

			if (pdata->gpio_init[i]) {

				wm8962_set_gpio_mode(codec, i + 1);

				snd_soc_write(codec, 0x200 + i,

				snd_soc_write(codec, 0x200 + i,

					      pdata->gpio_init[i] & 0xffff);

					      pdata->gpio_init[i] & 0xffff);

			}





		/* Put the speakers into mono mode? */

		/* Put the speakers into mono mode? */

		if (pdata->spk_mono)

		if (pdata->spk_mono)

CRA Git | Maintained and supported by SUSTech CRA and CCSE