[mirror_ubuntu-hirsute-kernel.git] / drivers / regulator / mp886x.c

// SPDX-License-Identifier: GPL-2.0
//
// MP8867/MP8869 regulator driver
//
// Copyright (C) 2020 Synaptics Incorporated
//
// Author: Jisheng Zhang <jszhang@kernel.org>

#include <linux/gpio/consumer.h>
#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/regmap.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/of_regulator.h>

#define MP886X_VSEL		0x00
#define  MP886X_V_BOOT		(1 << 7)
#define MP886X_SYSCNTLREG1	0x01
#define  MP886X_MODE		(1 << 0)
#define  MP886X_SLEW_SHIFT	3
#define  MP886X_SLEW_MASK	(0x7 << MP886X_SLEW_SHIFT)
#define  MP886X_GO		(1 << 6)
#define  MP886X_EN		(1 << 7)
#define MP8869_SYSCNTLREG2	0x02

struct mp886x_cfg_info {
	const struct regulator_ops *rops;
	const int slew_rates[8];
	const int switch_freq[4];
	const u8 fs_reg;
	const u8 fs_shift;
};

struct mp886x_device_info {
	struct device *dev;
	struct regulator_desc desc;
	struct regulator_init_data *regulator;
	struct gpio_desc *en_gpio;
	const struct mp886x_cfg_info *ci;
	u32 r[2];
	unsigned int sel;
};

static int mp886x_set_ramp(struct regulator_dev *rdev, int ramp)
{
	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	const struct mp886x_cfg_info *ci = di->ci;
	int reg = -1, i;

	for (i = 0; i < ARRAY_SIZE(ci->slew_rates); i++) {
		if (ramp <= ci->slew_rates[i])
			reg = i;
		else
			break;
	}

	if (reg < 0) {
		dev_err(di->dev, "unsupported ramp value %d\n", ramp);
		return -EINVAL;
	}

	return regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
				  MP886X_SLEW_MASK, reg << MP886X_SLEW_SHIFT);
}

static void mp886x_set_switch_freq(struct mp886x_device_info *di,
				   struct regmap *regmap,
				   u32 freq)
{
	const struct mp886x_cfg_info *ci = di->ci;
	int i;

	for (i = 0; i < ARRAY_SIZE(ci->switch_freq); i++) {
		if (freq == ci->switch_freq[i]) {
			regmap_update_bits(regmap, ci->fs_reg,
				  0x3 << ci->fs_shift, i << ci->fs_shift);
			return;
		}
	}

	dev_err(di->dev, "invalid frequency %d\n", freq);
}

static int mp886x_set_mode(struct regulator_dev *rdev, unsigned int mode)
{
	switch (mode) {
	case REGULATOR_MODE_FAST:
		regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
				   MP886X_MODE, MP886X_MODE);
		break;
	case REGULATOR_MODE_NORMAL:
		regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
				   MP886X_MODE, 0);
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

static unsigned int mp886x_get_mode(struct regulator_dev *rdev)
{
	u32 val;
	int ret;

	ret = regmap_read(rdev->regmap, MP886X_SYSCNTLREG1, &val);
	if (ret < 0)
		return ret;
	if (val & MP886X_MODE)
		return REGULATOR_MODE_FAST;
	else
		return REGULATOR_MODE_NORMAL;
}

static int mp8869_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
{
	int ret;

	ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
				 MP886X_GO, MP886X_GO);
	if (ret < 0)
		return ret;

	sel <<= ffs(rdev->desc->vsel_mask) - 1;
	return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
				  MP886X_V_BOOT | rdev->desc->vsel_mask, sel);
}

static inline unsigned int mp8869_scale(unsigned int uv, u32 r1, u32 r2)
{
	u32 tmp = uv * r1 / r2;

	return uv + tmp;
}

static int mp8869_get_voltage_sel(struct regulator_dev *rdev)
{
	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	int ret, uv;
	unsigned int val;
	bool fbloop;

	ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
	if (ret)
		return ret;

	fbloop = val & MP886X_V_BOOT;
	if (fbloop) {
		uv = rdev->desc->min_uV;
		uv = mp8869_scale(uv, di->r[0], di->r[1]);
		return regulator_map_voltage_linear(rdev, uv, uv);
	}

	val &= rdev->desc->vsel_mask;
	val >>= ffs(rdev->desc->vsel_mask) - 1;

	return val;
}

