Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 253322c1 authored by Mark Brown's avatar Mark Brown
Browse files

ASoC: ak4641: Push GPIO allocation out into the I2C probe 



It's more idiomatic to do this and it means we don't try to bring up the
card if the CODEC didn't manage to bind successfully.

Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent a0abacd8

sound/soc/codecs/ak4641.c

+48 −44
Original line number Original line Diff line number Diff line
@@ -517,67 +517,24 @@ static int ak4641_resume(struct snd_soc_codec *codec) 




static int ak4641_probe(struct snd_soc_codec *codec)

static int ak4641_probe(struct snd_soc_codec *codec)

{

{

	struct ak4641_platform_data *pdata = codec->dev->platform_data;

	int ret;

	int ret;







	if (pdata) {

		if (gpio_is_valid(pdata->gpio_power)) {

			ret = gpio_request_one(pdata->gpio_power,

					GPIOF_OUT_INIT_LOW, "ak4641 power");

			if (ret)

				goto err_out;

		}

		if (gpio_is_valid(pdata->gpio_npdn)) {

			ret = gpio_request_one(pdata->gpio_npdn,

					GPIOF_OUT_INIT_LOW, "ak4641 npdn");

			if (ret)

				goto err_gpio;



			udelay(1); /* > 150 ns */

			gpio_set_value(pdata->gpio_npdn, 1);

		}

	}



	ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);

	ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);

	if (ret != 0) {

	if (ret != 0) {

		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);

		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);

		goto err_register;

		return ret;

	}

	}





	/* power on device */

	/* power on device */

	ak4641_set_bias_level(codec, SND_SOC_BIAS_STANDBY);

	ak4641_set_bias_level(codec, SND_SOC_BIAS_STANDBY);





	return 0;

	return 0;



err_register:

	if (pdata) {

		if (gpio_is_valid(pdata->gpio_power))

			gpio_set_value(pdata->gpio_power, 0);

		if (gpio_is_valid(pdata->gpio_npdn))

			gpio_free(pdata->gpio_npdn);

	}

err_gpio:

	if (pdata && gpio_is_valid(pdata->gpio_power))

		gpio_free(pdata->gpio_power);

err_out:

	return ret;

}

}





static int ak4641_remove(struct snd_soc_codec *codec)

static int ak4641_remove(struct snd_soc_codec *codec)

{

{

	struct ak4641_platform_data *pdata = codec->dev->platform_data;



	ak4641_set_bias_level(codec, SND_SOC_BIAS_OFF);

	ak4641_set_bias_level(codec, SND_SOC_BIAS_OFF);





	if (pdata) {

		if (gpio_is_valid(pdata->gpio_power)) {

			gpio_set_value(pdata->gpio_power, 0);

			gpio_free(pdata->gpio_power);

		}

		if (gpio_is_valid(pdata->gpio_npdn))

			gpio_free(pdata->gpio_npdn);

	}

	return 0;

	return 0;

}

}
@@ -604,6 +561,7 @@ static struct snd_soc_codec_driver soc_codec_dev_ak4641 = { 
static int __devinit ak4641_i2c_probe(struct i2c_client *i2c,

static int __devinit ak4641_i2c_probe(struct i2c_client *i2c,

				      const struct i2c_device_id *id)

				      const struct i2c_device_id *id)

{

{

	struct ak4641_platform_data *pdata = i2c->dev.platform_data;

	struct ak4641_priv *ak4641;

	struct ak4641_priv *ak4641;

	int ret;

	int ret;
@@ -612,16 +570,62 @@ static int __devinit ak4641_i2c_probe(struct i2c_client *i2c, 
	if (!ak4641)

	if (!ak4641)

		return -ENOMEM;

		return -ENOMEM;





	if (pdata) {

		if (gpio_is_valid(pdata->gpio_power)) {

			ret = gpio_request_one(pdata->gpio_power,

					GPIOF_OUT_INIT_LOW, "ak4641 power");

			if (ret)

				goto err_out;

		}

		if (gpio_is_valid(pdata->gpio_npdn)) {

			ret = gpio_request_one(pdata->gpio_npdn,

					GPIOF_OUT_INIT_LOW, "ak4641 npdn");

			if (ret)

				goto err_gpio;



			udelay(1); /* > 150 ns */

			gpio_set_value(pdata->gpio_npdn, 1);

		}

	}



	i2c_set_clientdata(i2c, ak4641);

	i2c_set_clientdata(i2c, ak4641);





	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_ak4641,

	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_ak4641,

				ak4641_dai, ARRAY_SIZE(ak4641_dai));

				ak4641_dai, ARRAY_SIZE(ak4641_dai));

	if (ret != 0)

		goto err_gpio2;



	return 0;



err_gpio2:

	if (pdata) {

		if (gpio_is_valid(pdata->gpio_power))

			gpio_set_value(pdata->gpio_power, 0);

		if (gpio_is_valid(pdata->gpio_npdn))

			gpio_free(pdata->gpio_npdn);

	}

err_gpio:

	if (pdata && gpio_is_valid(pdata->gpio_power))

		gpio_free(pdata->gpio_power);

err_out:

	return ret;

	return ret;

}

}





static int __devexit ak4641_i2c_remove(struct i2c_client *i2c)

static int __devexit ak4641_i2c_remove(struct i2c_client *i2c)

{

{

	struct ak4641_platform_data *pdata = i2c->dev.platform_data;



	snd_soc_unregister_codec(&i2c->dev);

	snd_soc_unregister_codec(&i2c->dev);



	if (pdata) {

		if (gpio_is_valid(pdata->gpio_power)) {

			gpio_set_value(pdata->gpio_power, 0);

			gpio_free(pdata->gpio_power);

		}

		if (gpio_is_valid(pdata->gpio_npdn))

			gpio_free(pdata->gpio_npdn);

	}



	return 0;

	return 0;

}

}