Linux Audio

Check our new training course

Loading...
v5.9
  1// SPDX-License-Identifier: GPL-2.0
  2//
  3// FAN53555 Fairchild Digitally Programmable TinyBuck Regulator Driver.
  4//
  5// Supported Part Numbers:
  6// FAN53555UC00X/01X/03X/04X/05X
  7//
  8// Copyright (c) 2012 Marvell Technology Ltd.
  9// Yunfan Zhang <yfzhang@marvell.com>
 10
 
 
 
 
 11#include <linux/module.h>
 12#include <linux/param.h>
 13#include <linux/err.h>
 14#include <linux/platform_device.h>
 15#include <linux/regulator/driver.h>
 16#include <linux/regulator/machine.h>
 17#include <linux/regulator/of_regulator.h>
 18#include <linux/of_device.h>
 19#include <linux/i2c.h>
 20#include <linux/slab.h>
 21#include <linux/regmap.h>
 22#include <linux/regulator/fan53555.h>
 23
 24/* Voltage setting */
 25#define FAN53555_VSEL0		0x00
 26#define FAN53555_VSEL1		0x01
 27/* Control register */
 28#define FAN53555_CONTROL	0x02
 29/* IC Type */
 30#define FAN53555_ID1		0x03
 31/* IC mask version */
 32#define FAN53555_ID2		0x04
 33/* Monitor register */
 34#define FAN53555_MONITOR	0x05
 35
 36/* VSEL bit definitions */
 37#define VSEL_BUCK_EN	(1 << 7)
 38#define VSEL_MODE		(1 << 6)
 
 39/* Chip ID and Verison */
 40#define DIE_ID		0x0F	/* ID1 */
 41#define DIE_REV		0x0F	/* ID2 */
 42/* Control bit definitions */
 43#define CTL_OUTPUT_DISCHG	(1 << 7)
 44#define CTL_SLEW_MASK		(0x7 << 4)
 45#define CTL_SLEW_SHIFT		4
 46#define CTL_RESET			(1 << 2)
 47#define CTL_MODE_VSEL0_MODE	BIT(0)
 48#define CTL_MODE_VSEL1_MODE	BIT(1)
 49
 50#define FAN53555_NVOLTAGES	64	/* Numbers of voltages */
 51#define FAN53526_NVOLTAGES	128
 52
 53enum fan53555_vendor {
 54	FAN53526_VENDOR_FAIRCHILD = 0,
 55	FAN53555_VENDOR_FAIRCHILD,
 56	FAN53555_VENDOR_SILERGY,
 57};
 58
 59enum {
 60	FAN53526_CHIP_ID_01 = 1,
 61};
 62
 63enum {
 64	FAN53526_CHIP_REV_08 = 8,
 65};
 66
 67/* IC Type */
 68enum {
 69	FAN53555_CHIP_ID_00 = 0,
 70	FAN53555_CHIP_ID_01,
 71	FAN53555_CHIP_ID_02,
 72	FAN53555_CHIP_ID_03,
 73	FAN53555_CHIP_ID_04,
 74	FAN53555_CHIP_ID_05,
 75	FAN53555_CHIP_ID_08 = 8,
 76};
 77
 78/* IC mask revision */
 79enum {
 80	FAN53555_CHIP_REV_00 = 0x3,
 81	FAN53555_CHIP_REV_13 = 0xf,
 82};
 83
 84enum {
 85	SILERGY_SYR82X = 8,
 86	SILERGY_SYR83X = 9,
 87};
 88
 89struct fan53555_device_info {
 90	enum fan53555_vendor vendor;
 91	struct device *dev;
 92	struct regulator_desc desc;
 
 93	struct regulator_init_data *regulator;
 94	/* IC Type and Rev */
 95	int chip_id;
 96	int chip_rev;
 97	/* Voltage setting register */
 98	unsigned int vol_reg;
 99	unsigned int sleep_reg;
100	/* Voltage range and step(linear) */
101	unsigned int vsel_min;
102	unsigned int vsel_step;
103	unsigned int vsel_count;
104	/* Mode */
105	unsigned int mode_reg;
106	unsigned int mode_mask;
107	/* Sleep voltage cache */
108	unsigned int sleep_vol_cache;
109};
110
111static int fan53555_set_suspend_voltage(struct regulator_dev *rdev, int uV)
112{
113	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
114	int ret;
115
116	if (di->sleep_vol_cache == uV)
117		return 0;
118	ret = regulator_map_voltage_linear(rdev, uV, uV);
119	if (ret < 0)
120		return ret;
121	ret = regmap_update_bits(rdev->regmap, di->sleep_reg,
122				 di->desc.vsel_mask, ret);
123	if (ret < 0)
124		return ret;
125	/* Cache the sleep voltage setting.
126	 * Might not be the real voltage which is rounded */
127	di->sleep_vol_cache = uV;
128
129	return 0;
130}
131
132static int fan53555_set_suspend_enable(struct regulator_dev *rdev)
133{
134	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
135
136	return regmap_update_bits(rdev->regmap, di->sleep_reg,
137				  VSEL_BUCK_EN, VSEL_BUCK_EN);
138}
139
140static int fan53555_set_suspend_disable(struct regulator_dev *rdev)
141{
142	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
143
144	return regmap_update_bits(rdev->regmap, di->sleep_reg,
145				  VSEL_BUCK_EN, 0);
146}
147
148static int fan53555_set_mode(struct regulator_dev *rdev, unsigned int mode)
149{
150	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
151
152	switch (mode) {
153	case REGULATOR_MODE_FAST:
154		regmap_update_bits(rdev->regmap, di->mode_reg,
155				   di->mode_mask, di->mode_mask);
156		break;
157	case REGULATOR_MODE_NORMAL:
158		regmap_update_bits(rdev->regmap, di->vol_reg, di->mode_mask, 0);
159		break;
160	default:
161		return -EINVAL;
162	}
163	return 0;
164}
165
166static unsigned int fan53555_get_mode(struct regulator_dev *rdev)
167{
168	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
169	unsigned int val;
170	int ret = 0;
171
172	ret = regmap_read(rdev->regmap, di->mode_reg, &val);
173	if (ret < 0)
174		return ret;
175	if (val & di->mode_mask)
176		return REGULATOR_MODE_FAST;
177	else
178		return REGULATOR_MODE_NORMAL;
179}
180
181static const int slew_rates[] = {
182	64000,
183	32000,
184	16000,
185	 8000,
186	 4000,
187	 2000,
188	 1000,
189	  500,
190};
191
192static int fan53555_set_ramp(struct regulator_dev *rdev, int ramp)
193{
194	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
195	int regval = -1, i;
196
197	for (i = 0; i < ARRAY_SIZE(slew_rates); i++) {
198		if (ramp <= slew_rates[i])
199			regval = i;
200		else
201			break;
202	}
203
204	if (regval < 0) {
205		dev_err(di->dev, "unsupported ramp value %d\n", ramp);
206		return -EINVAL;
207	}
208
209	return regmap_update_bits(rdev->regmap, FAN53555_CONTROL,
210				  CTL_SLEW_MASK, regval << CTL_SLEW_SHIFT);
211}
212
213static const struct regulator_ops fan53555_regulator_ops = {
214	.set_voltage_sel = regulator_set_voltage_sel_regmap,
215	.get_voltage_sel = regulator_get_voltage_sel_regmap,
216	.set_voltage_time_sel = regulator_set_voltage_time_sel,
217	.map_voltage = regulator_map_voltage_linear,
218	.list_voltage = regulator_list_voltage_linear,
219	.set_suspend_voltage = fan53555_set_suspend_voltage,
220	.enable = regulator_enable_regmap,
221	.disable = regulator_disable_regmap,
222	.is_enabled = regulator_is_enabled_regmap,
223	.set_mode = fan53555_set_mode,
224	.get_mode = fan53555_get_mode,
225	.set_ramp_delay = fan53555_set_ramp,
226	.set_suspend_enable = fan53555_set_suspend_enable,
227	.set_suspend_disable = fan53555_set_suspend_disable,
228};
229
230static int fan53526_voltages_setup_fairchild(struct fan53555_device_info *di)
231{
232	/* Init voltage range and step */
233	switch (di->chip_id) {
234	case FAN53526_CHIP_ID_01:
235		switch (di->chip_rev) {
236		case FAN53526_CHIP_REV_08:
237			di->vsel_min = 600000;
238			di->vsel_step = 6250;
239			break;
240		default:
241			dev_err(di->dev,
242				"Chip ID %d with rev %d not supported!\n",
243				di->chip_id, di->chip_rev);
244			return -EINVAL;
245		}
246		break;
247	default:
248		dev_err(di->dev,
249			"Chip ID %d not supported!\n", di->chip_id);
250		return -EINVAL;
251	}
252
253	di->vsel_count = FAN53526_NVOLTAGES;
254
255	return 0;
256}
257
258static int fan53555_voltages_setup_fairchild(struct fan53555_device_info *di)
259{
260	/* Init voltage range and step */
261	switch (di->chip_id) {
262	case FAN53555_CHIP_ID_00:
263		switch (di->chip_rev) {
264		case FAN53555_CHIP_REV_00:
265			di->vsel_min = 600000;
266			di->vsel_step = 10000;
267			break;
268		case FAN53555_CHIP_REV_13:
269			di->vsel_min = 800000;
270			di->vsel_step = 10000;
271			break;
272		default:
273			dev_err(di->dev,
274				"Chip ID %d with rev %d not supported!\n",
275				di->chip_id, di->chip_rev);
276			return -EINVAL;
277		}
278		break;
279	case FAN53555_CHIP_ID_01:
280	case FAN53555_CHIP_ID_03:
281	case FAN53555_CHIP_ID_05:
282	case FAN53555_CHIP_ID_08:
283		di->vsel_min = 600000;
284		di->vsel_step = 10000;
285		break;
286	case FAN53555_CHIP_ID_04:
287		di->vsel_min = 603000;
288		di->vsel_step = 12826;
289		break;
290	default:
291		dev_err(di->dev,
292			"Chip ID %d not supported!\n", di->chip_id);
293		return -EINVAL;
294	}
295
296	di->vsel_count = FAN53555_NVOLTAGES;
297
298	return 0;
299}
300
301static int fan53555_voltages_setup_silergy(struct fan53555_device_info *di)
302{
303	/* Init voltage range and step */
304	switch (di->chip_id) {
305	case SILERGY_SYR82X:
306	case SILERGY_SYR83X:
307		di->vsel_min = 712500;
308		di->vsel_step = 12500;
309		break;
310	default:
311		dev_err(di->dev,
312			"Chip ID %d not supported!\n", di->chip_id);
313		return -EINVAL;
314	}
315
316	di->vsel_count = FAN53555_NVOLTAGES;
317
318	return 0;
319}
320
321/* For 00,01,03,05 options:
322 * VOUT = 0.60V + NSELx * 10mV, from 0.60 to 1.23V.
323 * For 04 option:
324 * VOUT = 0.603V + NSELx * 12.826mV, from 0.603 to 1.411V.
325 * */
326static int fan53555_device_setup(struct fan53555_device_info *di,
327				struct fan53555_platform_data *pdata)
328{
329	int ret = 0;
330
331	/* Setup voltage control register */
332	switch (pdata->sleep_vsel_id) {
333	case FAN53555_VSEL_ID_0:
334		di->sleep_reg = FAN53555_VSEL0;
335		di->vol_reg = FAN53555_VSEL1;
336		break;
337	case FAN53555_VSEL_ID_1:
338		di->sleep_reg = FAN53555_VSEL1;
339		di->vol_reg = FAN53555_VSEL0;
340		break;
341	default:
342		dev_err(di->dev, "Invalid VSEL ID!\n");
343		return -EINVAL;
344	}
345
346	/* Setup mode control register */
347	switch (di->vendor) {
348	case FAN53526_VENDOR_FAIRCHILD:
349		di->mode_reg = FAN53555_CONTROL;
350
351		switch (pdata->sleep_vsel_id) {
352		case FAN53555_VSEL_ID_0:
353			di->mode_mask = CTL_MODE_VSEL1_MODE;
354			break;
355		case FAN53555_VSEL_ID_1:
356			di->mode_mask = CTL_MODE_VSEL0_MODE;
357			break;
358		}
359		break;
360	case FAN53555_VENDOR_FAIRCHILD:
361	case FAN53555_VENDOR_SILERGY:
362		di->mode_reg = di->vol_reg;
363		di->mode_mask = VSEL_MODE;
364		break;
365	default:
366		dev_err(di->dev, "vendor %d not supported!\n", di->vendor);
367		return -EINVAL;
368	}
369
370	/* Setup voltage range */
371	switch (di->vendor) {
372	case FAN53526_VENDOR_FAIRCHILD:
373		ret = fan53526_voltages_setup_fairchild(di);
374		break;
375	case FAN53555_VENDOR_FAIRCHILD:
376		ret = fan53555_voltages_setup_fairchild(di);
377		break;
378	case FAN53555_VENDOR_SILERGY:
379		ret = fan53555_voltages_setup_silergy(di);
 
380		break;
381	default:
382		dev_err(di->dev, "vendor %d not supported!\n", di->vendor);
 
383		return -EINVAL;
384	}
385
386	return ret;
 
 
 
 
 
 
 
387}
388
389static int fan53555_regulator_register(struct fan53555_device_info *di,
390			struct regulator_config *config)
391{
392	struct regulator_desc *rdesc = &di->desc;
393	struct regulator_dev *rdev;
394
395	rdesc->name = "fan53555-reg";
396	rdesc->supply_name = "vin";
397	rdesc->ops = &fan53555_regulator_ops;
398	rdesc->type = REGULATOR_VOLTAGE;
399	rdesc->n_voltages = di->vsel_count;
400	rdesc->enable_reg = di->vol_reg;
401	rdesc->enable_mask = VSEL_BUCK_EN;
402	rdesc->min_uV = di->vsel_min;
403	rdesc->uV_step = di->vsel_step;
404	rdesc->vsel_reg = di->vol_reg;
405	rdesc->vsel_mask = di->vsel_count - 1;
406	rdesc->owner = THIS_MODULE;
407
408	rdev = devm_regulator_register(di->dev, &di->desc, config);
409	return PTR_ERR_OR_ZERO(rdev);
410}
411
412static const struct regmap_config fan53555_regmap_config = {
413	.reg_bits = 8,
414	.val_bits = 8,
415};
416
417static struct fan53555_platform_data *fan53555_parse_dt(struct device *dev,
418					      struct device_node *np,
419					      const struct regulator_desc *desc)
420{
421	struct fan53555_platform_data *pdata;
422	int ret;
423	u32 tmp;
424
425	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
426	if (!pdata)
427		return NULL;
428
429	pdata->regulator = of_get_regulator_init_data(dev, np, desc);
430
431	ret = of_property_read_u32(np, "fcs,suspend-voltage-selector",
432				   &tmp);
433	if (!ret)
434		pdata->sleep_vsel_id = tmp;
435
436	return pdata;
437}
438
439static const struct of_device_id fan53555_dt_ids[] = {
440	{
441		.compatible = "fcs,fan53526",
442		.data = (void *)FAN53526_VENDOR_FAIRCHILD,
443	}, {
444		.compatible = "fcs,fan53555",
445		.data = (void *)FAN53555_VENDOR_FAIRCHILD
446	}, {
447		.compatible = "silergy,syr827",
448		.data = (void *)FAN53555_VENDOR_SILERGY,
449	}, {
450		.compatible = "silergy,syr828",
451		.data = (void *)FAN53555_VENDOR_SILERGY,
452	},
453	{ }
454};
455MODULE_DEVICE_TABLE(of, fan53555_dt_ids);
456
457static int fan53555_regulator_probe(struct i2c_client *client,
458				const struct i2c_device_id *id)
459{
460	struct device_node *np = client->dev.of_node;
461	struct fan53555_device_info *di;
462	struct fan53555_platform_data *pdata;
463	struct regulator_config config = { };
464	struct regmap *regmap;
465	unsigned int val;
466	int ret;
467
468	di = devm_kzalloc(&client->dev, sizeof(struct fan53555_device_info),
469					GFP_KERNEL);
470	if (!di)
471		return -ENOMEM;
472
473	pdata = dev_get_platdata(&client->dev);
474	if (!pdata)
475		pdata = fan53555_parse_dt(&client->dev, np, &di->desc);
476
477	if (!pdata || !pdata->regulator) {
478		dev_err(&client->dev, "Platform data not found!\n");
479		return -ENODEV;
480	}
481
482	di->regulator = pdata->regulator;
483	if (client->dev.of_node) {
484		di->vendor =
485			(unsigned long)of_device_get_match_data(&client->dev);
486	} else {
487		/* if no ramp constraint set, get the pdata ramp_delay */
488		if (!di->regulator->constraints.ramp_delay) {
489			if (pdata->slew_rate >= ARRAY_SIZE(slew_rates)) {
490				dev_err(&client->dev, "Invalid slew_rate\n");
491				return -EINVAL;
492			}
493
494			di->regulator->constraints.ramp_delay
495					= slew_rates[pdata->slew_rate];
496		}
497
498		di->vendor = id->driver_data;
499	}
500
501	regmap = devm_regmap_init_i2c(client, &fan53555_regmap_config);
502	if (IS_ERR(regmap)) {
503		dev_err(&client->dev, "Failed to allocate regmap!\n");
504		return PTR_ERR(regmap);
505	}
506	di->dev = &client->dev;
 
507	i2c_set_clientdata(client, di);
508	/* Get chip ID */
509	ret = regmap_read(regmap, FAN53555_ID1, &val);
510	if (ret < 0) {
511		dev_err(&client->dev, "Failed to get chip ID!\n");
512		return ret;
513	}
514	di->chip_id = val & DIE_ID;
515	/* Get chip revision */
516	ret = regmap_read(regmap, FAN53555_ID2, &val);
517	if (ret < 0) {
518		dev_err(&client->dev, "Failed to get chip Rev!\n");
519		return ret;
520	}
521	di->chip_rev = val & DIE_REV;
522	dev_info(&client->dev, "FAN53555 Option[%d] Rev[%d] Detected!\n",
523				di->chip_id, di->chip_rev);
524	/* Device init */
525	ret = fan53555_device_setup(di, pdata);
526	if (ret < 0) {
527		dev_err(&client->dev, "Failed to setup device!\n");
528		return ret;
529	}
530	/* Register regulator */
531	config.dev = di->dev;
532	config.init_data = di->regulator;
533	config.regmap = regmap;
534	config.driver_data = di;
535	config.of_node = np;
536
537	ret = fan53555_regulator_register(di, &config);
538	if (ret < 0)
539		dev_err(&client->dev, "Failed to register regulator!\n");
540	return ret;
541
542}
543
544static const struct i2c_device_id fan53555_id[] = {
545	{
546		.name = "fan53526",
547		.driver_data = FAN53526_VENDOR_FAIRCHILD
548	}, {
549		.name = "fan53555",
550		.driver_data = FAN53555_VENDOR_FAIRCHILD
551	}, {
552		.name = "syr827",
553		.driver_data = FAN53555_VENDOR_SILERGY
554	}, {
555		.name = "syr828",
556		.driver_data = FAN53555_VENDOR_SILERGY
557	},
558	{ },
559};
560MODULE_DEVICE_TABLE(i2c, fan53555_id);
561
562static struct i2c_driver fan53555_regulator_driver = {
563	.driver = {
564		.name = "fan53555-regulator",
565		.of_match_table = of_match_ptr(fan53555_dt_ids),
566	},
567	.probe = fan53555_regulator_probe,
568	.id_table = fan53555_id,
569};
570
571module_i2c_driver(fan53555_regulator_driver);
572
573MODULE_AUTHOR("Yunfan Zhang <yfzhang@marvell.com>");
574MODULE_DESCRIPTION("FAN53555 regulator driver");
575MODULE_LICENSE("GPL v2");
v3.15
  1/*
  2 * FAN53555 Fairchild Digitally Programmable TinyBuck Regulator Driver.
  3 *
  4 * Supported Part Numbers:
  5 * FAN53555UC00X/01X/03X/04X/05X
  6 *
  7 * Copyright (c) 2012 Marvell Technology Ltd.
  8 * Yunfan Zhang <yfzhang@marvell.com>
  9 *
 10 * This package is free software; you can redistribute it and/or modify
 11 * it under the terms of the GNU General Public License version 2 as
 12 * published by the Free Software Foundation.
 13 *
 14 */
 15#include <linux/module.h>
 16#include <linux/param.h>
 17#include <linux/err.h>
 18#include <linux/platform_device.h>
 19#include <linux/regulator/driver.h>
 20#include <linux/regulator/machine.h>
 
 
 21#include <linux/i2c.h>
 22#include <linux/slab.h>
 23#include <linux/regmap.h>
 24#include <linux/regulator/fan53555.h>
 25
 26/* Voltage setting */
 27#define FAN53555_VSEL0		0x00
 28#define FAN53555_VSEL1		0x01
 29/* Control register */
 30#define FAN53555_CONTROL	0x02
 31/* IC Type */
 32#define FAN53555_ID1		0x03
 33/* IC mask version */
 34#define FAN53555_ID2		0x04
 35/* Monitor register */
 36#define FAN53555_MONITOR	0x05
 37
 38/* VSEL bit definitions */
 39#define VSEL_BUCK_EN	(1 << 7)
 40#define VSEL_MODE		(1 << 6)
 41#define VSEL_NSEL_MASK	0x3F
 42/* Chip ID and Verison */
 43#define DIE_ID		0x0F	/* ID1 */
 44#define DIE_REV		0x0F	/* ID2 */
 45/* Control bit definitions */
 46#define CTL_OUTPUT_DISCHG	(1 << 7)
 47#define CTL_SLEW_MASK		(0x7 << 4)
 48#define CTL_SLEW_SHIFT		4
 49#define CTL_RESET			(1 << 2)
 
 
 50
 51#define FAN53555_NVOLTAGES	64	/* Numbers of voltages */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 52
 53/* IC Type */
 54enum {
 55	FAN53555_CHIP_ID_00 = 0,
 56	FAN53555_CHIP_ID_01,
 57	FAN53555_CHIP_ID_02,
 58	FAN53555_CHIP_ID_03,
 59	FAN53555_CHIP_ID_04,
 60	FAN53555_CHIP_ID_05,
 
 
 
 
 
 
 
 
 
 
 
 
 61};
 62
 63struct fan53555_device_info {
 64	struct regmap *regmap;
 65	struct device *dev;
 66	struct regulator_desc desc;
 67	struct regulator_dev *rdev;
 68	struct regulator_init_data *regulator;
 69	/* IC Type and Rev */
 70	int chip_id;
 71	int chip_rev;
 72	/* Voltage setting register */
 73	unsigned int vol_reg;
 74	unsigned int sleep_reg;
 75	/* Voltage range and step(linear) */
 76	unsigned int vsel_min;
 77	unsigned int vsel_step;
 78	/* Voltage slew rate limiting */
 79	unsigned int slew_rate;
 
 
 80	/* Sleep voltage cache */
 81	unsigned int sleep_vol_cache;
 82};
 83
 84static int fan53555_set_suspend_voltage(struct regulator_dev *rdev, int uV)
 85{
 86	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
 87	int ret;
 88
 89	if (di->sleep_vol_cache == uV)
 90		return 0;
 91	ret = regulator_map_voltage_linear(rdev, uV, uV);
 92	if (ret < 0)
 93		return ret;
 94	ret = regmap_update_bits(di->regmap, di->sleep_reg,
 95					VSEL_NSEL_MASK, ret);
 96	if (ret < 0)
 97		return ret;
 98	/* Cache the sleep voltage setting.
 99	 * Might not be the real voltage which is rounded */
100	di->sleep_vol_cache = uV;
101
102	return 0;
103}
104
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
105static int fan53555_set_mode(struct regulator_dev *rdev, unsigned int mode)
106{
107	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
108
109	switch (mode) {
110	case REGULATOR_MODE_FAST:
111		regmap_update_bits(di->regmap, di->vol_reg,
112				VSEL_MODE, VSEL_MODE);
113		break;
114	case REGULATOR_MODE_NORMAL:
115		regmap_update_bits(di->regmap, di->vol_reg, VSEL_MODE, 0);
116		break;
117	default:
118		return -EINVAL;
119	}
120	return 0;
121}
122
123static unsigned int fan53555_get_mode(struct regulator_dev *rdev)
124{
125	struct fan53555_device_info *di = rdev_get_drvdata(rdev);
126	unsigned int val;
127	int ret = 0;
128
129	ret = regmap_read(di->regmap, di->vol_reg, &val);
130	if (ret < 0)
131		return ret;
132	if (val & VSEL_MODE)
133		return REGULATOR_MODE_FAST;
134	else
135		return REGULATOR_MODE_NORMAL;
136}
137
138static struct regulator_ops fan53555_regulator_ops = {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
139	.set_voltage_sel = regulator_set_voltage_sel_regmap,
140	.get_voltage_sel = regulator_get_voltage_sel_regmap,
 
141	.map_voltage = regulator_map_voltage_linear,
142	.list_voltage = regulator_list_voltage_linear,
143	.set_suspend_voltage = fan53555_set_suspend_voltage,
144	.enable = regulator_enable_regmap,
145	.disable = regulator_disable_regmap,
146	.is_enabled = regulator_is_enabled_regmap,
147	.set_mode = fan53555_set_mode,
148	.get_mode = fan53555_get_mode,
 
 
 
149};
150
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
151/* For 00,01,03,05 options:
152 * VOUT = 0.60V + NSELx * 10mV, from 0.60 to 1.23V.
153 * For 04 option:
154 * VOUT = 0.603V + NSELx * 12.826mV, from 0.603 to 1.411V.
155 * */
156static int fan53555_device_setup(struct fan53555_device_info *di,
157				struct fan53555_platform_data *pdata)
158{
159	unsigned int reg, data, mask;
160
161	/* Setup voltage control register */
162	switch (pdata->sleep_vsel_id) {
163	case FAN53555_VSEL_ID_0:
164		di->sleep_reg = FAN53555_VSEL0;
165		di->vol_reg = FAN53555_VSEL1;
166		break;
167	case FAN53555_VSEL_ID_1:
168		di->sleep_reg = FAN53555_VSEL1;
169		di->vol_reg = FAN53555_VSEL0;
170		break;
171	default:
172		dev_err(di->dev, "Invalid VSEL ID!\n");
173		return -EINVAL;
174	}
175	/* Init voltage range and step */
176	switch (di->chip_id) {
177	case FAN53555_CHIP_ID_00:
178	case FAN53555_CHIP_ID_01:
179	case FAN53555_CHIP_ID_03:
180	case FAN53555_CHIP_ID_05:
181		di->vsel_min = 600000;
182		di->vsel_step = 10000;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
183		break;
184	case FAN53555_CHIP_ID_04:
185		di->vsel_min = 603000;
186		di->vsel_step = 12826;
187		break;
188	default:
189		dev_err(di->dev,
190			"Chip ID[%d]\n not supported!\n", di->chip_id);
191		return -EINVAL;
192	}
193	/* Init slew rate */
194	if (pdata->slew_rate & 0x7)
195		di->slew_rate = pdata->slew_rate;
196	else
197		di->slew_rate = FAN53555_SLEW_RATE_64MV;
198	reg = FAN53555_CONTROL;
199	data = di->slew_rate << CTL_SLEW_SHIFT;
200	mask = CTL_SLEW_MASK;
201	return regmap_update_bits(di->regmap, reg, mask, data);
202}
203
204static int fan53555_regulator_register(struct fan53555_device_info *di,
205			struct regulator_config *config)
206{
207	struct regulator_desc *rdesc = &di->desc;
 
208
209	rdesc->name = "fan53555-reg";
 
210	rdesc->ops = &fan53555_regulator_ops;
211	rdesc->type = REGULATOR_VOLTAGE;
212	rdesc->n_voltages = FAN53555_NVOLTAGES;
213	rdesc->enable_reg = di->vol_reg;
214	rdesc->enable_mask = VSEL_BUCK_EN;
215	rdesc->min_uV = di->vsel_min;
216	rdesc->uV_step = di->vsel_step;
217	rdesc->vsel_reg = di->vol_reg;
218	rdesc->vsel_mask = VSEL_NSEL_MASK;
219	rdesc->owner = THIS_MODULE;
220
221	di->rdev = devm_regulator_register(di->dev, &di->desc, config);
222	return PTR_ERR_OR_ZERO(di->rdev);
223}
224
225static struct regmap_config fan53555_regmap_config = {
226	.reg_bits = 8,
227	.val_bits = 8,
228};
229
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
230static int fan53555_regulator_probe(struct i2c_client *client,
231				const struct i2c_device_id *id)
232{
 
233	struct fan53555_device_info *di;
234	struct fan53555_platform_data *pdata;
235	struct regulator_config config = { };
 
236	unsigned int val;
237	int ret;
238
 
 
 
 
 
239	pdata = dev_get_platdata(&client->dev);
 
 
 
240	if (!pdata || !pdata->regulator) {
241		dev_err(&client->dev, "Platform data not found!\n");
242		return -ENODEV;
243	}
244
245	di = devm_kzalloc(&client->dev, sizeof(struct fan53555_device_info),
246					GFP_KERNEL);
247	if (!di)
248		return -ENOMEM;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
249
250	di->regmap = devm_regmap_init_i2c(client, &fan53555_regmap_config);
251	if (IS_ERR(di->regmap)) {
252		dev_err(&client->dev, "Failed to allocate regmap!\n");
253		return PTR_ERR(di->regmap);
254	}
255	di->dev = &client->dev;
256	di->regulator = pdata->regulator;
257	i2c_set_clientdata(client, di);
258	/* Get chip ID */
259	ret = regmap_read(di->regmap, FAN53555_ID1, &val);
260	if (ret < 0) {
261		dev_err(&client->dev, "Failed to get chip ID!\n");
262		return ret;
263	}
264	di->chip_id = val & DIE_ID;
265	/* Get chip revision */
266	ret = regmap_read(di->regmap, FAN53555_ID2, &val);
267	if (ret < 0) {
268		dev_err(&client->dev, "Failed to get chip Rev!\n");
269		return ret;
270	}
271	di->chip_rev = val & DIE_REV;
272	dev_info(&client->dev, "FAN53555 Option[%d] Rev[%d] Detected!\n",
273				di->chip_id, di->chip_rev);
274	/* Device init */
275	ret = fan53555_device_setup(di, pdata);
276	if (ret < 0) {
277		dev_err(&client->dev, "Failed to setup device!\n");
278		return ret;
279	}
280	/* Register regulator */
281	config.dev = di->dev;
282	config.init_data = di->regulator;
283	config.regmap = di->regmap;
284	config.driver_data = di;
 
 
285	ret = fan53555_regulator_register(di, &config);
286	if (ret < 0)
287		dev_err(&client->dev, "Failed to register regulator!\n");
288	return ret;
289
290}
291
292static const struct i2c_device_id fan53555_id[] = {
293	{"fan53555", -1},
 
 
 
 
 
 
 
 
 
 
 
 
294	{ },
295};
 
296
297static struct i2c_driver fan53555_regulator_driver = {
298	.driver = {
299		.name = "fan53555-regulator",
 
300	},
301	.probe = fan53555_regulator_probe,
302	.id_table = fan53555_id,
303};
304
305module_i2c_driver(fan53555_regulator_driver);
306
307MODULE_AUTHOR("Yunfan Zhang <yfzhang@marvell.com>");
308MODULE_DESCRIPTION("FAN53555 regulator driver");
309MODULE_LICENSE("GPL v2");