static const struct regulator_ops mp8869_regulator_ops = {
	.set_voltage_sel = mp8869_set_voltage_sel,
	.get_voltage_sel = mp8869_get_voltage_sel,
	.set_voltage_time_sel = regulator_set_voltage_time_sel,
	.map_voltage = regulator_map_voltage_linear,
	.list_voltage = regulator_list_voltage_linear,
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
	.is_enabled = regulator_is_enabled_regmap,
	.set_mode = mp886x_set_mode,
	.get_mode = mp886x_get_mode,
	.set_ramp_delay = mp886x_set_ramp,
};

static const struct mp886x_cfg_info mp8869_ci = {
	.rops = &mp8869_regulator_ops,
	.slew_rates = {
		40000,
		30000,
		20000,
		10000,
		5000,
		2500,
		1250,
		625,
	},
	.switch_freq = {
		500000,
		750000,
		1000000,
		1250000,
	},
	.fs_reg = MP8869_SYSCNTLREG2,
	.fs_shift = 4,
};

static int mp8867_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
{
	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	int ret, delta;

	ret = mp8869_set_voltage_sel(rdev, sel);
	if (ret < 0)
		return ret;

	delta = di->sel - sel;
	if (abs(delta) <= 5)
		ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
					 MP886X_GO, 0);
	di->sel = sel;

	return ret;
}

static int mp8867_get_voltage_sel(struct regulator_dev *rdev)
{
	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	int ret, uv;
	unsigned int val;
	bool fbloop;

	ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
	if (ret)
		return ret;

	fbloop = val & MP886X_V_BOOT;

	val &= rdev->desc->vsel_mask;
	val >>= ffs(rdev->desc->vsel_mask) - 1;

	if (fbloop) {
		uv = regulator_list_voltage_linear(rdev, val);
		uv = mp8869_scale(uv, di->r[0], di->r[1]);
		return regulator_map_voltage_linear(rdev, uv, uv);
	}

	return val;
}

static const struct regulator_ops mp8867_regulator_ops = {
	.set_voltage_sel = mp8867_set_voltage_sel,
	.get_voltage_sel = mp8867_get_voltage_sel,
	.set_voltage_time_sel = regulator_set_voltage_time_sel,
	.map_voltage = regulator_map_voltage_linear,
	.list_voltage = regulator_list_voltage_linear,
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
	.is_enabled = regulator_is_enabled_regmap,
	.set_mode = mp886x_set_mode,
	.get_mode = mp886x_get_mode,
	.set_ramp_delay = mp886x_set_ramp,
};

static const struct mp886x_cfg_info mp8867_ci = {
	.rops = &mp8867_regulator_ops,
	.slew_rates = {
		64000,
		32000,
		16000,
		8000,
		4000,
		2000,
		1000,
		500,
	},
	.switch_freq = {
		500000,
		750000,
		1000000,
		1500000,
	},
	.fs_reg = MP886X_SYSCNTLREG1,
	.fs_shift = 1,
};

static int mp886x_regulator_register(struct mp886x_device_info *di,
				     struct regulator_config *config)
{
	struct regulator_desc *rdesc = &di->desc;
	struct regulator_dev *rdev;

	rdesc->name = "mp886x-reg";
	rdesc->supply_name = "vin";
	rdesc->ops = di->ci->rops;
	rdesc->type = REGULATOR_VOLTAGE;
	rdesc->n_voltages = 128;
	rdesc->enable_reg = MP886X_SYSCNTLREG1;
	rdesc->enable_mask = MP886X_EN;
	rdesc->min_uV = 600000;
	rdesc->uV_step = 10000;
	rdesc->vsel_reg = MP886X_VSEL;
	rdesc->vsel_mask = 0x3f;
	rdesc->owner = THIS_MODULE;

	rdev = devm_regulator_register(di->dev, &di->desc, config);
	if (IS_ERR(rdev))
		return PTR_ERR(rdev);
	di->sel = rdesc->ops->get_voltage_sel(rdev);
	return 0;
}

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

