[mirror_ubuntu-bionic-kernel.git] / drivers / mfd / wm831x-i2c.c

/*
 * wm831x-i2c.c  --  I2C access for Wolfson WM831x PMICs
 *
 * Copyright 2009,2010 Wolfson Microelectronics PLC.
 *
 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/i2c.h>
#include <linux/delay.h>
#include <linux/mfd/core.h>
#include <linux/slab.h>
#include <linux/err.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/regmap.h>

#include <linux/mfd/wm831x/core.h>
#include <linux/mfd/wm831x/pdata.h>

static int wm831x_i2c_probe(struct i2c_client *i2c,
			    const struct i2c_device_id *id)
{
	struct wm831x_pdata *pdata = dev_get_platdata(&i2c->dev);
	const struct of_device_id *of_id;
	struct wm831x *wm831x;
	enum wm831x_parent type;
	int ret;

	if (i2c->dev.of_node) {
		of_id = of_match_device(wm831x_of_match, &i2c->dev);
		if (!of_id) {
			dev_err(&i2c->dev, "Failed to match device\n");
			return -ENODEV;
		}
		type = (enum wm831x_parent)of_id->data;
	} else {
		type = (enum wm831x_parent)id->driver_data;
	}

	wm831x = devm_kzalloc(&i2c->dev, sizeof(struct wm831x), GFP_KERNEL);
	if (wm831x == NULL)
		return -ENOMEM;

	i2c_set_clientdata(i2c, wm831x);
	wm831x->dev = &i2c->dev;
	wm831x->type = type;

	wm831x->regmap = devm_regmap_init_i2c(i2c, &wm831x_regmap_config);
	if (IS_ERR(wm831x->regmap)) {
		ret = PTR_ERR(wm831x->regmap);
		dev_err(wm831x->dev, "Failed to allocate register map: %d\n",
			ret);
		return ret;
	}

	if (pdata)
		memcpy(&wm831x->pdata, pdata, sizeof(*pdata));

	return wm831x_device_init(wm831x, i2c->irq);
}

static int wm831x_i2c_remove(struct i2c_client *i2c)
{
	struct wm831x *wm831x = i2c_get_clientdata(i2c);

	wm831x_device_exit(wm831x);

	return 0;
}

static int wm831x_i2c_suspend(struct device *dev)
{
	struct wm831x *wm831x = dev_get_drvdata(dev);

	return wm831x_device_suspend(wm831x);
}

static int wm831x_i2c_poweroff(struct device *dev)
{
	struct wm831x *wm831x = dev_get_drvdata(dev);

	wm831x_device_shutdown(wm831x);

	return 0;
}

static const struct i2c_device_id wm831x_i2c_id[] = {
	{ "wm8310", WM8310 },
	{ "wm8311", WM8311 },
	{ "wm8312", WM8312 },
	{ "wm8320", WM8320 },
	{ "wm8321", WM8321 },
	{ "wm8325", WM8325 },
	{ "wm8326", WM8326 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, wm831x_i2c_id);

static const struct dev_pm_ops wm831x_pm_ops = {
	.suspend = wm831x_i2c_suspend,
	.poweroff = wm831x_i2c_poweroff,
};

static struct i2c_driver wm831x_i2c_driver = {
	.driver = {
		.name = "wm831x",
		.pm = &wm831x_pm_ops,
		.of_match_table = of_match_ptr(wm831x_of_match),
	},
	.probe = wm831x_i2c_probe,
	.remove = wm831x_i2c_remove,
	.id_table = wm831x_i2c_id,
};

static int __init wm831x_i2c_init(void)
{
	int ret;

	ret = i2c_add_driver(&wm831x_i2c_driver);
	if (ret != 0)
		pr_err("Failed to register wm831x I2C driver: %d\n", ret);

	return ret;
}
subsys_initcall(wm831x_i2c_init);

static void __exit wm831x_i2c_exit(void)
{
	i2c_del_driver(&wm831x_i2c_driver);
}
module_exit(wm831x_i2c_exit);
Commit	Line	Data
e5b48684 MB	1	/*
	2	* wm831x-i2c.c -- I2C access for Wolfson WM831x PMICs
	3	*
	4	* Copyright 2009,2010 Wolfson Microelectronics PLC.
	5	*
	6	* Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify it
	9	* under the terms of the GNU General Public License as published by the
	10	* Free Software Foundation; either version 2 of the License, or (at your
	11	* option) any later version.
	12	*
	13	*/
	14
	15	#include <linux/kernel.h>
	16	#include <linux/module.h>
	17	#include <linux/i2c.h>
	18	#include <linux/delay.h>
	19	#include <linux/mfd/core.h>
	20	#include <linux/slab.h>
1df5981b	21	#include <linux/err.h>
f6dd8449 CK	22	#include <linux/of.h>
f6dd8449 CK	23	#include <linux/of_device.h>
1df5981b	24	#include <linux/regmap.h>
e5b48684 MB	25
	26	#include <linux/mfd/wm831x/core.h>
	27	#include <linux/mfd/wm831x/pdata.h>
	28
