[mirror_ubuntu-bionic-kernel.git] / drivers / regulator / act8865-regulator.c

/*
 * act8865-regulator.c - Voltage regulation for the active-semi ACT8865
 * http://www.active-semi.com/sheets/ACT8865_Datasheet.pdf
 *
 * Copyright (C) 2013 Atmel Corporation
 *
 * 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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/i2c.h>
#include <linux/err.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/act8865.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/regulator/of_regulator.h>
#include <linux/regmap.h>

/*
 * ACT8865 Global Register Map.
 */
#define	ACT8865_SYS_MODE	0x00
#define	ACT8865_SYS_CTRL	0x01
#define	ACT8865_DCDC1_VSET1	0x20
#define	ACT8865_DCDC1_VSET2	0x21
#define	ACT8865_DCDC1_CTRL	0x22
#define	ACT8865_DCDC2_VSET1	0x30
#define	ACT8865_DCDC2_VSET2	0x31
#define	ACT8865_DCDC2_CTRL	0x32
#define	ACT8865_DCDC3_VSET1	0x40
#define	ACT8865_DCDC3_VSET2	0x41
#define	ACT8865_DCDC3_CTRL	0x42
#define	ACT8865_LDO1_VSET	0x50
#define	ACT8865_LDO1_CTRL	0x51
#define	ACT8865_LDO2_VSET	0x54
#define	ACT8865_LDO2_CTRL	0x55
#define	ACT8865_LDO3_VSET	0x60
#define	ACT8865_LDO3_CTRL	0x61
#define	ACT8865_LDO4_VSET	0x64
#define	ACT8865_LDO4_CTRL	0x65

/*
 * Field Definitions.
 */
#define	ACT8865_ENA		0x80	/* ON - [7] */
#define	ACT8865_VSEL_MASK	0x3F	/* VSET - [5:0] */

/*
 * ACT8865 voltage number
 */
#define	ACT8865_VOLTAGE_NUM	64

struct act8865 {
	struct regulator_dev *rdev[ACT8865_REG_NUM];
	struct regmap *regmap;
};

static const struct regmap_config act8865_regmap_config = {
	.reg_bits = 8,
	.val_bits = 8,
};

static const struct regulator_linear_range act8865_volatge_ranges[] = {
	REGULATOR_LINEAR_RANGE(600000, 0, 23, 25000),
	REGULATOR_LINEAR_RANGE(1200000, 24, 47, 50000),
	REGULATOR_LINEAR_RANGE(2400000, 48, 63, 100000),
};

static struct regulator_ops act8865_ops = {
	.list_voltage		= regulator_list_voltage_linear_range,
	.map_voltage		= regulator_map_voltage_linear_range,
	.get_voltage_sel	= regulator_get_voltage_sel_regmap,
	.set_voltage_sel	= regulator_set_voltage_sel_regmap,
	.enable			= regulator_enable_regmap,
	.disable		= regulator_disable_regmap,
	.is_enabled		= regulator_is_enabled_regmap,
};