static int mp886x_i2c_probe(struct i2c_client *client)
{
	struct device *dev = &client->dev;
	struct device_node *np = dev->of_node;
	struct mp886x_device_info *di;
	struct regulator_config config = { };
	struct regmap *regmap;
	u32 freq;
	int ret;

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

	di->regulator = of_get_regulator_init_data(dev, np, &di->desc);
	if (!di->regulator) {
		dev_err(dev, "Platform data not found!\n");
		return -EINVAL;
	}

	ret = of_property_read_u32_array(np, "mps,fb-voltage-divider",
					 di->r, 2);
	if (ret)
		return ret;

	di->en_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH);
	if (IS_ERR(di->en_gpio))
		return PTR_ERR(di->en_gpio);

	di->ci = of_device_get_match_data(dev);
	di->dev = dev;

	regmap = devm_regmap_init_i2c(client, &mp886x_regmap_config);
	if (IS_ERR(regmap)) {
		dev_err(dev, "Failed to allocate regmap!\n");
		return PTR_ERR(regmap);
	}
	i2c_set_clientdata(client, di);

	config.dev = di->dev;
	config.init_data = di->regulator;
	config.regmap = regmap;
	config.driver_data = di;
	config.of_node = np;

	if (!of_property_read_u32(np, "mps,switch-frequency-hz", &freq))
		mp886x_set_switch_freq(di, regmap, freq);

	ret = mp886x_regulator_register(di, &config);
	if (ret < 0)
		dev_err(dev, "Failed to register regulator!\n");
	return ret;
}

static const struct of_device_id mp886x_dt_ids[] = {
	{
		.compatible = "mps,mp8867",
		.data = &mp8867_ci
	},
	{
		.compatible = "mps,mp8869",
		.data = &mp8869_ci
	},
	{ }
};
MODULE_DEVICE_TABLE(of, mp886x_dt_ids);

static const struct i2c_device_id mp886x_id[] = {
	{ "mp886x", },
	{ },
};
MODULE_DEVICE_TABLE(i2c, mp886x_id);

static struct i2c_driver mp886x_regulator_driver = {
	.driver = {
		.name = "mp886x-regulator",
		.of_match_table = of_match_ptr(mp886x_dt_ids),
	},
	.probe_new = mp886x_i2c_probe,
	.id_table = mp886x_id,
};
module_i2c_driver(mp886x_regulator_driver);

MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>");
MODULE_DESCRIPTION("MP886x regulator driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
97be8288 JZ	1	// SPDX-License-Identifier: GPL-2.0
97be8288 JZ	2	//
751ca3aa	3	// MP8867/MP8869 regulator driver
97be8288 JZ	4	//
	5	// Copyright (C) 2020 Synaptics Incorporated
	6	//
	7	// Author: Jisheng Zhang <jszhang@kernel.org>
	8
	9	#include <linux/gpio/consumer.h>
	10	#include <linux/i2c.h>
	11	#include <linux/module.h>
	12	#include <linux/of_device.h>
	13	#include <linux/regmap.h>
	14	#include <linux/regulator/driver.h>
	15	#include <linux/regulator/of_regulator.h>
	16
	17	#define MP886X_VSEL 0x00
	18	#define MP886X_V_BOOT (1 << 7)
	19	#define MP886X_SYSCNTLREG1 0x01
	20	#define MP886X_MODE (1 << 0)
0eddcf02 JZ	21	#define MP886X_SLEW_SHIFT 3
0eddcf02 JZ	22	#define MP886X_SLEW_MASK (0x7 << MP886X_SLEW_SHIFT)
97be8288 JZ	23	#define MP886X_GO (1 << 6)
97be8288 JZ	24	#define MP886X_EN (1 << 7)
ee6ad5a2	25	#define MP8869_SYSCNTLREG2 0x02
97be8288	26
0eddcf02 JZ	27	struct mp886x_cfg_info {
	28	const struct regulator_ops *rops;
	29	const int slew_rates[8];
ee6ad5a2 JZ	30	const int switch_freq[4];
	31	const u8 fs_reg;
	32	const u8 fs_shift;
0eddcf02 JZ	33	};
0eddcf02 JZ	34
97be8288 JZ	35	struct mp886x_device_info {
	36	struct device *dev;
	37	struct regulator_desc desc;
	38	struct regulator_init_data *regulator;
	39	struct gpio_desc *en_gpio;
0eddcf02	40	const struct mp886x_cfg_info *ci;
97be8288 JZ	41	u32 r[2];
	42	unsigned int sel;
	43	};
	44
0eddcf02 JZ	45	static int mp886x_set_ramp(struct regulator_dev *rdev, int ramp)
	46	{
	47	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	48	const struct mp886x_cfg_info *ci = di->ci;
	49	int reg = -1, i;
	50
	51	for (i = 0; i < ARRAY_SIZE(ci->slew_rates); i++) {
	52	if (ramp <= ci->slew_rates[i])
	53	reg = i;
	54	else
	55	break;
	56	}
	57
	58	if (reg < 0) {
	59	dev_err(di->dev, "unsupported ramp value %d\n", ramp);
	60	return -EINVAL;
	61	}
	62
	63	return regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
	64	MP886X_SLEW_MASK, reg << MP886X_SLEW_SHIFT);
	65	}
	66
ee6ad5a2 JZ	67	static void mp886x_set_switch_freq(struct mp886x_device_info *di,
	68	struct regmap *regmap,
	69	u32 freq)
	70	{
	71	const struct mp886x_cfg_info *ci = di->ci;
	72	int i;
	73
	74	for (i = 0; i < ARRAY_SIZE(ci->switch_freq); i++) {
	75	if (freq == ci->switch_freq[i]) {
	76	regmap_update_bits(regmap, ci->fs_reg,
	77	0x3 << ci->fs_shift, i << ci->fs_shift);
	78	return;
	79	}
	80	}
	81
	82	dev_err(di->dev, "invalid frequency %d\n", freq);
	83	}
	84
97be8288 JZ	85	static int mp886x_set_mode(struct regulator_dev *rdev, unsigned int mode)
	86	{
	87	switch (mode) {
	88	case REGULATOR_MODE_FAST:
	89	regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
	90	MP886X_MODE, MP886X_MODE);
	91	break;
	92	case REGULATOR_MODE_NORMAL:
	93	regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
	94	MP886X_MODE, 0);
	95	break;
	96	default:
	97	return -EINVAL;
	98	}
	99	return 0;
	100	}
	101
	102	static unsigned int mp886x_get_mode(struct regulator_dev *rdev)
	103	{
	104	u32 val;
	105	int ret;
	106
	107	ret = regmap_read(rdev->regmap, MP886X_SYSCNTLREG1, &val);
	108	if (ret < 0)
	109	return ret;
	110	if (val & MP886X_MODE)
	111	return REGULATOR_MODE_FAST;
	112	else
	113	return REGULATOR_MODE_NORMAL;
	114	}
	115
	116	static int mp8869_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
	117	{
	118	int ret;
	119
	120	ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
	121	MP886X_GO, MP886X_GO);
	122	if (ret < 0)
	123	return ret;
	124
	125	sel <<= ffs(rdev->desc->vsel_mask) - 1;
	126	return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg,
	127	MP886X_V_BOOT \| rdev->desc->vsel_mask, sel);
	128	}
	129
	130	static inline unsigned int mp8869_scale(unsigned int uv, u32 r1, u32 r2)
	131	{
	132	u32 tmp = uv * r1 / r2;
	133
	134	return uv + tmp;
	135	}
	136
	137	static int mp8869_get_voltage_sel(struct regulator_dev *rdev)
	138	{
	139	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	140	int ret, uv;
	141	unsigned int val;
	142	bool fbloop;
	143
	144	ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
	145	if (ret)
	146	return ret;
	147
	148	fbloop = val & MP886X_V_BOOT;
149	if (fbloop) {
150	uv = rdev->desc->min_uV;
151	uv = mp8869_scale(uv, di->r[0], di->r[1]);
152	return regulator_map_voltage_linear(rdev, uv, uv);
153	}
154
155	val &= rdev->desc->vsel_mask;
156	val >>= ffs(rdev->desc->vsel_mask) - 1;
157
158	return val;
159	}
160
161	static const struct regulator_ops mp8869_regulator_ops = {
162	.set_voltage_sel = mp8869_set_voltage_sel,
163	.get_voltage_sel = mp8869_get_voltage_sel,
164	.set_voltage_time_sel = regulator_set_voltage_time_sel,
165	.map_voltage = regulator_map_voltage_linear,
166	.list_voltage = regulator_list_voltage_linear,
167	.enable = regulator_enable_regmap,
168	.disable = regulator_disable_regmap,
169	.is_enabled = regulator_is_enabled_regmap,
170	.set_mode = mp886x_set_mode,
171	.get_mode = mp886x_get_mode,
0eddcf02 JZ	172	.set_ramp_delay = mp886x_set_ramp,
	173	};
	174
	175	static const struct mp886x_cfg_info mp8869_ci = {
	176	.rops = &mp8869_regulator_ops,
	177	.slew_rates = {
	178	40000,
	179	30000,
	180	20000,
	181	10000,
	182	5000,
	183	2500,
	184	1250,
	185	625,
	186	},
ee6ad5a2 JZ	187	.switch_freq = {
	188	500000,
	189	750000,
	190	1000000,
	191	1250000,
	192	},
	193	.fs_reg = MP8869_SYSCNTLREG2,
	194	.fs_shift = 4,
97be8288 JZ	195	};
97be8288 JZ	196
751ca3aa JZ	197	static int mp8867_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
	198	{
	199	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	200	int ret, delta;
	201
	202	ret = mp8869_set_voltage_sel(rdev, sel);
	203	if (ret < 0)
	204	return ret;
	205
	206	delta = di->sel - sel;
	207	if (abs(delta) <= 5)
	208	ret = regmap_update_bits(rdev->regmap, MP886X_SYSCNTLREG1,
	209	MP886X_GO, 0);
	210	di->sel = sel;
	211
	212	return ret;
	213	}
	214
	215	static int mp8867_get_voltage_sel(struct regulator_dev *rdev)
	216	{
	217	struct mp886x_device_info *di = rdev_get_drvdata(rdev);
	218	int ret, uv;
	219	unsigned int val;
	220	bool fbloop;
	221
	222	ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
	223	if (ret)
	224	return ret;
	225
	226	fbloop = val & MP886X_V_BOOT;
	227
	228	val &= rdev->desc->vsel_mask;
	229	val >>= ffs(rdev->desc->vsel_mask) - 1;
	230
	231	if (fbloop) {
	232	uv = regulator_list_voltage_linear(rdev, val);
	233	uv = mp8869_scale(uv, di->r[0], di->r[1]);
	234	return regulator_map_voltage_linear(rdev, uv, uv);
	235	}
	236
	237	return val;
	238	}
	239
	240	static const struct regulator_ops mp8867_regulator_ops = {
	241	.set_voltage_sel = mp8867_set_voltage_sel,
	242	.get_voltage_sel = mp8867_get_voltage_sel,
	243	.set_voltage_time_sel = regulator_set_voltage_time_sel,
	244	.map_voltage = regulator_map_voltage_linear,
	245	.list_voltage = regulator_list_voltage_linear,
	246	.enable = regulator_enable_regmap,
	247	.disable = regulator_disable_regmap,
	248	.is_enabled = regulator_is_enabled_regmap,
	249	.set_mode = mp886x_set_mode,
	250	.get_mode = mp886x_get_mode,
0eddcf02 JZ	251	.set_ramp_delay = mp886x_set_ramp,
	252	};
	253
	254	static const struct mp886x_cfg_info mp8867_ci = {
	255	.rops = &mp8867_regulator_ops,
	256	.slew_rates = {
	257	64000,
	258	32000,
	259	16000,
	260	8000,
	261	4000,
	262	2000,
	263	1000,
	264	500,
	265	},
ee6ad5a2 JZ	266	.switch_freq = {
	267	500000,
	268	750000,
	269	1000000,
	270	1500000,
	271	},
	272	.fs_reg = MP886X_SYSCNTLREG1,
	273	.fs_shift = 1,
751ca3aa JZ	274	};
751ca3aa JZ	275
97be8288 JZ	276	static int mp886x_regulator_register(struct mp886x_device_info *di,
	277	struct regulator_config *config)
	278	{
	279	struct regulator_desc *rdesc = &di->desc;
	280	struct regulator_dev *rdev;
	281
	282	rdesc->name = "mp886x-reg";
	283	rdesc->supply_name = "vin";
0eddcf02	284	rdesc->ops = di->ci->rops;
97be8288 JZ	285	rdesc->type = REGULATOR_VOLTAGE;
	286	rdesc->n_voltages = 128;
	287	rdesc->enable_reg = MP886X_SYSCNTLREG1;
	288	rdesc->enable_mask = MP886X_EN;
	289	rdesc->min_uV = 600000;
	290	rdesc->uV_step = 10000;
	291	rdesc->vsel_reg = MP886X_VSEL;
	292	rdesc->vsel_mask = 0x3f;
	293	rdesc->owner = THIS_MODULE;
	294
	295	rdev = devm_regulator_register(di->dev, &di->desc, config);
	296	if (IS_ERR(rdev))
	297	return PTR_ERR(rdev);
	298	di->sel = rdesc->ops->get_voltage_sel(rdev);
	299	return 0;
	300	}
	301
	302	static const struct regmap_config mp886x_regmap_config = {
	303	.reg_bits = 8,
	304	.val_bits = 8,
	305	};
	306