e5b48684 MB	29	static int wm831x_i2c_probe(struct i2c_client *i2c,
	30	const struct i2c_device_id *id)
	31	{
f6dd8449 CK	32	struct wm831x_pdata *pdata = dev_get_platdata(&i2c->dev);
f6dd8449 CK	33	const struct of_device_id *of_id;
e5b48684	34	struct wm831x *wm831x;
f6dd8449	35	enum wm831x_parent type;
1df5981b	36	int ret;
e5b48684	37
f6dd8449 CK	38	if (i2c->dev.of_node) {
f6dd8449 CK	39	of_id = of_match_device(wm831x_of_match, &i2c->dev);
800e5455 GS	40	if (!of_id) {
	41	dev_err(&i2c->dev, "Failed to match device\n");
	42	return -ENODEV;
	43	}
f6dd8449 CK	44	type = (enum wm831x_parent)of_id->data;
	45	} else {
	46	type = (enum wm831x_parent)id->driver_data;
	47	}
	48
d48cbb74	49	wm831x = devm_kzalloc(&i2c->dev, sizeof(struct wm831x), GFP_KERNEL);
e5b48684 MB	50	if (wm831x == NULL)
	51	return -ENOMEM;
	52
	53	i2c_set_clientdata(i2c, wm831x);
	54	wm831x->dev = &i2c->dev;
f6dd8449	55	wm831x->type = type;
1df5981b	56
130a7032	57	wm831x->regmap = devm_regmap_init_i2c(i2c, &wm831x_regmap_config);
1df5981b MB	58	if (IS_ERR(wm831x->regmap)) {
	59	ret = PTR_ERR(wm831x->regmap);
	60	dev_err(wm831x->dev, "Failed to allocate register map: %d\n",
	61	ret);
1df5981b MB	62	return ret;
1df5981b MB	63	}
e5b48684	64
f6dd8449 CK	65	if (pdata)
	66	memcpy(&wm831x->pdata, pdata, sizeof(*pdata));
	67
	68	return wm831x_device_init(wm831x, i2c->irq);
e5b48684 MB	69	}
	70
	71	static int wm831x_i2c_remove(struct i2c_client *i2c)
	72	{
	73	struct wm831x *wm831x = i2c_get_clientdata(i2c);
	74
	75	wm831x_device_exit(wm831x);
	76
	77	return 0;
	78	}
	79
c538ddbe	80	static int wm831x_i2c_suspend(struct device *dev)
e5b48684	81	{
c538ddbe	82	struct wm831x *wm831x = dev_get_drvdata(dev);
e5b48684 MB	83
	84	return wm831x_device_suspend(wm831x);
	85	}
	86
b9736a16	87	static int wm831x_i2c_poweroff(struct device *dev)
523d9cfb	88	{
b9736a16	89	struct wm831x *wm831x = dev_get_drvdata(dev);
523d9cfb MB	90
523d9cfb MB	91	wm831x_device_shutdown(wm831x);
b9736a16 MB	92
b9736a16 MB	93	return 0;
523d9cfb MB	94	}
523d9cfb MB	95
e5b48684 MB	96	static const struct i2c_device_id wm831x_i2c_id[] = {
	97	{ "wm8310", WM8310 },
	98	{ "wm8311", WM8311 },
	99	{ "wm8312", WM8312 },
	100	{ "wm8320", WM8320 },
	101	{ "wm8321", WM8321 },
	102	{ "wm8325", WM8325 },
412dc11d	103	{ "wm8326", WM8326 },
e5b48684 MB	104	{ }
	105	};
	106	MODULE_DEVICE_TABLE(i2c, wm831x_i2c_id);
	107
c538ddbe MB	108	static const struct dev_pm_ops wm831x_pm_ops = {
c538ddbe MB	109	.suspend = wm831x_i2c_suspend,
b9736a16	110	.poweroff = wm831x_i2c_poweroff,
c538ddbe	111	};
e5b48684 MB	112
	113	static struct i2c_driver wm831x_i2c_driver = {
	114	.driver = {
c538ddbe	115	.name = "wm831x",
c538ddbe	116	.pm = &wm831x_pm_ops,
f6dd8449	117	.of_match_table = of_match_ptr(wm831x_of_match),
e5b48684 MB	118	},
	119	.probe = wm831x_i2c_probe,
	120	.remove = wm831x_i2c_remove,
e5b48684 MB	121	.id_table = wm831x_i2c_id,
	122	};
	123
	124	static int __init wm831x_i2c_init(void)
	125	{
	126	int ret;
	127
	128	ret = i2c_add_driver(&wm831x_i2c_driver);
	129	if (ret != 0)
	130	pr_err("Failed to register wm831x I2C driver: %d\n", ret);
	131
	132	return ret;
	133	}
	134	subsys_initcall(wm831x_i2c_init);
	135
	136	static void __exit wm831x_i2c_exit(void)
	137	{
	138	i2c_del_driver(&wm831x_i2c_driver);
	139	}
	140	module_exit(wm831x_i2c_exit);