Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * twl-regulator.c -- support regulators in twl4030/twl6030 family chips
  4 *
  5 * Copyright (C) 2008 David Brownell
  6 */
  7
  8#include <linux/module.h>
  9#include <linux/string.h>
 10#include <linux/slab.h>
 11#include <linux/init.h>
 12#include <linux/err.h>
 13#include <linux/platform_device.h>
 14#include <linux/of.h>
 
 15#include <linux/regulator/driver.h>
 16#include <linux/regulator/machine.h>
 17#include <linux/regulator/of_regulator.h>
 18#include <linux/mfd/twl.h>
 19#include <linux/delay.h>
 20
 21/*
 22 * The TWL4030/TW5030/TPS659x0 family chips include power management, a
 23 * USB OTG transceiver, an RTC, ADC, PWM, and lots more.  Some versions
 24 * include an audio codec, battery charger, and more voltage regulators.
 25 * These chips are often used in OMAP-based systems.
 26 *
 27 * This driver implements software-based resource control for various
 28 * voltage regulators.  This is usually augmented with state machine
 29 * based control.
 30 */
 31
 32struct twlreg_info {
 33	/* start of regulator's PM_RECEIVER control register bank */
 34	u8			base;
 35
 36	/* twl resource ID, for resource control state machine */
 37	u8			id;
 38
 39	/* voltage in mV = table[VSEL]; table_len must be a power-of-two */
 40	u8			table_len;
 41	const u16		*table;
 42
 43	/* State REMAP default configuration */
 44	u8			remap;
 45
 46	/* used by regulator core */
 47	struct regulator_desc	desc;
 48
 49	/* chip specific features */
 50	unsigned long		features;
 51
 52	/* data passed from board for external get/set voltage */
 53	void			*data;
 54};
 55
 56
 57/* LDO control registers ... offset is from the base of its register bank.
 58 * The first three registers of all power resource banks help hardware to
 59 * manage the various resource groups.
 60 */
 61/* Common offset in TWL4030/6030 */
 62#define VREG_GRP		0
 63/* TWL4030 register offsets */
 64#define VREG_TYPE		1
 65#define VREG_REMAP		2
 66#define VREG_DEDICATED		3	/* LDO control */
 67#define VREG_VOLTAGE_SMPS_4030	9
 68/* TWL6030 register offsets */
 69#define VREG_TRANS		1
 70#define VREG_STATE		2
 71#define VREG_VOLTAGE		3
 72#define VREG_VOLTAGE_SMPS	4
 73
 74static inline int
 75twlreg_read(struct twlreg_info *info, unsigned slave_subgp, unsigned offset)
 76{
 77	u8 value;
 78	int status;
 79
 80	status = twl_i2c_read_u8(slave_subgp,
 81			&value, info->base + offset);
 82	return (status < 0) ? status : value;
 83}
 84
 85static inline int
 86twlreg_write(struct twlreg_info *info, unsigned slave_subgp, unsigned offset,
 87						 u8 value)
 88{
 89	return twl_i2c_write_u8(slave_subgp,
 90			value, info->base + offset);
 91}
 92
 93/*----------------------------------------------------------------------*/
 94
 95/* generic power resource operations, which work on all regulators */
 96
 97static int twlreg_grp(struct regulator_dev *rdev)
 98{
 99	return twlreg_read(rdev_get_drvdata(rdev), TWL_MODULE_PM_RECEIVER,
100								 VREG_GRP);
101}
102
103/*
104 * Enable/disable regulators by joining/leaving the P1 (processor) group.
105 * We assume nobody else is updating the DEV_GRP registers.
106 */
107/* definition for 4030 family */
108#define P3_GRP_4030	BIT(7)		/* "peripherals" */
109#define P2_GRP_4030	BIT(6)		/* secondary processor, modem, etc */
110#define P1_GRP_4030	BIT(5)		/* CPU/Linux */
111/* definition for 6030 family */
112#define P3_GRP_6030	BIT(2)		/* secondary processor, modem, etc */
113#define P2_GRP_6030	BIT(1)		/* "peripherals" */
114#define P1_GRP_6030	BIT(0)		/* CPU/Linux */
115
116static int twl4030reg_is_enabled(struct regulator_dev *rdev)
117{
118	int	state = twlreg_grp(rdev);
119
120	if (state < 0)
121		return state;
122
123	return state & P1_GRP_4030;
124}
125
126#define PB_I2C_BUSY	BIT(0)
127#define PB_I2C_BWEN	BIT(1)
128
129/* Wait until buffer empty/ready to send a word on power bus. */
130static int twl4030_wait_pb_ready(void)
131{
132
133	int	ret;
134	int	timeout = 10;
135	u8	val;
136
137	do {
138		ret = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &val,
139				      TWL4030_PM_MASTER_PB_CFG);
140		if (ret < 0)
141			return ret;
142
143		if (!(val & PB_I2C_BUSY))
144			return 0;
145
146		mdelay(1);
147		timeout--;
148	} while (timeout);
149
150	return -ETIMEDOUT;
151}
152
153/* Send a word over the powerbus */
154static int twl4030_send_pb_msg(unsigned msg)
155{
156	u8	val;
157	int	ret;
158
159	/* save powerbus configuration */
160	ret = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &val,
161			      TWL4030_PM_MASTER_PB_CFG);
162	if (ret < 0)
163		return ret;
164
165	/* Enable i2c access to powerbus */
166	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, val | PB_I2C_BWEN,
167			       TWL4030_PM_MASTER_PB_CFG);
168	if (ret < 0)
169		return ret;
170
171	ret = twl4030_wait_pb_ready();
172	if (ret < 0)
173		return ret;
174
175	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, msg >> 8,
176			       TWL4030_PM_MASTER_PB_WORD_MSB);
177	if (ret < 0)
178		return ret;
179
180	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, msg & 0xff,
181			       TWL4030_PM_MASTER_PB_WORD_LSB);
182	if (ret < 0)
183		return ret;
184
185	ret = twl4030_wait_pb_ready();
186	if (ret < 0)
187		return ret;
188
189	/* Restore powerbus configuration */
190	return twl_i2c_write_u8(TWL_MODULE_PM_MASTER, val,
191				TWL4030_PM_MASTER_PB_CFG);
192}
193
194static int twl4030reg_enable(struct regulator_dev *rdev)
195{
196	struct twlreg_info	*info = rdev_get_drvdata(rdev);
197	int			grp;
 
198
199	grp = twlreg_grp(rdev);
200	if (grp < 0)
201		return grp;
202
203	grp |= P1_GRP_4030;
204
205	return twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_GRP, grp);
 
 
206}
207
208static int twl4030reg_disable(struct regulator_dev *rdev)
209{
210	struct twlreg_info	*info = rdev_get_drvdata(rdev);
211	int			grp;
 
212
213	grp = twlreg_grp(rdev);
214	if (grp < 0)
215		return grp;
216
217	grp &= ~(P1_GRP_4030 | P2_GRP_4030 | P3_GRP_4030);
218
219	return twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_GRP, grp);
 
 
220}
221
222static int twl4030reg_get_status(struct regulator_dev *rdev)
223{
224	int	state = twlreg_grp(rdev);
225
226	if (state < 0)
227		return state;
228	state &= 0x0f;
229
230	/* assume state != WARM_RESET; we'd not be running...  */
231	if (!state)
232		return REGULATOR_STATUS_OFF;
233	return (state & BIT(3))
234		? REGULATOR_STATUS_NORMAL
235		: REGULATOR_STATUS_STANDBY;
236}
237
238static int twl4030reg_set_mode(struct regulator_dev *rdev, unsigned mode)
239{
240	struct twlreg_info	*info = rdev_get_drvdata(rdev);
241	unsigned		message;
242
243	/* We can only set the mode through state machine commands... */
244	switch (mode) {
245	case REGULATOR_MODE_NORMAL:
246		message = MSG_SINGULAR(DEV_GRP_P1, info->id, RES_STATE_ACTIVE);
247		break;
248	case REGULATOR_MODE_STANDBY:
249		message = MSG_SINGULAR(DEV_GRP_P1, info->id, RES_STATE_SLEEP);
250		break;
251	default:
252		return -EINVAL;
253	}
254
255	return twl4030_send_pb_msg(message);
256}
257
258static inline unsigned int twl4030reg_map_mode(unsigned int mode)
259{
260	switch (mode) {
261	case RES_STATE_ACTIVE:
262		return REGULATOR_MODE_NORMAL;
263	case RES_STATE_SLEEP:
264		return REGULATOR_MODE_STANDBY;
265	default:
266		return REGULATOR_MODE_INVALID;
267	}
268}
269
270/*----------------------------------------------------------------------*/
271
272/*
273 * Support for adjustable-voltage LDOs uses a four bit (or less) voltage
274 * select field in its control register.   We use tables indexed by VSEL
275 * to record voltages in milliVolts.  (Accuracy is about three percent.)
276 *
277 * Note that VSEL values for VAUX2 changed in twl5030 and newer silicon;
278 * currently handled by listing two slightly different VAUX2 regulators,
279 * only one of which will be configured.
280 *
281 * VSEL values documented as "TI cannot support these values" are flagged
282 * in these tables as UNSUP() values; we normally won't assign them.
283 *
284 * VAUX3 at 3V is incorrectly listed in some TI manuals as unsupported.
285 * TI are revising the twl5030/tps659x0 specs to support that 3.0V setting.
286 */
287#define UNSUP_MASK	0x8000
288
289#define UNSUP(x)	(UNSUP_MASK | (x))
290#define IS_UNSUP(info, x)			\
291	((UNSUP_MASK & (x)) &&			\
292	 !((info)->features & TWL4030_ALLOW_UNSUPPORTED))
293#define LDO_MV(x)	(~UNSUP_MASK & (x))
294
295
296static const u16 VAUX1_VSEL_table[] = {
297	UNSUP(1500), UNSUP(1800), 2500, 2800,
298	3000, 3000, 3000, 3000,
299};
300static const u16 VAUX2_4030_VSEL_table[] = {
301	UNSUP(1000), UNSUP(1000), UNSUP(1200), 1300,
302	1500, 1800, UNSUP(1850), 2500,
303	UNSUP(2600), 2800, UNSUP(2850), UNSUP(3000),
304	UNSUP(3150), UNSUP(3150), UNSUP(3150), UNSUP(3150),
305};
306static const u16 VAUX2_VSEL_table[] = {
307	1700, 1700, 1900, 1300,
308	1500, 1800, 2000, 2500,
309	2100, 2800, 2200, 2300,
310	2400, 2400, 2400, 2400,
311};
312static const u16 VAUX3_VSEL_table[] = {
313	1500, 1800, 2500, 2800,
314	3000, 3000, 3000, 3000,
315};
316static const u16 VAUX4_VSEL_table[] = {
317	700, 1000, 1200, UNSUP(1300),
318	1500, 1800, UNSUP(1850), 2500,
319	UNSUP(2600), 2800, UNSUP(2850), UNSUP(3000),
320	UNSUP(3150), UNSUP(3150), UNSUP(3150), UNSUP(3150),
321};
322static const u16 VMMC1_VSEL_table[] = {
323	1850, 2850, 3000, 3150,
324};
325static const u16 VMMC2_VSEL_table[] = {
326	UNSUP(1000), UNSUP(1000), UNSUP(1200), UNSUP(1300),
327	UNSUP(1500), UNSUP(1800), 1850, UNSUP(2500),
328	2600, 2800, 2850, 3000,
329	3150, 3150, 3150, 3150,
330};
331static const u16 VPLL1_VSEL_table[] = {
332	1000, 1200, 1300, 1800,
333	UNSUP(2800), UNSUP(3000), UNSUP(3000), UNSUP(3000),
334};
335static const u16 VPLL2_VSEL_table[] = {
336	700, 1000, 1200, 1300,
337	UNSUP(1500), 1800, UNSUP(1850), UNSUP(2500),
338	UNSUP(2600), UNSUP(2800), UNSUP(2850), UNSUP(3000),
339	UNSUP(3150), UNSUP(3150), UNSUP(3150), UNSUP(3150),
340};
341static const u16 VSIM_VSEL_table[] = {
342	UNSUP(1000), UNSUP(1200), UNSUP(1300), 1800,
343	2800, 3000, 3000, 3000,
344};
345static const u16 VDAC_VSEL_table[] = {
346	1200, 1300, 1800, 1800,
347};
348static const u16 VIO_VSEL_table[] = {
349	1800, 1850,
350};
351static const u16 VINTANA2_VSEL_table[] = {
352	2500, 2750,
353};
354
355/* 600mV to 1450mV in 12.5 mV steps */
356static const struct linear_range VDD1_ranges[] = {
357	REGULATOR_LINEAR_RANGE(600000, 0, 68, 12500)
358};
359
360/* 600mV to 1450mV in 12.5 mV steps, everything above = 1500mV */
361static const struct linear_range VDD2_ranges[] = {
362	REGULATOR_LINEAR_RANGE(600000, 0, 68, 12500),
363	REGULATOR_LINEAR_RANGE(1500000, 69, 69, 12500)
364};
365
366static int twl4030ldo_list_voltage(struct regulator_dev *rdev, unsigned index)
367{
368	struct twlreg_info	*info = rdev_get_drvdata(rdev);
369	int			mV = info->table[index];
370
371	return IS_UNSUP(info, mV) ? 0 : (LDO_MV(mV) * 1000);
372}
373
374static int
375twl4030ldo_set_voltage_sel(struct regulator_dev *rdev, unsigned selector)
376{
377	struct twlreg_info	*info = rdev_get_drvdata(rdev);
378
379	return twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE,
380			    selector);
381}
382
383static int twl4030ldo_get_voltage_sel(struct regulator_dev *rdev)
384{
385	struct twlreg_info	*info = rdev_get_drvdata(rdev);
386	int vsel = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE);
387
388	if (vsel < 0)
389		return vsel;
390
391	vsel &= info->table_len - 1;
392	return vsel;
393}
394
395static const struct regulator_ops twl4030ldo_ops = {
396	.list_voltage	= twl4030ldo_list_voltage,
397
398	.set_voltage_sel = twl4030ldo_set_voltage_sel,
399	.get_voltage_sel = twl4030ldo_get_voltage_sel,
400
401	.enable		= twl4030reg_enable,
402	.disable	= twl4030reg_disable,
403	.is_enabled	= twl4030reg_is_enabled,
404
405	.set_mode	= twl4030reg_set_mode,
406
407	.get_status	= twl4030reg_get_status,
408};
409
410static int
411twl4030smps_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV,
412			unsigned *selector)
413{
414	struct twlreg_info *info = rdev_get_drvdata(rdev);
415	int vsel = DIV_ROUND_UP(min_uV - 600000, 12500);
416
417	twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE_SMPS_4030, vsel);
418
419	return 0;
420}
421
422static int twl4030smps_get_voltage(struct regulator_dev *rdev)
423{
424	struct twlreg_info *info = rdev_get_drvdata(rdev);
425	int vsel;
426
427	vsel = twlreg_read(info, TWL_MODULE_PM_RECEIVER,
428		VREG_VOLTAGE_SMPS_4030);
429
430	return vsel * 12500 + 600000;
431}
432
433static const struct regulator_ops twl4030smps_ops = {
434	.list_voltage   = regulator_list_voltage_linear_range,
435
436	.set_voltage	= twl4030smps_set_voltage,
437	.get_voltage	= twl4030smps_get_voltage,
438};
439
440/*----------------------------------------------------------------------*/
441
442static const struct regulator_ops twl4030fixed_ops = {
443	.list_voltage	= regulator_list_voltage_linear,
444
445	.enable		= twl4030reg_enable,
446	.disable	= twl4030reg_disable,
447	.is_enabled	= twl4030reg_is_enabled,
448
449	.set_mode	= twl4030reg_set_mode,
450
451	.get_status	= twl4030reg_get_status,
452};
453
454/*----------------------------------------------------------------------*/
455
456#define TWL4030_ADJUSTABLE_LDO(label, offset, num, turnon_delay, remap_conf) \
457static const struct twlreg_info TWL4030_INFO_##label = { \
458	.base = offset, \
459	.id = num, \
460	.table_len = ARRAY_SIZE(label##_VSEL_table), \
461	.table = label##_VSEL_table, \
462	.remap = remap_conf, \
463	.desc = { \
464		.name = #label, \
465		.id = TWL4030_REG_##label, \
466		.n_voltages = ARRAY_SIZE(label##_VSEL_table), \
467		.ops = &twl4030ldo_ops, \
468		.type = REGULATOR_VOLTAGE, \
469		.owner = THIS_MODULE, \
470		.enable_time = turnon_delay, \
471		.of_map_mode = twl4030reg_map_mode, \
472		}, \
473	}
474
475#define TWL4030_ADJUSTABLE_SMPS(label, offset, num, turnon_delay, remap_conf, \
476		n_volt) \
477static const struct twlreg_info TWL4030_INFO_##label = { \
478	.base = offset, \
479	.id = num, \
480	.remap = remap_conf, \
481	.desc = { \
482		.name = #label, \
483		.id = TWL4030_REG_##label, \
484		.ops = &twl4030smps_ops, \
485		.type = REGULATOR_VOLTAGE, \
486		.owner = THIS_MODULE, \
487		.enable_time = turnon_delay, \
488		.of_map_mode = twl4030reg_map_mode, \
489		.n_voltages = n_volt, \
490		.n_linear_ranges = ARRAY_SIZE(label ## _ranges), \
491		.linear_ranges = label ## _ranges, \
492		}, \
493	}
494
495#define TWL4030_FIXED_LDO(label, offset, mVolts, num, turnon_delay, \
496			remap_conf) \
497static const struct twlreg_info TWLFIXED_INFO_##label = { \
498	.base = offset, \
499	.id = num, \
500	.remap = remap_conf, \
501	.desc = { \
502		.name = #label, \
503		.id = TWL4030##_REG_##label, \
504		.n_voltages = 1, \
505		.ops = &twl4030fixed_ops, \
506		.type = REGULATOR_VOLTAGE, \
507		.owner = THIS_MODULE, \
508		.min_uV = mVolts * 1000, \
509		.enable_time = turnon_delay, \
510		.of_map_mode = twl4030reg_map_mode, \
511		}, \
512	}
513
514/*
515 * We list regulators here if systems need some level of
516 * software control over them after boot.
517 */
518TWL4030_ADJUSTABLE_LDO(VAUX1, 0x17, 1, 100, 0x08);
519TWL4030_ADJUSTABLE_LDO(VAUX2_4030, 0x1b, 2, 100, 0x08);
520TWL4030_ADJUSTABLE_LDO(VAUX2, 0x1b, 2, 100, 0x08);
521TWL4030_ADJUSTABLE_LDO(VAUX3, 0x1f, 3, 100, 0x08);
522TWL4030_ADJUSTABLE_LDO(VAUX4, 0x23, 4, 100, 0x08);
523TWL4030_ADJUSTABLE_LDO(VMMC1, 0x27, 5, 100, 0x08);
524TWL4030_ADJUSTABLE_LDO(VMMC2, 0x2b, 6, 100, 0x08);
525TWL4030_ADJUSTABLE_LDO(VPLL1, 0x2f, 7, 100, 0x00);
526TWL4030_ADJUSTABLE_LDO(VPLL2, 0x33, 8, 100, 0x08);
527TWL4030_ADJUSTABLE_LDO(VSIM, 0x37, 9, 100, 0x00);
528TWL4030_ADJUSTABLE_LDO(VDAC, 0x3b, 10, 100, 0x08);
529TWL4030_ADJUSTABLE_LDO(VINTANA2, 0x43, 12, 100, 0x08);
530TWL4030_ADJUSTABLE_LDO(VIO, 0x4b, 14, 1000, 0x08);
531TWL4030_ADJUSTABLE_SMPS(VDD1, 0x55, 15, 1000, 0x08, 68);
532TWL4030_ADJUSTABLE_SMPS(VDD2, 0x63, 16, 1000, 0x08, 69);
533/* VUSBCP is managed *only* by the USB subchip */
534TWL4030_FIXED_LDO(VINTANA1, 0x3f, 1500, 11, 100, 0x08);
535TWL4030_FIXED_LDO(VINTDIG, 0x47, 1500, 13, 100, 0x08);
536TWL4030_FIXED_LDO(VUSB1V5, 0x71, 1500, 17, 100, 0x08);
537TWL4030_FIXED_LDO(VUSB1V8, 0x74, 1800, 18, 100, 0x08);
538TWL4030_FIXED_LDO(VUSB3V1, 0x77, 3100, 19, 150, 0x08);
539
540#define TWL_OF_MATCH(comp, family, label) \
541	{ \
542		.compatible = comp, \
543		.data = &family##_INFO_##label, \
544	}
545
546#define TWL4030_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWL4030, label)
547#define TWL6030_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWL6030, label)
548#define TWL6032_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWL6032, label)
549#define TWLFIXED_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWLFIXED, label)
550#define TWLSMPS_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWLSMPS, label)
551
552static const struct of_device_id twl_of_match[] = {
553	TWL4030_OF_MATCH("ti,twl4030-vaux1", VAUX1),
554	TWL4030_OF_MATCH("ti,twl4030-vaux2", VAUX2_4030),
555	TWL4030_OF_MATCH("ti,twl5030-vaux2", VAUX2),
556	TWL4030_OF_MATCH("ti,twl4030-vaux3", VAUX3),
557	TWL4030_OF_MATCH("ti,twl4030-vaux4", VAUX4),
558	TWL4030_OF_MATCH("ti,twl4030-vmmc1", VMMC1),
559	TWL4030_OF_MATCH("ti,twl4030-vmmc2", VMMC2),
560	TWL4030_OF_MATCH("ti,twl4030-vpll1", VPLL1),
561	TWL4030_OF_MATCH("ti,twl4030-vpll2", VPLL2),
562	TWL4030_OF_MATCH("ti,twl4030-vsim", VSIM),
563	TWL4030_OF_MATCH("ti,twl4030-vdac", VDAC),
564	TWL4030_OF_MATCH("ti,twl4030-vintana2", VINTANA2),
565	TWL4030_OF_MATCH("ti,twl4030-vio", VIO),
566	TWL4030_OF_MATCH("ti,twl4030-vdd1", VDD1),
567	TWL4030_OF_MATCH("ti,twl4030-vdd2", VDD2),
568	TWLFIXED_OF_MATCH("ti,twl4030-vintana1", VINTANA1),
569	TWLFIXED_OF_MATCH("ti,twl4030-vintdig", VINTDIG),
570	TWLFIXED_OF_MATCH("ti,twl4030-vusb1v5", VUSB1V5),
571	TWLFIXED_OF_MATCH("ti,twl4030-vusb1v8", VUSB1V8),
572	TWLFIXED_OF_MATCH("ti,twl4030-vusb3v1", VUSB3V1),
573	{},
574};
575MODULE_DEVICE_TABLE(of, twl_of_match);
576
577static int twlreg_probe(struct platform_device *pdev)
578{
579	int id;
580	struct twlreg_info		*info;
581	const struct twlreg_info	*template;
582	struct regulator_init_data	*initdata;
583	struct regulation_constraints	*c;
584	struct regulator_dev		*rdev;
585	struct regulator_config		config = { };
586
587	template = of_device_get_match_data(&pdev->dev);
588	if (!template)
589		return -ENODEV;
590
591	id = template->desc.id;
592	initdata = of_get_regulator_init_data(&pdev->dev, pdev->dev.of_node,
593						&template->desc);
594	if (!initdata)
595		return -EINVAL;
596
597	info = devm_kmemdup(&pdev->dev, template, sizeof(*info), GFP_KERNEL);
598	if (!info)
599		return -ENOMEM;
600
601	/* Constrain board-specific capabilities according to what
602	 * this driver and the chip itself can actually do.
603	 */
604	c = &initdata->constraints;
605	c->valid_modes_mask &= REGULATOR_MODE_NORMAL | REGULATOR_MODE_STANDBY;
606	c->valid_ops_mask &= REGULATOR_CHANGE_VOLTAGE
607				| REGULATOR_CHANGE_MODE
608				| REGULATOR_CHANGE_STATUS;
609	switch (id) {
610	case TWL4030_REG_VIO:
611	case TWL4030_REG_VDD1:
612	case TWL4030_REG_VDD2:
613	case TWL4030_REG_VPLL1:
614	case TWL4030_REG_VINTANA1:
615	case TWL4030_REG_VINTANA2:
616	case TWL4030_REG_VINTDIG:
617		c->always_on = true;
618		break;
619	default:
620		break;
621	}
622
623	config.dev = &pdev->dev;
624	config.init_data = initdata;
625	config.driver_data = info;
626	config.of_node = pdev->dev.of_node;
627
628	rdev = devm_regulator_register(&pdev->dev, &info->desc, &config);
629	if (IS_ERR(rdev)) {
630		dev_err(&pdev->dev, "can't register %s, %ld\n",
631				info->desc.name, PTR_ERR(rdev));
632		return PTR_ERR(rdev);
633	}
634	platform_set_drvdata(pdev, rdev);
635
636	twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_REMAP, info->remap);
637
638	/* NOTE:  many regulators support short-circuit IRQs (presentable
639	 * as REGULATOR_OVER_CURRENT notifications?) configured via:
640	 *  - SC_CONFIG
641	 *  - SC_DETECT1 (vintana2, vmmc1/2, vaux1/2/3/4)
642	 *  - SC_DETECT2 (vusb, vdac, vio, vdd1/2, vpll2)
643	 *  - IT_CONFIG
644	 */
645
646	return 0;
647}
648
649MODULE_ALIAS("platform:twl4030_reg");
650
651static struct platform_driver twlreg_driver = {
652	.probe		= twlreg_probe,
653	/* NOTE: short name, to work around driver model truncation of
654	 * "twl_regulator.12" (and friends) to "twl_regulator.1".
655	 */
656	.driver  = {
657		.name  = "twl4030_reg",
658		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
659		.of_match_table = of_match_ptr(twl_of_match),
660	},
661};
662
663static int __init twlreg_init(void)
664{
665	return platform_driver_register(&twlreg_driver);
666}
667subsys_initcall(twlreg_init);
668
669static void __exit twlreg_exit(void)
670{
671	platform_driver_unregister(&twlreg_driver);
672}
673module_exit(twlreg_exit)
674
675MODULE_DESCRIPTION("TWL4030 regulator driver");
676MODULE_LICENSE("GPL");
v5.4
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * twl-regulator.c -- support regulators in twl4030/twl6030 family chips
  4 *
  5 * Copyright (C) 2008 David Brownell
  6 */
  7
  8#include <linux/module.h>
  9#include <linux/string.h>
 10#include <linux/slab.h>
 11#include <linux/init.h>
 12#include <linux/err.h>
 13#include <linux/platform_device.h>
 14#include <linux/of.h>
 15#include <linux/of_device.h>
 16#include <linux/regulator/driver.h>
 17#include <linux/regulator/machine.h>
 18#include <linux/regulator/of_regulator.h>
 19#include <linux/mfd/twl.h>
 20#include <linux/delay.h>
 21
 22/*
 23 * The TWL4030/TW5030/TPS659x0 family chips include power management, a
 24 * USB OTG transceiver, an RTC, ADC, PWM, and lots more.  Some versions
 25 * include an audio codec, battery charger, and more voltage regulators.
 26 * These chips are often used in OMAP-based systems.
 27 *
 28 * This driver implements software-based resource control for various
 29 * voltage regulators.  This is usually augmented with state machine
 30 * based control.
 31 */
 32
 33struct twlreg_info {
 34	/* start of regulator's PM_RECEIVER control register bank */
 35	u8			base;
 36
 37	/* twl resource ID, for resource control state machine */
 38	u8			id;
 39
 40	/* voltage in mV = table[VSEL]; table_len must be a power-of-two */
 41	u8			table_len;
 42	const u16		*table;
 43
 44	/* State REMAP default configuration */
 45	u8			remap;
 46
 47	/* used by regulator core */
 48	struct regulator_desc	desc;
 49
 50	/* chip specific features */
 51	unsigned long		features;
 52
 53	/* data passed from board for external get/set voltage */
 54	void			*data;
 55};
 56
 57
 58/* LDO control registers ... offset is from the base of its register bank.
 59 * The first three registers of all power resource banks help hardware to
 60 * manage the various resource groups.
 61 */
 62/* Common offset in TWL4030/6030 */
 63#define VREG_GRP		0
 64/* TWL4030 register offsets */
 65#define VREG_TYPE		1
 66#define VREG_REMAP		2
 67#define VREG_DEDICATED		3	/* LDO control */
 68#define VREG_VOLTAGE_SMPS_4030	9
 69/* TWL6030 register offsets */
 70#define VREG_TRANS		1
 71#define VREG_STATE		2
 72#define VREG_VOLTAGE		3
 73#define VREG_VOLTAGE_SMPS	4
 74
 75static inline int
 76twlreg_read(struct twlreg_info *info, unsigned slave_subgp, unsigned offset)
 77{
 78	u8 value;
 79	int status;
 80
 81	status = twl_i2c_read_u8(slave_subgp,
 82			&value, info->base + offset);
 83	return (status < 0) ? status : value;
 84}
 85
 86static inline int
 87twlreg_write(struct twlreg_info *info, unsigned slave_subgp, unsigned offset,
 88						 u8 value)
 89{
 90	return twl_i2c_write_u8(slave_subgp,
 91			value, info->base + offset);
 92}
 93
 94/*----------------------------------------------------------------------*/
 95
 96/* generic power resource operations, which work on all regulators */
 97
 98static int twlreg_grp(struct regulator_dev *rdev)
 99{
100	return twlreg_read(rdev_get_drvdata(rdev), TWL_MODULE_PM_RECEIVER,
101								 VREG_GRP);
102}
103
104/*
105 * Enable/disable regulators by joining/leaving the P1 (processor) group.
106 * We assume nobody else is updating the DEV_GRP registers.
107 */
108/* definition for 4030 family */
109#define P3_GRP_4030	BIT(7)		/* "peripherals" */
110#define P2_GRP_4030	BIT(6)		/* secondary processor, modem, etc */
111#define P1_GRP_4030	BIT(5)		/* CPU/Linux */
112/* definition for 6030 family */
113#define P3_GRP_6030	BIT(2)		/* secondary processor, modem, etc */
114#define P2_GRP_6030	BIT(1)		/* "peripherals" */
115#define P1_GRP_6030	BIT(0)		/* CPU/Linux */
116
117static int twl4030reg_is_enabled(struct regulator_dev *rdev)
118{
119	int	state = twlreg_grp(rdev);
120
121	if (state < 0)
122		return state;
123
124	return state & P1_GRP_4030;
125}
126
127#define PB_I2C_BUSY	BIT(0)
128#define PB_I2C_BWEN	BIT(1)
129
130/* Wait until buffer empty/ready to send a word on power bus. */
131static int twl4030_wait_pb_ready(void)
132{
133
134	int	ret;
135	int	timeout = 10;
136	u8	val;
137
138	do {
139		ret = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &val,
140				      TWL4030_PM_MASTER_PB_CFG);
141		if (ret < 0)
142			return ret;
143
144		if (!(val & PB_I2C_BUSY))
145			return 0;
146
147		mdelay(1);
148		timeout--;
149	} while (timeout);
150
151	return -ETIMEDOUT;
152}
153
154/* Send a word over the powerbus */
155static int twl4030_send_pb_msg(unsigned msg)
156{
157	u8	val;
158	int	ret;
159
160	/* save powerbus configuration */
161	ret = twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &val,
162			      TWL4030_PM_MASTER_PB_CFG);
163	if (ret < 0)
164		return ret;
165
166	/* Enable i2c access to powerbus */
167	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, val | PB_I2C_BWEN,
168			       TWL4030_PM_MASTER_PB_CFG);
169	if (ret < 0)
170		return ret;
171
172	ret = twl4030_wait_pb_ready();
173	if (ret < 0)
174		return ret;
175
176	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, msg >> 8,
177			       TWL4030_PM_MASTER_PB_WORD_MSB);
178	if (ret < 0)
179		return ret;
180
181	ret = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, msg & 0xff,
182			       TWL4030_PM_MASTER_PB_WORD_LSB);
183	if (ret < 0)
184		return ret;
185
186	ret = twl4030_wait_pb_ready();
187	if (ret < 0)
188		return ret;
189
190	/* Restore powerbus configuration */
191	return twl_i2c_write_u8(TWL_MODULE_PM_MASTER, val,
192				TWL4030_PM_MASTER_PB_CFG);
193}
194
195static int twl4030reg_enable(struct regulator_dev *rdev)
196{
197	struct twlreg_info	*info = rdev_get_drvdata(rdev);
198	int			grp;
199	int			ret;
200
201	grp = twlreg_grp(rdev);
202	if (grp < 0)
203		return grp;
204
205	grp |= P1_GRP_4030;
206
207	ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_GRP, grp);
208
209	return ret;
210}
211
212static int twl4030reg_disable(struct regulator_dev *rdev)
213{
214	struct twlreg_info	*info = rdev_get_drvdata(rdev);
215	int			grp;
216	int			ret;
217
218	grp = twlreg_grp(rdev);
219	if (grp < 0)
220		return grp;
221
222	grp &= ~(P1_GRP_4030 | P2_GRP_4030 | P3_GRP_4030);
223
224	ret = twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_GRP, grp);
225
226	return ret;
227}
228
229static int twl4030reg_get_status(struct regulator_dev *rdev)
230{
231	int	state = twlreg_grp(rdev);
232
233	if (state < 0)
234		return state;
235	state &= 0x0f;
236
237	/* assume state != WARM_RESET; we'd not be running...  */
238	if (!state)
239		return REGULATOR_STATUS_OFF;
240	return (state & BIT(3))
241		? REGULATOR_STATUS_NORMAL
242		: REGULATOR_STATUS_STANDBY;
243}
244
245static int twl4030reg_set_mode(struct regulator_dev *rdev, unsigned mode)
246{
247	struct twlreg_info	*info = rdev_get_drvdata(rdev);
248	unsigned		message;
249
250	/* We can only set the mode through state machine commands... */
251	switch (mode) {
252	case REGULATOR_MODE_NORMAL:
253		message = MSG_SINGULAR(DEV_GRP_P1, info->id, RES_STATE_ACTIVE);
254		break;
255	case REGULATOR_MODE_STANDBY:
256		message = MSG_SINGULAR(DEV_GRP_P1, info->id, RES_STATE_SLEEP);
257		break;
258	default:
259		return -EINVAL;
260	}
261
262	return twl4030_send_pb_msg(message);
263}
264
265static inline unsigned int twl4030reg_map_mode(unsigned int mode)
266{
267	switch (mode) {
268	case RES_STATE_ACTIVE:
269		return REGULATOR_MODE_NORMAL;
270	case RES_STATE_SLEEP:
271		return REGULATOR_MODE_STANDBY;
272	default:
273		return REGULATOR_MODE_INVALID;
274	}
275}
276
277/*----------------------------------------------------------------------*/
278
279/*
280 * Support for adjustable-voltage LDOs uses a four bit (or less) voltage
281 * select field in its control register.   We use tables indexed by VSEL
282 * to record voltages in milliVolts.  (Accuracy is about three percent.)
283 *
284 * Note that VSEL values for VAUX2 changed in twl5030 and newer silicon;
285 * currently handled by listing two slightly different VAUX2 regulators,
286 * only one of which will be configured.
287 *
288 * VSEL values documented as "TI cannot support these values" are flagged
289 * in these tables as UNSUP() values; we normally won't assign them.
290 *
291 * VAUX3 at 3V is incorrectly listed in some TI manuals as unsupported.
292 * TI are revising the twl5030/tps659x0 specs to support that 3.0V setting.
293 */
294#define UNSUP_MASK	0x8000
295
296#define UNSUP(x)	(UNSUP_MASK | (x))
297#define IS_UNSUP(info, x)			\
298	((UNSUP_MASK & (x)) &&			\
299	 !((info)->features & TWL4030_ALLOW_UNSUPPORTED))
300#define LDO_MV(x)	(~UNSUP_MASK & (x))
301
302
303static const u16 VAUX1_VSEL_table[] = {
304	UNSUP(1500), UNSUP(1800), 2500, 2800,
305	3000, 3000, 3000, 3000,
306};
307static const u16 VAUX2_4030_VSEL_table[] = {
308	UNSUP(1000), UNSUP(1000), UNSUP(1200), 1300,
309	1500, 1800, UNSUP(1850), 2500,
310	UNSUP(2600), 2800, UNSUP(2850), UNSUP(3000),
311	UNSUP(3150), UNSUP(3150), UNSUP(3150), UNSUP(3150),
312};
313static const u16 VAUX2_VSEL_table[] = {
314	1700, 1700, 1900, 1300,
315	1500, 1800, 2000, 2500,
316	2100, 2800, 2200, 2300,
317	2400, 2400, 2400, 2400,
318};
319static const u16 VAUX3_VSEL_table[] = {
320	1500, 1800, 2500, 2800,
321	3000, 3000, 3000, 3000,
322};
323static const u16 VAUX4_VSEL_table[] = {
324	700, 1000, 1200, UNSUP(1300),
325	1500, 1800, UNSUP(1850), 2500,
326	UNSUP(2600), 2800, UNSUP(2850), UNSUP(3000),
327	UNSUP(3150), UNSUP(3150), UNSUP(3150), UNSUP(3150),
328};
329static const u16 VMMC1_VSEL_table[] = {
330	1850, 2850, 3000, 3150,
331};
332static const u16 VMMC2_VSEL_table[] = {
333	UNSUP(1000), UNSUP(1000), UNSUP(1200), UNSUP(1300),
334	UNSUP(1500), UNSUP(1800), 1850, UNSUP(2500),
335	2600, 2800, 2850, 3000,
336	3150, 3150, 3150, 3150,
337};
338static const u16 VPLL1_VSEL_table[] = {
339	1000, 1200, 1300, 1800,
340	UNSUP(2800), UNSUP(3000), UNSUP(3000), UNSUP(3000),
341};
342static const u16 VPLL2_VSEL_table[] = {
343	700, 1000, 1200, 1300,
344	UNSUP(1500), 1800, UNSUP(1850), UNSUP(2500),
345	UNSUP(2600), UNSUP(2800), UNSUP(2850), UNSUP(3000),
346	UNSUP(3150), UNSUP(3150), UNSUP(3150), UNSUP(3150),
347};
348static const u16 VSIM_VSEL_table[] = {
349	UNSUP(1000), UNSUP(1200), UNSUP(1300), 1800,
350	2800, 3000, 3000, 3000,
351};
352static const u16 VDAC_VSEL_table[] = {
353	1200, 1300, 1800, 1800,
354};
355static const u16 VIO_VSEL_table[] = {
356	1800, 1850,
357};
358static const u16 VINTANA2_VSEL_table[] = {
359	2500, 2750,
360};
361
362/* 600mV to 1450mV in 12.5 mV steps */
363static const struct regulator_linear_range VDD1_ranges[] = {
364	REGULATOR_LINEAR_RANGE(600000, 0, 68, 12500)
365};
366
367/* 600mV to 1450mV in 12.5 mV steps, everything above = 1500mV */
368static const struct regulator_linear_range VDD2_ranges[] = {
369	REGULATOR_LINEAR_RANGE(600000, 0, 68, 12500),
370	REGULATOR_LINEAR_RANGE(1500000, 69, 69, 12500)
371};
372
373static int twl4030ldo_list_voltage(struct regulator_dev *rdev, unsigned index)
374{
375	struct twlreg_info	*info = rdev_get_drvdata(rdev);
376	int			mV = info->table[index];
377
378	return IS_UNSUP(info, mV) ? 0 : (LDO_MV(mV) * 1000);
379}
380
381static int
382twl4030ldo_set_voltage_sel(struct regulator_dev *rdev, unsigned selector)
383{
384	struct twlreg_info	*info = rdev_get_drvdata(rdev);
385
386	return twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE,
387			    selector);
388}
389
390static int twl4030ldo_get_voltage_sel(struct regulator_dev *rdev)
391{
392	struct twlreg_info	*info = rdev_get_drvdata(rdev);
393	int vsel = twlreg_read(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE);
394
395	if (vsel < 0)
396		return vsel;
397
398	vsel &= info->table_len - 1;
399	return vsel;
400}
401
402static const struct regulator_ops twl4030ldo_ops = {
403	.list_voltage	= twl4030ldo_list_voltage,
404
405	.set_voltage_sel = twl4030ldo_set_voltage_sel,
406	.get_voltage_sel = twl4030ldo_get_voltage_sel,
407
408	.enable		= twl4030reg_enable,
409	.disable	= twl4030reg_disable,
410	.is_enabled	= twl4030reg_is_enabled,
411
412	.set_mode	= twl4030reg_set_mode,
413
414	.get_status	= twl4030reg_get_status,
415};
416
417static int
418twl4030smps_set_voltage(struct regulator_dev *rdev, int min_uV, int max_uV,
419			unsigned *selector)
420{
421	struct twlreg_info *info = rdev_get_drvdata(rdev);
422	int vsel = DIV_ROUND_UP(min_uV - 600000, 12500);
423
424	twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_VOLTAGE_SMPS_4030, vsel);
425
426	return 0;
427}
428
429static int twl4030smps_get_voltage(struct regulator_dev *rdev)
430{
431	struct twlreg_info *info = rdev_get_drvdata(rdev);
432	int vsel;
433
434	vsel = twlreg_read(info, TWL_MODULE_PM_RECEIVER,
435		VREG_VOLTAGE_SMPS_4030);
436
437	return vsel * 12500 + 600000;
438}
439
440static const struct regulator_ops twl4030smps_ops = {
441	.list_voltage   = regulator_list_voltage_linear_range,
442
443	.set_voltage	= twl4030smps_set_voltage,
444	.get_voltage	= twl4030smps_get_voltage,
445};
446
447/*----------------------------------------------------------------------*/
448
449static const struct regulator_ops twl4030fixed_ops = {
450	.list_voltage	= regulator_list_voltage_linear,
451
452	.enable		= twl4030reg_enable,
453	.disable	= twl4030reg_disable,
454	.is_enabled	= twl4030reg_is_enabled,
455
456	.set_mode	= twl4030reg_set_mode,
457
458	.get_status	= twl4030reg_get_status,
459};
460
461/*----------------------------------------------------------------------*/
462
463#define TWL4030_ADJUSTABLE_LDO(label, offset, num, turnon_delay, remap_conf) \
464static const struct twlreg_info TWL4030_INFO_##label = { \
465	.base = offset, \
466	.id = num, \
467	.table_len = ARRAY_SIZE(label##_VSEL_table), \
468	.table = label##_VSEL_table, \
469	.remap = remap_conf, \
470	.desc = { \
471		.name = #label, \
472		.id = TWL4030_REG_##label, \
473		.n_voltages = ARRAY_SIZE(label##_VSEL_table), \
474		.ops = &twl4030ldo_ops, \
475		.type = REGULATOR_VOLTAGE, \
476		.owner = THIS_MODULE, \
477		.enable_time = turnon_delay, \
478		.of_map_mode = twl4030reg_map_mode, \
479		}, \
480	}
481
482#define TWL4030_ADJUSTABLE_SMPS(label, offset, num, turnon_delay, remap_conf, \
483		n_volt) \
484static const struct twlreg_info TWL4030_INFO_##label = { \
485	.base = offset, \
486	.id = num, \
487	.remap = remap_conf, \
488	.desc = { \
489		.name = #label, \
490		.id = TWL4030_REG_##label, \
491		.ops = &twl4030smps_ops, \
492		.type = REGULATOR_VOLTAGE, \
493		.owner = THIS_MODULE, \
494		.enable_time = turnon_delay, \
495		.of_map_mode = twl4030reg_map_mode, \
496		.n_voltages = n_volt, \
497		.n_linear_ranges = ARRAY_SIZE(label ## _ranges), \
498		.linear_ranges = label ## _ranges, \
499		}, \
500	}
501
502#define TWL4030_FIXED_LDO(label, offset, mVolts, num, turnon_delay, \
503			remap_conf) \
504static const struct twlreg_info TWLFIXED_INFO_##label = { \
505	.base = offset, \
506	.id = num, \
507	.remap = remap_conf, \
508	.desc = { \
509		.name = #label, \
510		.id = TWL4030##_REG_##label, \
511		.n_voltages = 1, \
512		.ops = &twl4030fixed_ops, \
513		.type = REGULATOR_VOLTAGE, \
514		.owner = THIS_MODULE, \
515		.min_uV = mVolts * 1000, \
516		.enable_time = turnon_delay, \
517		.of_map_mode = twl4030reg_map_mode, \
518		}, \
519	}
520
521/*
522 * We list regulators here if systems need some level of
523 * software control over them after boot.
524 */
525TWL4030_ADJUSTABLE_LDO(VAUX1, 0x17, 1, 100, 0x08);
526TWL4030_ADJUSTABLE_LDO(VAUX2_4030, 0x1b, 2, 100, 0x08);
527TWL4030_ADJUSTABLE_LDO(VAUX2, 0x1b, 2, 100, 0x08);
528TWL4030_ADJUSTABLE_LDO(VAUX3, 0x1f, 3, 100, 0x08);
529TWL4030_ADJUSTABLE_LDO(VAUX4, 0x23, 4, 100, 0x08);
530TWL4030_ADJUSTABLE_LDO(VMMC1, 0x27, 5, 100, 0x08);
531TWL4030_ADJUSTABLE_LDO(VMMC2, 0x2b, 6, 100, 0x08);
532TWL4030_ADJUSTABLE_LDO(VPLL1, 0x2f, 7, 100, 0x00);
533TWL4030_ADJUSTABLE_LDO(VPLL2, 0x33, 8, 100, 0x08);
534TWL4030_ADJUSTABLE_LDO(VSIM, 0x37, 9, 100, 0x00);
535TWL4030_ADJUSTABLE_LDO(VDAC, 0x3b, 10, 100, 0x08);
536TWL4030_ADJUSTABLE_LDO(VINTANA2, 0x43, 12, 100, 0x08);
537TWL4030_ADJUSTABLE_LDO(VIO, 0x4b, 14, 1000, 0x08);
538TWL4030_ADJUSTABLE_SMPS(VDD1, 0x55, 15, 1000, 0x08, 68);
539TWL4030_ADJUSTABLE_SMPS(VDD2, 0x63, 16, 1000, 0x08, 69);
540/* VUSBCP is managed *only* by the USB subchip */
541TWL4030_FIXED_LDO(VINTANA1, 0x3f, 1500, 11, 100, 0x08);
542TWL4030_FIXED_LDO(VINTDIG, 0x47, 1500, 13, 100, 0x08);
543TWL4030_FIXED_LDO(VUSB1V5, 0x71, 1500, 17, 100, 0x08);
544TWL4030_FIXED_LDO(VUSB1V8, 0x74, 1800, 18, 100, 0x08);
545TWL4030_FIXED_LDO(VUSB3V1, 0x77, 3100, 19, 150, 0x08);
546
547#define TWL_OF_MATCH(comp, family, label) \
548	{ \
549		.compatible = comp, \
550		.data = &family##_INFO_##label, \
551	}
552
553#define TWL4030_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWL4030, label)
554#define TWL6030_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWL6030, label)
555#define TWL6032_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWL6032, label)
556#define TWLFIXED_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWLFIXED, label)
557#define TWLSMPS_OF_MATCH(comp, label) TWL_OF_MATCH(comp, TWLSMPS, label)
558
559static const struct of_device_id twl_of_match[] = {
560	TWL4030_OF_MATCH("ti,twl4030-vaux1", VAUX1),
561	TWL4030_OF_MATCH("ti,twl4030-vaux2", VAUX2_4030),
562	TWL4030_OF_MATCH("ti,twl5030-vaux2", VAUX2),
563	TWL4030_OF_MATCH("ti,twl4030-vaux3", VAUX3),
564	TWL4030_OF_MATCH("ti,twl4030-vaux4", VAUX4),
565	TWL4030_OF_MATCH("ti,twl4030-vmmc1", VMMC1),
566	TWL4030_OF_MATCH("ti,twl4030-vmmc2", VMMC2),
567	TWL4030_OF_MATCH("ti,twl4030-vpll1", VPLL1),
568	TWL4030_OF_MATCH("ti,twl4030-vpll2", VPLL2),
569	TWL4030_OF_MATCH("ti,twl4030-vsim", VSIM),
570	TWL4030_OF_MATCH("ti,twl4030-vdac", VDAC),
571	TWL4030_OF_MATCH("ti,twl4030-vintana2", VINTANA2),
572	TWL4030_OF_MATCH("ti,twl4030-vio", VIO),
573	TWL4030_OF_MATCH("ti,twl4030-vdd1", VDD1),
574	TWL4030_OF_MATCH("ti,twl4030-vdd2", VDD2),
575	TWLFIXED_OF_MATCH("ti,twl4030-vintana1", VINTANA1),
576	TWLFIXED_OF_MATCH("ti,twl4030-vintdig", VINTDIG),
577	TWLFIXED_OF_MATCH("ti,twl4030-vusb1v5", VUSB1V5),
578	TWLFIXED_OF_MATCH("ti,twl4030-vusb1v8", VUSB1V8),
579	TWLFIXED_OF_MATCH("ti,twl4030-vusb3v1", VUSB3V1),
580	{},
581};
582MODULE_DEVICE_TABLE(of, twl_of_match);
583
584static int twlreg_probe(struct platform_device *pdev)
585{
586	int id;
587	struct twlreg_info		*info;
588	const struct twlreg_info	*template;
589	struct regulator_init_data	*initdata;
590	struct regulation_constraints	*c;
591	struct regulator_dev		*rdev;
592	struct regulator_config		config = { };
593
594	template = of_device_get_match_data(&pdev->dev);
595	if (!template)
596		return -ENODEV;
597
598	id = template->desc.id;
599	initdata = of_get_regulator_init_data(&pdev->dev, pdev->dev.of_node,
600						&template->desc);
601	if (!initdata)
602		return -EINVAL;
603
604	info = devm_kmemdup(&pdev->dev, template, sizeof(*info), GFP_KERNEL);
605	if (!info)
606		return -ENOMEM;
607
608	/* Constrain board-specific capabilities according to what
609	 * this driver and the chip itself can actually do.
610	 */
611	c = &initdata->constraints;
612	c->valid_modes_mask &= REGULATOR_MODE_NORMAL | REGULATOR_MODE_STANDBY;
613	c->valid_ops_mask &= REGULATOR_CHANGE_VOLTAGE
614				| REGULATOR_CHANGE_MODE
615				| REGULATOR_CHANGE_STATUS;
616	switch (id) {
617	case TWL4030_REG_VIO:
618	case TWL4030_REG_VDD1:
619	case TWL4030_REG_VDD2:
620	case TWL4030_REG_VPLL1:
621	case TWL4030_REG_VINTANA1:
622	case TWL4030_REG_VINTANA2:
623	case TWL4030_REG_VINTDIG:
624		c->always_on = true;
625		break;
626	default:
627		break;
628	}
629
630	config.dev = &pdev->dev;
631	config.init_data = initdata;
632	config.driver_data = info;
633	config.of_node = pdev->dev.of_node;
634
635	rdev = devm_regulator_register(&pdev->dev, &info->desc, &config);
636	if (IS_ERR(rdev)) {
637		dev_err(&pdev->dev, "can't register %s, %ld\n",
638				info->desc.name, PTR_ERR(rdev));
639		return PTR_ERR(rdev);
640	}
641	platform_set_drvdata(pdev, rdev);
642
643	twlreg_write(info, TWL_MODULE_PM_RECEIVER, VREG_REMAP, info->remap);
644
645	/* NOTE:  many regulators support short-circuit IRQs (presentable
646	 * as REGULATOR_OVER_CURRENT notifications?) configured via:
647	 *  - SC_CONFIG
648	 *  - SC_DETECT1 (vintana2, vmmc1/2, vaux1/2/3/4)
649	 *  - SC_DETECT2 (vusb, vdac, vio, vdd1/2, vpll2)
650	 *  - IT_CONFIG
651	 */
652
653	return 0;
654}
655
656MODULE_ALIAS("platform:twl4030_reg");
657
658static struct platform_driver twlreg_driver = {
659	.probe		= twlreg_probe,
660	/* NOTE: short name, to work around driver model truncation of
661	 * "twl_regulator.12" (and friends) to "twl_regulator.1".
662	 */
663	.driver  = {
664		.name  = "twl4030_reg",
 
665		.of_match_table = of_match_ptr(twl_of_match),
666	},
667};
668
669static int __init twlreg_init(void)
670{
671	return platform_driver_register(&twlreg_driver);
672}
673subsys_initcall(twlreg_init);
674
675static void __exit twlreg_exit(void)
676{
677	platform_driver_unregister(&twlreg_driver);
678}
679module_exit(twlreg_exit)
680
681MODULE_DESCRIPTION("TWL4030 regulator driver");
682MODULE_LICENSE("GPL");