e2c6678b	307	static int mp886x_i2c_probe(struct i2c_client *client)
97be8288 JZ	308	{
	309	struct device *dev = &client->dev;
	310	struct device_node *np = dev->of_node;
	311	struct mp886x_device_info *di;
	312	struct regulator_config config = { };
	313	struct regmap *regmap;
ee6ad5a2	314	u32 freq;
97be8288 JZ	315	int ret;
	316
	317	di = devm_kzalloc(dev, sizeof(struct mp886x_device_info), GFP_KERNEL);
	318	if (!di)
	319	return -ENOMEM;
	320
	321	di->regulator = of_get_regulator_init_data(dev, np, &di->desc);
	322	if (!di->regulator) {
	323	dev_err(dev, "Platform data not found!\n");
	324	return -EINVAL;
	325	}
	326
	327	ret = of_property_read_u32_array(np, "mps,fb-voltage-divider",
	328	di->r, 2);
	329	if (ret)
	330	return ret;
	331
	332	di->en_gpio = devm_gpiod_get(dev, "enable", GPIOD_OUT_HIGH);
	333	if (IS_ERR(di->en_gpio))
	334	return PTR_ERR(di->en_gpio);
	335
0eddcf02	336	di->ci = of_device_get_match_data(dev);
97be8288 JZ	337	di->dev = dev;
	338
	339	regmap = devm_regmap_init_i2c(client, &mp886x_regmap_config);
	340	if (IS_ERR(regmap)) {
	341	dev_err(dev, "Failed to allocate regmap!\n");
	342	return PTR_ERR(regmap);
	343	}
	344	i2c_set_clientdata(client, di);
	345
	346	config.dev = di->dev;
	347	config.init_data = di->regulator;
	348	config.regmap = regmap;
	349	config.driver_data = di;
	350	config.of_node = np;
	351
a5f79495	352	if (!of_property_read_u32(np, "mps,switch-frequency-hz", &freq))
ee6ad5a2 JZ	353	mp886x_set_switch_freq(di, regmap, freq);
ee6ad5a2 JZ	354
97be8288 JZ	355	ret = mp886x_regulator_register(di, &config);
	356	if (ret < 0)
	357	dev_err(dev, "Failed to register regulator!\n");
	358	return ret;
	359	}
	360
	361	static const struct of_device_id mp886x_dt_ids[] = {
751ca3aa JZ	362	{
751ca3aa JZ	363	.compatible = "mps,mp8867",
0eddcf02	364	.data = &mp8867_ci
751ca3aa	365	},
97be8288 JZ	366	{
97be8288 JZ	367	.compatible = "mps,mp8869",
0eddcf02	368	.data = &mp8869_ci
97be8288 JZ	369	},
	370	{ }
	371	};
	372	MODULE_DEVICE_TABLE(of, mp886x_dt_ids);
	373
	374	static const struct i2c_device_id mp886x_id[] = {
	375	{ "mp886x", },
	376	{ },
	377	};
	378	MODULE_DEVICE_TABLE(i2c, mp886x_id);
	379
	380	static struct i2c_driver mp886x_regulator_driver = {
	381	.driver = {
	382	.name = "mp886x-regulator",
	383	.of_match_table = of_match_ptr(mp886x_dt_ids),
	384	},
e2c6678b	385	.probe_new = mp886x_i2c_probe,
97be8288 JZ	386	.id_table = mp886x_id,
	387	};
	388	module_i2c_driver(mp886x_regulator_driver);
	389
	390	MODULE_AUTHOR("Jisheng Zhang <jszhang@kernel.org>");
	391	MODULE_DESCRIPTION("MP886x regulator driver");
	392	MODULE_LICENSE("GPL v2");