static const struct regulator_desc act8865_reg[] = {
	{
		.name = "DCDC_REG1",
		.id = ACT8865_ID_DCDC1,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_DCDC1_VSET1,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_DCDC1_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
	{
		.name = "DCDC_REG2",
		.id = ACT8865_ID_DCDC2,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_DCDC2_VSET1,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_DCDC2_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
	{
		.name = "DCDC_REG3",
		.id = ACT8865_ID_DCDC3,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_DCDC3_VSET1,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_DCDC3_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO_REG1",
		.id = ACT8865_ID_LDO1,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_LDO1_VSET,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_LDO1_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO_REG2",
		.id = ACT8865_ID_LDO2,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_LDO2_VSET,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_LDO2_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO_REG3",
		.id = ACT8865_ID_LDO3,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_LDO3_VSET,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_LDO3_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO_REG4",
		.id = ACT8865_ID_LDO4,
		.ops = &act8865_ops,
		.type = REGULATOR_VOLTAGE,
		.n_voltages = ACT8865_VOLTAGE_NUM,
		.linear_ranges = act8865_volatge_ranges,
		.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
		.vsel_reg = ACT8865_LDO4_VSET,
		.vsel_mask = ACT8865_VSEL_MASK,
		.enable_reg = ACT8865_LDO4_CTRL,
		.enable_mask = ACT8865_ENA,
		.owner = THIS_MODULE,
	},
};

#ifdef CONFIG_OF
static const struct of_device_id act8865_dt_ids[] = {
	{ .compatible = "active-semi,act8865" },
	{ }
};
MODULE_DEVICE_TABLE(of, act8865_dt_ids);

static struct of_regulator_match act8865_matches[] = {
	[ACT8865_ID_DCDC1]	= { .name = "DCDC_REG1"},
	[ACT8865_ID_DCDC2]	= { .name = "DCDC_REG2"},
	[ACT8865_ID_DCDC3]	= { .name = "DCDC_REG3"},
	[ACT8865_ID_LDO1]	= { .name = "LDO_REG1"},
	[ACT8865_ID_LDO2]	= { .name = "LDO_REG2"},
	[ACT8865_ID_LDO3]	= { .name = "LDO_REG3"},
	[ACT8865_ID_LDO4]	= { .name = "LDO_REG4"},
};

static int act8865_pdata_from_dt(struct device *dev,
				 struct device_node **of_node,
				 struct act8865_platform_data *pdata)
{
	int matched, i;
	struct device_node *np;
	struct act8865_regulator_data *regulator;

	np = of_get_child_by_name(dev->of_node, "regulators");
	if (!np) {
		dev_err(dev, "missing 'regulators' subnode in DT\n");
		return -EINVAL;
	}

	matched = of_regulator_match(dev, np,
				act8865_matches, ARRAY_SIZE(act8865_matches));
	of_node_put(np);
	if (matched <= 0)
		return matched;

	pdata->regulators = devm_kzalloc(dev,
				sizeof(struct act8865_regulator_data) *
				ARRAY_SIZE(act8865_matches), GFP_KERNEL);
	if (!pdata->regulators) {
		dev_err(dev, "%s: failed to allocate act8865 registor\n",
						__func__);
		return -ENOMEM;
	}

	pdata->num_regulators = matched;
	regulator = pdata->regulators;

	for (i = 0; i < ARRAY_SIZE(act8865_matches); i++) {
		regulator->id = i;
		regulator->name = act8865_matches[i].name;
		regulator->platform_data = act8865_matches[i].init_data;
		of_node[i] = act8865_matches[i].of_node;
		regulator++;
	}

	return 0;
}
#else
static inline int act8865_pdata_from_dt(struct device *dev,
					struct device_node **of_node,
					struct act8865_platform_data *pdata)
{
	return 0;
}
#endif

static int act8865_pmic_probe(struct i2c_client *client,
			   const struct i2c_device_id *i2c_id)
{
	struct regulator_dev **rdev;
	struct device *dev = &client->dev;
	struct act8865_platform_data *pdata = dev_get_platdata(dev);
	struct regulator_config config = { };
	struct act8865 *act8865;
	struct device_node *of_node[ACT8865_REG_NUM];
	int i, id;
	int ret = -EINVAL;
	int error;

	if (dev->of_node && !pdata) {
		const struct of_device_id *id;
		struct act8865_platform_data pdata_of;

		id = of_match_device(of_match_ptr(act8865_dt_ids), dev);
		if (!id)
			return -ENODEV;

		ret = act8865_pdata_from_dt(dev, of_node, &pdata_of);
		if (ret < 0)
			return ret;

		pdata = &pdata_of;
	}

	if (pdata->num_regulators > ACT8865_REG_NUM) {
		dev_err(dev, "Too many regulators found!\n");
		return -EINVAL;
	}

	act8865 = devm_kzalloc(dev, sizeof(struct act8865), GFP_KERNEL);
	if (!act8865)
		return -ENOMEM;

	rdev = act8865->rdev;

	act8865->regmap = devm_regmap_init_i2c(client, &act8865_regmap_config);
	if (IS_ERR(act8865->regmap)) {
		error = PTR_ERR(act8865->regmap);
		dev_err(&client->dev, "Failed to allocate register map: %d\n",
			error);
		return error;
	}

	/* Finally register devices */
	for (i = 0; i < ACT8865_REG_NUM; i++) {

		id = pdata->regulators[i].id;

		config.dev = dev;
		config.init_data = pdata->regulators[i].platform_data;
		config.of_node = of_node[i];
		config.driver_data = act8865;
		config.regmap = act8865->regmap;

		rdev[i] = devm_regulator_register(&client->dev,
						&act8865_reg[i], &config);
		if (IS_ERR(rdev[i])) {
			dev_err(dev, "failed to register %s\n",
				act8865_reg[id].name);
			return PTR_ERR(rdev[i]);
		}
	}

	i2c_set_clientdata(client, act8865);

	return 0;
}

static const struct i2c_device_id act8865_ids[] = {
	{ "act8865", 0 },
	{ },
};
MODULE_DEVICE_TABLE(i2c, act8865_ids);

static struct i2c_driver act8865_pmic_driver = {
	.driver	= {
		.name	= "act8865",
		.owner	= THIS_MODULE,
	},
	.probe		= act8865_pmic_probe,
	.id_table	= act8865_ids,
};

module_i2c_driver(act8865_pmic_driver);

MODULE_DESCRIPTION("active-semi act8865 voltage regulator driver");
MODULE_AUTHOR("Wenyou Yang <wenyou.yang@atmel.com>");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
33036f48 WY	1	/*
	2	* act8865-regulator.c - Voltage regulation for the active-semi ACT8865
	3	* http://www.active-semi.com/sheets/ACT8865_Datasheet.pdf
	4	*
	5	* Copyright (C) 2013 Atmel Corporation
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* (at your option) any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*/
	17
	18	#include <linux/module.h>
	19	#include <linux/init.h>
	20	#include <linux/i2c.h>
	21	#include <linux/err.h>
	22	#include <linux/platform_device.h>
	23	#include <linux/regulator/driver.h>
	24	#include <linux/regulator/act8865.h>
	25	#include <linux/of.h>
	26	#include <linux/of_device.h>
	27	#include <linux/regulator/of_regulator.h>
	28	#include <linux/regmap.h>
	29
	30	/*
	31	* ACT8865 Global Register Map.
	32	*/
	33	#define ACT8865_SYS_MODE 0x00
	34	#define ACT8865_SYS_CTRL 0x01
	35	#define ACT8865_DCDC1_VSET1 0x20
	36	#define ACT8865_DCDC1_VSET2 0x21
	37	#define ACT8865_DCDC1_CTRL 0x22
	38	#define ACT8865_DCDC2_VSET1 0x30
	39	#define ACT8865_DCDC2_VSET2 0x31
	40	#define ACT8865_DCDC2_CTRL 0x32
	41	#define ACT8865_DCDC3_VSET1 0x40
	42	#define ACT8865_DCDC3_VSET2 0x41
	43	#define ACT8865_DCDC3_CTRL 0x42
	44	#define ACT8865_LDO1_VSET 0x50
	45	#define ACT8865_LDO1_CTRL 0x51
	46	#define ACT8865_LDO2_VSET 0x54
	47	#define ACT8865_LDO2_CTRL 0x55
	48	#define ACT8865_LDO3_VSET 0x60
	49	#define ACT8865_LDO3_CTRL 0x61
	50	#define ACT8865_LDO4_VSET 0x64
	51	#define ACT8865_LDO4_CTRL 0x65
	52
	53	/*
	54	* Field Definitions.
	55	*/
	56	#define ACT8865_ENA 0x80 /* ON - [7] */
	57	#define ACT8865_VSEL_MASK 0x3F /* VSET - [5:0] */
	58
	59	/*
	60	* ACT8865 voltage number
	61	*/
	62	#define ACT8865_VOLTAGE_NUM 64
	63
	64	struct act8865 {
65	struct regulator_dev *rdev[ACT8865_REG_NUM];
66	struct regmap *regmap;
67	};
68
69	static const struct regmap_config act8865_regmap_config = {
70	.reg_bits = 8,
71	.val_bits = 8,
72	};
73
74	static const struct regulator_linear_range act8865_volatge_ranges[] = {
75	REGULATOR_LINEAR_RANGE(600000, 0, 23, 25000),
76	REGULATOR_LINEAR_RANGE(1200000, 24, 47, 50000),
77	REGULATOR_LINEAR_RANGE(2400000, 48, 63, 100000),
78	};
79
80	static struct regulator_ops act8865_ops = {
81	.list_voltage = regulator_list_voltage_linear_range,
82	.map_voltage = regulator_map_voltage_linear_range,
83	.get_voltage_sel = regulator_get_voltage_sel_regmap,
84	.set_voltage_sel = regulator_set_voltage_sel_regmap,
85	.enable = regulator_enable_regmap,
86	.disable = regulator_disable_regmap,
87	.is_enabled = regulator_is_enabled_regmap,
33036f48 WY	88	};
	89
	90	static const struct regulator_desc act8865_reg[] = {
	91	{
	92	.name = "DCDC_REG1",
	93	.id = ACT8865_ID_DCDC1,
	94	.ops = &act8865_ops,
	95	.type = REGULATOR_VOLTAGE,
	96	.n_voltages = ACT8865_VOLTAGE_NUM,
	97	.linear_ranges = act8865_volatge_ranges,
	98	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
	99	.vsel_reg = ACT8865_DCDC1_VSET1,
	100	.vsel_mask = ACT8865_VSEL_MASK,
	101	.enable_reg = ACT8865_DCDC1_CTRL,
	102	.enable_mask = ACT8865_ENA,
	103	.owner = THIS_MODULE,
	104	},
	105	{
	106	.name = "DCDC_REG2",
	107	.id = ACT8865_ID_DCDC2,
	108	.ops = &act8865_ops,
	109	.type = REGULATOR_VOLTAGE,
	110	.n_voltages = ACT8865_VOLTAGE_NUM,
	111	.linear_ranges = act8865_volatge_ranges,
	112	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
	113	.vsel_reg = ACT8865_DCDC2_VSET1,
	114	.vsel_mask = ACT8865_VSEL_MASK,
	115	.enable_reg = ACT8865_DCDC2_CTRL,
	116	.enable_mask = ACT8865_ENA,
	117	.owner = THIS_MODULE,
	118	},
	119	{
	120	.name = "DCDC_REG3",
	121	.id = ACT8865_ID_DCDC3,
	122	.ops = &act8865_ops,
	123	.type = REGULATOR_VOLTAGE,
	124	.n_voltages = ACT8865_VOLTAGE_NUM,
	125	.linear_ranges = act8865_volatge_ranges,
	126	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
	127	.vsel_reg = ACT8865_DCDC3_VSET1,
	128	.vsel_mask = ACT8865_VSEL_MASK,
	129	.enable_reg = ACT8865_DCDC3_CTRL,
	130	.enable_mask = ACT8865_ENA,
	131	.owner = THIS_MODULE,
	132	},
	133	{
	134	.name = "LDO_REG1",
	135	.id = ACT8865_ID_LDO1,
	136	.ops = &act8865_ops,
	137	.type = REGULATOR_VOLTAGE,
	138	.n_voltages = ACT8865_VOLTAGE_NUM,
	139	.linear_ranges = act8865_volatge_ranges,
	140	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
	141	.vsel_reg = ACT8865_LDO1_VSET,
	142	.vsel_mask = ACT8865_VSEL_MASK,
	143	.enable_reg = ACT8865_LDO1_CTRL,
	144	.enable_mask = ACT8865_ENA,
	145	.owner = THIS_MODULE,
	146	},
	147	{
	148	.name = "LDO_REG2",
	149	.id = ACT8865_ID_LDO2,
	150	.ops = &act8865_ops,
	151	.type = REGULATOR_VOLTAGE,
152	.n_voltages = ACT8865_VOLTAGE_NUM,
153	.linear_ranges = act8865_volatge_ranges,
154	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
155	.vsel_reg = ACT8865_LDO2_VSET,
156	.vsel_mask = ACT8865_VSEL_MASK,
157	.enable_reg = ACT8865_LDO2_CTRL,
158	.enable_mask = ACT8865_ENA,
159	.owner = THIS_MODULE,
160	},
161	{
162	.name = "LDO_REG3",
163	.id = ACT8865_ID_LDO3,
164	.ops = &act8865_ops,
165	.type = REGULATOR_VOLTAGE,
166	.n_voltages = ACT8865_VOLTAGE_NUM,
167	.linear_ranges = act8865_volatge_ranges,
168	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
169	.vsel_reg = ACT8865_LDO3_VSET,
170	.vsel_mask = ACT8865_VSEL_MASK,
171	.enable_reg = ACT8865_LDO3_CTRL,
172	.enable_mask = ACT8865_ENA,
173	.owner = THIS_MODULE,
174	},
175	{
176	.name = "LDO_REG4",
177	.id = ACT8865_ID_LDO4,
178	.ops = &act8865_ops,
179	.type = REGULATOR_VOLTAGE,
180	.n_voltages = ACT8865_VOLTAGE_NUM,
181	.linear_ranges = act8865_volatge_ranges,
182	.n_linear_ranges = ARRAY_SIZE(act8865_volatge_ranges),
183	.vsel_reg = ACT8865_LDO4_VSET,
184	.vsel_mask = ACT8865_VSEL_MASK,
185	.enable_reg = ACT8865_LDO4_CTRL,
186	.enable_mask = ACT8865_ENA,
187	.owner = THIS_MODULE,
188	},
189	};
190
191	#ifdef CONFIG_OF
192	static const struct of_device_id act8865_dt_ids[] = {
193	{ .compatible = "active-semi,act8865" },
194	{ }
195	};
196	MODULE_DEVICE_TABLE(of, act8865_dt_ids);
197
198	static struct of_regulator_match act8865_matches[] = {
199	[ACT8865_ID_DCDC1] = { .name = "DCDC_REG1"},
200	[ACT8865_ID_DCDC2] = { .name = "DCDC_REG2"},
201	[ACT8865_ID_DCDC3] = { .name = "DCDC_REG3"},
202	[ACT8865_ID_LDO1] = { .name = "LDO_REG1"},
203	[ACT8865_ID_LDO2] = { .name = "LDO_REG2"},
204	[ACT8865_ID_LDO3] = { .name = "LDO_REG3"},
205	[ACT8865_ID_LDO4] = { .name = "LDO_REG4"},
206	};
207
208	static int act8865_pdata_from_dt(struct device *dev,
209	struct device_node **of_node,
210	struct act8865_platform_data *pdata)
211	{
212	int matched, i;
213	struct device_node *np;
214	struct act8865_regulator_data *regulator;
215
6ea970a9	216	np = of_get_child_by_name(dev->of_node, "regulators");
33036f48 WY	217	if (!np) {
	218	dev_err(dev, "missing 'regulators' subnode in DT\n");
	219	return -EINVAL;
	220	}
	221
	222	matched = of_regulator_match(dev, np,
	223	act8865_matches, ARRAY_SIZE(act8865_matches));
0079eb53	224	of_node_put(np);
33036f48 WY	225	if (matched <= 0)
	226	return matched;
	227
	228	pdata->regulators = devm_kzalloc(dev,
d04b7552 WY	229	sizeof(struct act8865_regulator_data) *
d04b7552 WY	230	ARRAY_SIZE(act8865_matches), GFP_KERNEL);
33036f48 WY	231	if (!pdata->regulators) {
	232	dev_err(dev, "%s: failed to allocate act8865 registor\n",
	233	__func__);
	234	return -ENOMEM;
	235	}
	236
	237	pdata->num_regulators = matched;
	238	regulator = pdata->regulators;
	239
d04b7552	240	for (i = 0; i < ARRAY_SIZE(act8865_matches); i++) {
33036f48 WY	241	regulator->id = i;
	242	regulator->name = act8865_matches[i].name;
	243	regulator->platform_data = act8865_matches[i].init_data;
	244	of_node[i] = act8865_matches[i].of_node;
	245	regulator++;
	246	}
	247
	248	return 0;
	249	}
	250	#else
	251	static inline int act8865_pdata_from_dt(struct device *dev,
	252	struct device_node **of_node,
	253	struct act8865_platform_data *pdata)
	254	{
	255	return 0;
	256	}
	257	#endif
	258
	259	static int act8865_pmic_probe(struct i2c_client *client,
	260	const struct i2c_device_id *i2c_id)
	261	{
	262	struct regulator_dev **rdev;
	263	struct device *dev = &client->dev;
	264	struct act8865_platform_data *pdata = dev_get_platdata(dev);
	265	struct regulator_config config = { };
	266	struct act8865 *act8865;
	267	struct device_node *of_node[ACT8865_REG_NUM];
	268	int i, id;
	269	int ret = -EINVAL;
	270	int error;
	271
	272	if (dev->of_node && !pdata) {
	273	const struct of_device_id *id;
	274	struct act8865_platform_data pdata_of;
	275
	276	id = of_match_device(of_match_ptr(act8865_dt_ids), dev);
	277	if (!id)
	278	return -ENODEV;
	279
	280	ret = act8865_pdata_from_dt(dev, of_node, &pdata_of);
	281	if (ret < 0)
	282	return ret;
	283
	284	pdata = &pdata_of;
	285	}
	286
	287	if (pdata->num_regulators > ACT8865_REG_NUM) {
	288	dev_err(dev, "Too many regulators found!\n");
	289	return -EINVAL;
	290	}
	291
f1de2c2f	292	act8865 = devm_kzalloc(dev, sizeof(struct act8865), GFP_KERNEL);
33036f48 WY	293	if (!act8865)
	294	return -ENOMEM;
	295
	296	rdev = act8865->rdev;
	297
	298	act8865->regmap = devm_regmap_init_i2c(client, &act8865_regmap_config);
	299	if (IS_ERR(act8865->regmap)) {
	300	error = PTR_ERR(act8865->regmap);
	301	dev_err(&client->dev, "Failed to allocate register map: %d\n",
	302	error);
	303	return error;
	304	}
	305
	306	/* Finally register devices */
a8659ba4	307	for (i = 0; i < ACT8865_REG_NUM; i++) {
33036f48 WY	308
	309	id = pdata->regulators[i].id;
	310
	311	config.dev = dev;
	312	config.init_data = pdata->regulators[i].platform_data;
	313	config.of_node = of_node[i];
	314	config.driver_data = act8865;
	315	config.regmap = act8865->regmap;
	316
	317	rdev[i] = devm_regulator_register(&client->dev,
	318	&act8865_reg[i], &config);
	319	if (IS_ERR(rdev[i])) {
	320	dev_err(dev, "failed to register %s\n",
	321	act8865_reg[id].name);
	322	return PTR_ERR(rdev[i]);
	323	}
	324	}
	325
	326	i2c_set_clientdata(client, act8865);
	327
	328	return 0;
	329	}
	330
33036f48 WY	331	static const struct i2c_device_id act8865_ids[] = {
	332	{ "act8865", 0 },
	333	{ },
	334	};
	335	MODULE_DEVICE_TABLE(i2c, act8865_ids);
	336
	337	static struct i2c_driver act8865_pmic_driver = {
	338	.driver = {
	339	.name = "act8865",
	340	.owner = THIS_MODULE,
	341	},
	342	.probe = act8865_pmic_probe,
33036f48 WY	343	.id_table = act8865_ids,
	344	};
	345
	346	module_i2c_driver(act8865_pmic_driver);
	347
	348	MODULE_DESCRIPTION("active-semi act8865 voltage regulator driver");
	349	MODULE_AUTHOR("Wenyou Yang <wenyou.yang@atmel.com>");
	350	MODULE_LICENSE("GPL v2");