Commit ad4503d8 authored by Jean Delvare's avatar Jean Delvare Committed by Jaroslav Kysela

sound: ASoC: Convert wm8753 to a new-style i2c driver

Convert the wm8753 codec driver to the new (standard) i2c device
driver binding model.
Signed-off-by: default avatarJean Delvare <khali@linux-fr.org>
Cc: Ville Syrjala <syrjala@sci.fi>
Cc: Frank Mandarino <fmandarino@endrelia.com>
Cc: Mark Brown <broonie@opensource.wolfsonmicro.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
Signed-off-by: default avatarJaroslav Kysela <perex@perex.cz>
parent d280289e
...@@ -1637,84 +1637,86 @@ static struct snd_soc_device *wm8753_socdev; ...@@ -1637,84 +1637,86 @@ static struct snd_soc_device *wm8753_socdev;
* low = 0x1a * low = 0x1a
* high = 0x1b * high = 0x1b
*/ */
static unsigned short normal_i2c[] = { 0, I2C_CLIENT_END };
/* Magic definition of all other variables and things */ static int wm8753_i2c_probe(struct i2c_client *i2c,
I2C_CLIENT_INSMOD; const struct i2c_device_id *id)
static struct i2c_driver wm8753_i2c_driver;
static struct i2c_client client_template;
static int wm8753_codec_probe(struct i2c_adapter *adap, int addr, int kind)
{ {
struct snd_soc_device *socdev = wm8753_socdev; struct snd_soc_device *socdev = wm8753_socdev;
struct wm8753_setup_data *setup = socdev->codec_data;
struct snd_soc_codec *codec = socdev->codec; struct snd_soc_codec *codec = socdev->codec;
struct i2c_client *i2c;
int ret; int ret;
if (addr != setup->i2c_address)
return -ENODEV;
client_template.adapter = adap;
client_template.addr = addr;
i2c = kmemdup(&client_template, sizeof(client_template), GFP_KERNEL);
if (!i2c)
return -ENOMEM;
i2c_set_clientdata(i2c, codec); i2c_set_clientdata(i2c, codec);
codec->control_data = i2c; codec->control_data = i2c;
ret = i2c_attach_client(i2c);
if (ret < 0) {
pr_err("failed to attach codec at addr %x\n", addr);
goto err;
}
ret = wm8753_init(socdev); ret = wm8753_init(socdev);
if (ret < 0) { if (ret < 0)
pr_err("failed to initialise WM8753\n"); pr_err("failed to initialise WM8753\n");
goto err;
}
return ret; return ret;
err:
kfree(i2c);
return ret;
} }
static int wm8753_i2c_detach(struct i2c_client *client) static int wm8753_i2c_remove(struct i2c_client *client)
{ {
struct snd_soc_codec *codec = i2c_get_clientdata(client); struct snd_soc_codec *codec = i2c_get_clientdata(client);
i2c_detach_client(client);
kfree(codec->reg_cache); kfree(codec->reg_cache);
kfree(client);
return 0; return 0;
} }
static int wm8753_i2c_attach(struct i2c_adapter *adap) static const struct i2c_device_id wm8753_i2c_id[] = {
{ { "wm8753", 0 },
return i2c_probe(adap, &addr_data, wm8753_codec_probe); { }
} };
MODULE_DEVICE_TABLE(i2c, wm8753_i2c_id);
/* corgi i2c codec control layer */
static struct i2c_driver wm8753_i2c_driver = { static struct i2c_driver wm8753_i2c_driver = {
.driver = { .driver = {
.name = "WM8753 I2C Codec", .name = "WM8753 I2C Codec",
.owner = THIS_MODULE, .owner = THIS_MODULE,
}, },
.id = I2C_DRIVERID_WM8753, .probe = wm8753_i2c_probe,
.attach_adapter = wm8753_i2c_attach, .remove = wm8753_i2c_remove,
.detach_client = wm8753_i2c_detach, .id_table = wm8753_i2c_id,
.command = NULL,
}; };
static struct i2c_client client_template = { static int wm8753_add_i2c_device(struct platform_device *pdev,
.name = "WM8753", const struct wm8753_setup_data *setup)
.driver = &wm8753_i2c_driver, {
}; struct i2c_board_info info;
struct i2c_adapter *adapter;
struct i2c_client *client;
int ret;
ret = i2c_add_driver(&wm8753_i2c_driver);
if (ret != 0) {
dev_err(&pdev->dev, "can't add i2c driver\n");
return ret;
}
memset(&info, 0, sizeof(struct i2c_board_info));
info.addr = setup->i2c_address;
strlcpy(info.type, "wm8753", I2C_NAME_SIZE);
adapter = i2c_get_adapter(setup->i2c_bus);
if (!adapter) {
dev_err(&pdev->dev, "can't get i2c adapter %d\n",
setup->i2c_bus);
goto err_driver;
}
client = i2c_new_device(adapter, &info);
i2c_put_adapter(adapter);
if (!client) {
dev_err(&pdev->dev, "can't add i2c device at 0x%x\n",
(unsigned int)info.addr);
goto err_driver;
}
return 0;
err_driver:
i2c_del_driver(&wm8753_i2c_driver);
return -ENODEV;
}
#endif #endif
static int wm8753_probe(struct platform_device *pdev) static int wm8753_probe(struct platform_device *pdev)
...@@ -1748,11 +1750,8 @@ static int wm8753_probe(struct platform_device *pdev) ...@@ -1748,11 +1750,8 @@ static int wm8753_probe(struct platform_device *pdev)
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
if (setup->i2c_address) { if (setup->i2c_address) {
normal_i2c[0] = setup->i2c_address;
codec->hw_write = (hw_write_t)i2c_master_send; codec->hw_write = (hw_write_t)i2c_master_send;
ret = i2c_add_driver(&wm8753_i2c_driver); ret = wm8753_add_i2c_device(pdev, setup);
if (ret != 0)
printk(KERN_ERR "can't add i2c driver");
} }
#else #else
/* Add other interfaces here */ /* Add other interfaces here */
...@@ -1796,6 +1795,7 @@ static int wm8753_remove(struct platform_device *pdev) ...@@ -1796,6 +1795,7 @@ static int wm8753_remove(struct platform_device *pdev)
snd_soc_free_pcms(socdev); snd_soc_free_pcms(socdev);
snd_soc_dapm_free(socdev); snd_soc_dapm_free(socdev);
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
i2c_unregister_device(codec->control_data);
i2c_del_driver(&wm8753_i2c_driver); i2c_del_driver(&wm8753_i2c_driver);
#endif #endif
kfree(codec->private_data); kfree(codec->private_data);
......
...@@ -79,6 +79,7 @@ ...@@ -79,6 +79,7 @@
#define WM8753_ADCTL2 0x3f #define WM8753_ADCTL2 0x3f
struct wm8753_setup_data { struct wm8753_setup_data {
int i2c_bus;
unsigned short i2c_address; unsigned short i2c_address;
}; };
......
...@@ -586,6 +586,7 @@ static struct snd_soc_machine neo1973 = { ...@@ -586,6 +586,7 @@ static struct snd_soc_machine neo1973 = {
}; };
static struct wm8753_setup_data neo1973_wm8753_setup = { static struct wm8753_setup_data neo1973_wm8753_setup = {
.i2c_bus = 0,
.i2c_address = 0x1a, .i2c_address = 0x1a,
}; };
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment