1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Texas Instruments SoC Adaptive Body Bias(ABB) Regulator
4  *
5  * Copyright (C) 2011 Texas Instruments, Inc.
6  * Mike Turquette <mturquette@ti.com>
7  *
8  * Copyright (C) 2012-2013 Texas Instruments, Inc.
9  * Andrii Tseglytskyi <andrii.tseglytskyi@ti.com>
10  * Nishanth Menon <nm@ti.com>
11  */
12 #include <linux/clk.h>
13 #include <linux/delay.h>
14 #include <linux/err.h>
15 #include <linux/io.h>
16 #include <linux/module.h>
17 #include <linux/of_device.h>
18 #include <linux/of.h>
19 #include <linux/platform_device.h>
20 #include <linux/regulator/driver.h>
21 #include <linux/regulator/machine.h>
22 #include <linux/regulator/of_regulator.h>
23 
24 /*
25  * ABB LDO operating states:
26  * NOMINAL_OPP:	bypasses the ABB LDO
27  * FAST_OPP:	sets ABB LDO to Forward Body-Bias
28  * SLOW_OPP:	sets ABB LDO to Reverse Body-Bias
29  */
30 #define TI_ABB_NOMINAL_OPP	0
31 #define TI_ABB_FAST_OPP		1
32 #define TI_ABB_SLOW_OPP		3
33 
34 /**
35  * struct ti_abb_info - ABB information per voltage setting
36  * @opp_sel:	one of TI_ABB macro
37  * @vset:	(optional) vset value that LDOVBB needs to be overridden with.
38  *
39  * Array of per voltage entries organized in the same order as regulator_desc's
40  * volt_table list. (selector is used to index from this array)
41  */
42 struct ti_abb_info {
43 	u32 opp_sel;
44 	u32 vset;
45 };
46 
47 /**
48  * struct ti_abb_reg - Register description for ABB block
49  * @setup_off:			setup register offset from base
50  * @control_off:		control register offset from base
51  * @sr2_wtcnt_value_mask:	setup register- sr2_wtcnt_value mask
52  * @fbb_sel_mask:		setup register- FBB sel mask
53  * @rbb_sel_mask:		setup register- RBB sel mask
54  * @sr2_en_mask:		setup register- enable mask
55  * @opp_change_mask:		control register - mask to trigger LDOVBB change
56  * @opp_sel_mask:		control register - mask for mode to operate
57  */
58 struct ti_abb_reg {
59 	u32 setup_off;
60 	u32 control_off;
61 
62 	/* Setup register fields */
63 	u32 sr2_wtcnt_value_mask;
64 	u32 fbb_sel_mask;
65 	u32 rbb_sel_mask;
66 	u32 sr2_en_mask;
67 
68 	/* Control register fields */
69 	u32 opp_change_mask;
70 	u32 opp_sel_mask;
71 };
72 
73 /**
74  * struct ti_abb - ABB instance data
75  * @rdesc:			regulator descriptor
76  * @clk:			clock(usually sysclk) supplying ABB block
77  * @base:			base address of ABB block
78  * @setup_reg:			setup register of ABB block
79  * @control_reg:		control register of ABB block
80  * @int_base:			interrupt register base address
81  * @efuse_base:			(optional) efuse base address for ABB modes
82  * @ldo_base:			(optional) LDOVBB vset override base address
83  * @regs:			pointer to struct ti_abb_reg for ABB block
84  * @txdone_mask:		mask on int_base for tranxdone interrupt
85  * @ldovbb_override_mask:	mask to ldo_base for overriding default LDO VBB
86  *				vset with value from efuse
87  * @ldovbb_vset_mask:		mask to ldo_base for providing the VSET override
88  * @info:			array to per voltage ABB configuration
89  * @current_info_idx:		current index to info
90  * @settling_time:		SoC specific settling time for LDO VBB
91  */
92 struct ti_abb {
93 	struct regulator_desc rdesc;
94 	struct clk *clk;
95 	void __iomem *base;
96 	void __iomem *setup_reg;
97 	void __iomem *control_reg;
98 	void __iomem *int_base;
99 	void __iomem *efuse_base;
100 	void __iomem *ldo_base;
101 
102 	const struct ti_abb_reg *regs;
103 	u32 txdone_mask;
104 	u32 ldovbb_override_mask;
105 	u32 ldovbb_vset_mask;
106 
107 	struct ti_abb_info *info;
108 	int current_info_idx;
109 
110 	u32 settling_time;
111 };
112 
113 /**
114  * ti_abb_rmw() - handy wrapper to set specific register bits
115  * @mask:	mask for register field
116  * @value:	value shifted to mask location and written
117  * @reg:	register address
118  *
119  * Return: final register value (may be unused)
120  */
ti_abb_rmw(u32 mask,u32 value,void __iomem * reg)121 static inline u32 ti_abb_rmw(u32 mask, u32 value, void __iomem *reg)
122 {
123 	u32 val;
124 
125 	val = readl(reg);
126 	val &= ~mask;
127 	val |= (value << __ffs(mask)) & mask;
128 	writel(val, reg);
129 
130 	return val;
131 }
132 
133 /**
134  * ti_abb_check_txdone() - handy wrapper to check ABB tranxdone status
135  * @abb:	pointer to the abb instance
136  *
137  * Return: true or false
138  */
ti_abb_check_txdone(const struct ti_abb * abb)139 static inline bool ti_abb_check_txdone(const struct ti_abb *abb)
140 {
141 	return !!(readl(abb->int_base) & abb->txdone_mask);
142 }
143 
144 /**
145  * ti_abb_clear_txdone() - handy wrapper to clear ABB tranxdone status
146  * @abb:	pointer to the abb instance
147  */
ti_abb_clear_txdone(const struct ti_abb * abb)148 static inline void ti_abb_clear_txdone(const struct ti_abb *abb)
149 {
150 	writel(abb->txdone_mask, abb->int_base);
151 };
152 
153 /**
154  * ti_abb_wait_txdone() - waits for ABB tranxdone event
155  * @dev:	device
156  * @abb:	pointer to the abb instance
157  *
158  * Return: 0 on success or -ETIMEDOUT if the event is not cleared on time.
159  */
ti_abb_wait_txdone(struct device * dev,struct ti_abb * abb)160 static int ti_abb_wait_txdone(struct device *dev, struct ti_abb *abb)
161 {
162 	int timeout = 0;
163 	bool status;
164 
165 	while (timeout++ <= abb->settling_time) {
166 		status = ti_abb_check_txdone(abb);
167 		if (status)
168 			return 0;
169 
170 		udelay(1);
171 	}
172 
173 	dev_warn_ratelimited(dev, "%s:TRANXDONE timeout(%duS) int=0x%08x\n",
174 			     __func__, timeout, readl(abb->int_base));
175 	return -ETIMEDOUT;
176 }
177 
178 /**
179  * ti_abb_clear_all_txdone() - clears ABB tranxdone event
180  * @dev:	device
181  * @abb:	pointer to the abb instance
182  *
183  * Return: 0 on success or -ETIMEDOUT if the event is not cleared on time.
184  */
ti_abb_clear_all_txdone(struct device * dev,const struct ti_abb * abb)185 static int ti_abb_clear_all_txdone(struct device *dev, const struct ti_abb *abb)
186 {
187 	int timeout = 0;
188 	bool status;
189 
190 	while (timeout++ <= abb->settling_time) {
191 		ti_abb_clear_txdone(abb);
192 
193 		status = ti_abb_check_txdone(abb);
194 		if (!status)
195 			return 0;
196 
197 		udelay(1);
198 	}
199 
200 	dev_warn_ratelimited(dev, "%s:TRANXDONE timeout(%duS) int=0x%08x\n",
201 			     __func__, timeout, readl(abb->int_base));
202 	return -ETIMEDOUT;
203 }
204 
205 /**
206  * ti_abb_program_ldovbb() - program LDOVBB register for override value
207  * @dev:	device
208  * @abb:	pointer to the abb instance
209  * @info:	ABB info to program
210  */
ti_abb_program_ldovbb(struct device * dev,const struct ti_abb * abb,struct ti_abb_info * info)211 static void ti_abb_program_ldovbb(struct device *dev, const struct ti_abb *abb,
212 				  struct ti_abb_info *info)
213 {
214 	u32 val;
215 
216 	val = readl(abb->ldo_base);
217 	/* clear up previous values */
218 	val &= ~(abb->ldovbb_override_mask | abb->ldovbb_vset_mask);
219 
220 	switch (info->opp_sel) {
221 	case TI_ABB_SLOW_OPP:
222 	case TI_ABB_FAST_OPP:
223 		val |= abb->ldovbb_override_mask;
224 		val |= info->vset << __ffs(abb->ldovbb_vset_mask);
225 		break;
226 	}
227 
228 	writel(val, abb->ldo_base);
229 }
230 
231 /**
232  * ti_abb_set_opp() - Setup ABB and LDO VBB for required bias
233  * @rdev:	regulator device
234  * @abb:	pointer to the abb instance
235  * @info:	ABB info to program
236  *
237  * Return: 0 on success or appropriate error value when fails
238  */
ti_abb_set_opp(struct regulator_dev * rdev,struct ti_abb * abb,struct ti_abb_info * info)239 static int ti_abb_set_opp(struct regulator_dev *rdev, struct ti_abb *abb,
240 			  struct ti_abb_info *info)
241 {
242 	const struct ti_abb_reg *regs = abb->regs;
243 	struct device *dev = &rdev->dev;
244 	int ret;
245 
246 	ret = ti_abb_clear_all_txdone(dev, abb);
247 	if (ret)
248 		goto out;
249 
250 	ti_abb_rmw(regs->fbb_sel_mask | regs->rbb_sel_mask, 0, abb->setup_reg);
251 
252 	switch (info->opp_sel) {
253 	case TI_ABB_SLOW_OPP:
254 		ti_abb_rmw(regs->rbb_sel_mask, 1, abb->setup_reg);
255 		break;
256 	case TI_ABB_FAST_OPP:
257 		ti_abb_rmw(regs->fbb_sel_mask, 1, abb->setup_reg);
258 		break;
259 	}
260 
261 	/* program next state of ABB ldo */
262 	ti_abb_rmw(regs->opp_sel_mask, info->opp_sel, abb->control_reg);
263 
264 	/*
265 	 * program LDO VBB vset override if needed for !bypass mode
266 	 * XXX: Do not switch sequence - for !bypass, LDO override reset *must*
267 	 * be performed *before* switch to bias mode else VBB glitches.
268 	 */
269 	if (abb->ldo_base && info->opp_sel != TI_ABB_NOMINAL_OPP)
270 		ti_abb_program_ldovbb(dev, abb, info);
271 
272 	/* Initiate ABB ldo change */
273 	ti_abb_rmw(regs->opp_change_mask, 1, abb->control_reg);
274 
275 	/* Wait for ABB LDO to complete transition to new Bias setting */
276 	ret = ti_abb_wait_txdone(dev, abb);
277 	if (ret)
278 		goto out;
279 
280 	ret = ti_abb_clear_all_txdone(dev, abb);
281 	if (ret)
282 		goto out;
283 
284 	/*
285 	 * Reset LDO VBB vset override bypass mode
286 	 * XXX: Do not switch sequence - for bypass, LDO override reset *must*
287 	 * be performed *after* switch to bypass else VBB glitches.
288 	 */
289 	if (abb->ldo_base && info->opp_sel == TI_ABB_NOMINAL_OPP)
290 		ti_abb_program_ldovbb(dev, abb, info);
291 
292 out:
293 	return ret;
294 }
295 
296 /**
297  * ti_abb_set_voltage_sel() - regulator accessor function to set ABB LDO
298  * @rdev:	regulator device
299  * @sel:	selector to index into required ABB LDO settings (maps to
300  *		regulator descriptor's volt_table)
301  *
302  * Return: 0 on success or appropriate error value when fails
303  */
ti_abb_set_voltage_sel(struct regulator_dev * rdev,unsigned int sel)304 static int ti_abb_set_voltage_sel(struct regulator_dev *rdev, unsigned int sel)
305 {
306 	const struct regulator_desc *desc = rdev->desc;
307 	struct ti_abb *abb = rdev_get_drvdata(rdev);
308 	struct device *dev = &rdev->dev;
309 	struct ti_abb_info *info, *oinfo;
310 	int ret = 0;
311 
312 	if (!abb) {
313 		dev_err_ratelimited(dev, "%s: No regulator drvdata\n",
314 				    __func__);
315 		return -ENODEV;
316 	}
317 
318 	if (!desc->n_voltages || !abb->info) {
319 		dev_err_ratelimited(dev,
320 				    "%s: No valid voltage table entries?\n",
321 				    __func__);
322 		return -EINVAL;
323 	}
324 
325 	if (sel >= desc->n_voltages) {
326 		dev_err(dev, "%s: sel idx(%d) >= n_voltages(%d)\n", __func__,
327 			sel, desc->n_voltages);
328 		return -EINVAL;
329 	}
330 
331 	/* If we are in the same index as we were, nothing to do here! */
332 	if (sel == abb->current_info_idx) {
333 		dev_dbg(dev, "%s: Already at sel=%d\n", __func__, sel);
334 		return ret;
335 	}
336 
337 	info = &abb->info[sel];
338 	/*
339 	 * When Linux kernel is starting up, we aren't sure of the
340 	 * Bias configuration that bootloader has configured.
341 	 * So, we get to know the actual setting the first time
342 	 * we are asked to transition.
343 	 */
344 	if (abb->current_info_idx == -EINVAL)
345 		goto just_set_abb;
346 
347 	/* If data is exactly the same, then just update index, no change */
348 	oinfo = &abb->info[abb->current_info_idx];
349 	if (!memcmp(info, oinfo, sizeof(*info))) {
350 		dev_dbg(dev, "%s: Same data new idx=%d, old idx=%d\n", __func__,
351 			sel, abb->current_info_idx);
352 		goto out;
353 	}
354 
355 just_set_abb:
356 	ret = ti_abb_set_opp(rdev, abb, info);
357 
358 out:
359 	if (!ret)
360 		abb->current_info_idx = sel;
361 	else
362 		dev_err_ratelimited(dev,
363 				    "%s: Volt[%d] idx[%d] mode[%d] Fail(%d)\n",
364 				    __func__, desc->volt_table[sel], sel,
365 				    info->opp_sel, ret);
366 	return ret;
367 }
368 
369 /**
370  * ti_abb_get_voltage_sel() - Regulator accessor to get current ABB LDO setting
371  * @rdev:	regulator device
372  *
373  * Return: 0 on success or appropriate error value when fails
374  */
ti_abb_get_voltage_sel(struct regulator_dev * rdev)375 static int ti_abb_get_voltage_sel(struct regulator_dev *rdev)
376 {
377 	const struct regulator_desc *desc = rdev->desc;
378 	struct ti_abb *abb = rdev_get_drvdata(rdev);
379 	struct device *dev = &rdev->dev;
380 
381 	if (!abb) {
382 		dev_err_ratelimited(dev, "%s: No regulator drvdata\n",
383 				    __func__);
384 		return -ENODEV;
385 	}
386 
387 	if (!desc->n_voltages || !abb->info) {
388 		dev_err_ratelimited(dev,
389 				    "%s: No valid voltage table entries?\n",
390 				    __func__);
391 		return -EINVAL;
392 	}
393 
394 	if (abb->current_info_idx >= (int)desc->n_voltages) {
395 		dev_err(dev, "%s: Corrupted data? idx(%d) >= n_voltages(%d)\n",
396 			__func__, abb->current_info_idx, desc->n_voltages);
397 		return -EINVAL;
398 	}
399 
400 	return abb->current_info_idx;
401 }
402 
403 /**
404  * ti_abb_init_timings() - setup ABB clock timing for the current platform
405  * @dev:	device
406  * @abb:	pointer to the abb instance
407  *
408  * Return: 0 if timing is updated, else returns error result.
409  */
ti_abb_init_timings(struct device * dev,struct ti_abb * abb)410 static int ti_abb_init_timings(struct device *dev, struct ti_abb *abb)
411 {
412 	u32 clock_cycles;
413 	u32 clk_rate, sr2_wt_cnt_val, cycle_rate;
414 	const struct ti_abb_reg *regs = abb->regs;
415 	int ret;
416 	char *pname = "ti,settling-time";
417 
418 	/* read device tree properties */
419 	ret = of_property_read_u32(dev->of_node, pname, &abb->settling_time);
420 	if (ret) {
421 		dev_err(dev, "Unable to get property '%s'(%d)\n", pname, ret);
422 		return ret;
423 	}
424 
425 	/* ABB LDO cannot be settle in 0 time */
426 	if (!abb->settling_time) {
427 		dev_err(dev, "Invalid property:'%s' set as 0!\n", pname);
428 		return -EINVAL;
429 	}
430 
431 	pname = "ti,clock-cycles";
432 	ret = of_property_read_u32(dev->of_node, pname, &clock_cycles);
433 	if (ret) {
434 		dev_err(dev, "Unable to get property '%s'(%d)\n", pname, ret);
435 		return ret;
436 	}
437 	/* ABB LDO cannot be settle in 0 clock cycles */
438 	if (!clock_cycles) {
439 		dev_err(dev, "Invalid property:'%s' set as 0!\n", pname);
440 		return -EINVAL;
441 	}
442 
443 	abb->clk = devm_clk_get(dev, NULL);
444 	if (IS_ERR(abb->clk)) {
445 		ret = PTR_ERR(abb->clk);
446 		dev_err(dev, "%s: Unable to get clk(%d)\n", __func__, ret);
447 		return ret;
448 	}
449 
450 	/*
451 	 * SR2_WTCNT_VALUE is the settling time for the ABB ldo after a
452 	 * transition and must be programmed with the correct time at boot.
453 	 * The value programmed into the register is the number of SYS_CLK
454 	 * clock cycles that match a given wall time profiled for the ldo.
455 	 * This value depends on:
456 	 * settling time of ldo in micro-seconds (varies per OMAP family)
457 	 * # of clock cycles per SYS_CLK period (varies per OMAP family)
458 	 * the SYS_CLK frequency in MHz (varies per board)
459 	 * The formula is:
460 	 *
461 	 *                      ldo settling time (in micro-seconds)
462 	 * SR2_WTCNT_VALUE = ------------------------------------------
463 	 *                   (# system clock cycles) * (sys_clk period)
464 	 *
465 	 * Put another way:
466 	 *
467 	 * SR2_WTCNT_VALUE = settling time / (# SYS_CLK cycles / SYS_CLK rate))
468 	 *
469 	 * To avoid dividing by zero multiply both "# clock cycles" and
470 	 * "settling time" by 10 such that the final result is the one we want.
471 	 */
472 
473 	/* Convert SYS_CLK rate to MHz & prevent divide by zero */
474 	clk_rate = DIV_ROUND_CLOSEST(clk_get_rate(abb->clk), 1000000);
475 
476 	/* Calculate cycle rate */
477 	cycle_rate = DIV_ROUND_CLOSEST(clock_cycles * 10, clk_rate);
478 
479 	/* Calculate SR2_WTCNT_VALUE */
480 	sr2_wt_cnt_val = DIV_ROUND_CLOSEST(abb->settling_time * 10, cycle_rate);
481 
482 	dev_dbg(dev, "%s: Clk_rate=%ld, sr2_cnt=0x%08x\n", __func__,
483 		clk_get_rate(abb->clk), sr2_wt_cnt_val);
484 
485 	ti_abb_rmw(regs->sr2_wtcnt_value_mask, sr2_wt_cnt_val, abb->setup_reg);
486 
487 	return 0;
488 }
489 
490 /**
491  * ti_abb_init_table() - Initialize ABB table from device tree
492  * @dev:	device
493  * @abb:	pointer to the abb instance
494  * @rinit_data:	regulator initdata
495  *
496  * Return: 0 on success or appropriate error value when fails
497  */
ti_abb_init_table(struct device * dev,struct ti_abb * abb,struct regulator_init_data * rinit_data)498 static int ti_abb_init_table(struct device *dev, struct ti_abb *abb,
499 			     struct regulator_init_data *rinit_data)
500 {
501 	struct ti_abb_info *info;
502 	const u32 num_values = 6;
503 	char *pname = "ti,abb_info";
504 	u32 i;
505 	unsigned int *volt_table;
506 	int num_entries, min_uV = INT_MAX, max_uV = 0;
507 	struct regulation_constraints *c = &rinit_data->constraints;
508 
509 	/*
510 	 * Each abb_info is a set of n-tuple, where n is num_values, consisting
511 	 * of voltage and a set of detection logic for ABB information for that
512 	 * voltage to apply.
513 	 */
514 	num_entries = of_property_count_u32_elems(dev->of_node, pname);
515 	if (num_entries < 0) {
516 		dev_err(dev, "No '%s' property?\n", pname);
517 		return num_entries;
518 	}
519 
520 	if (!num_entries || (num_entries % num_values)) {
521 		dev_err(dev, "All '%s' list entries need %d vals\n", pname,
522 			num_values);
523 		return -EINVAL;
524 	}
525 	num_entries /= num_values;
526 
527 	info = devm_kcalloc(dev, num_entries, sizeof(*info), GFP_KERNEL);
528 	if (!info)
529 		return -ENOMEM;
530 
531 	abb->info = info;
532 
533 	volt_table = devm_kcalloc(dev, num_entries, sizeof(unsigned int),
534 				  GFP_KERNEL);
535 	if (!volt_table)
536 		return -ENOMEM;
537 
538 	abb->rdesc.n_voltages = num_entries;
539 	abb->rdesc.volt_table = volt_table;
540 	/* We do not know where the OPP voltage is at the moment */
541 	abb->current_info_idx = -EINVAL;
542 
543 	for (i = 0; i < num_entries; i++, info++, volt_table++) {
544 		u32 efuse_offset, rbb_mask, fbb_mask, vset_mask;
545 		u32 efuse_val;
546 
547 		/* NOTE: num_values should equal to entries picked up here */
548 		of_property_read_u32_index(dev->of_node, pname, i * num_values,
549 					   volt_table);
550 		of_property_read_u32_index(dev->of_node, pname,
551 					   i * num_values + 1, &info->opp_sel);
552 		of_property_read_u32_index(dev->of_node, pname,
553 					   i * num_values + 2, &efuse_offset);
554 		of_property_read_u32_index(dev->of_node, pname,
555 					   i * num_values + 3, &rbb_mask);
556 		of_property_read_u32_index(dev->of_node, pname,
557 					   i * num_values + 4, &fbb_mask);
558 		of_property_read_u32_index(dev->of_node, pname,
559 					   i * num_values + 5, &vset_mask);
560 
561 		dev_dbg(dev,
562 			"[%d]v=%d ABB=%d ef=0x%x rbb=0x%x fbb=0x%x vset=0x%x\n",
563 			i, *volt_table, info->opp_sel, efuse_offset, rbb_mask,
564 			fbb_mask, vset_mask);
565 
566 		/* Find min/max for voltage set */
567 		if (min_uV > *volt_table)
568 			min_uV = *volt_table;
569 		if (max_uV < *volt_table)
570 			max_uV = *volt_table;
571 
572 		if (!abb->efuse_base) {
573 			/* Ignore invalid data, but warn to help cleanup */
574 			if (efuse_offset || rbb_mask || fbb_mask || vset_mask)
575 				dev_err(dev, "prop '%s': v=%d,bad efuse/mask\n",
576 					pname, *volt_table);
577 			goto check_abb;
578 		}
579 
580 		efuse_val = readl(abb->efuse_base + efuse_offset);
581 
582 		/* Use ABB recommendation from Efuse */
583 		if (efuse_val & rbb_mask)
584 			info->opp_sel = TI_ABB_SLOW_OPP;
585 		else if (efuse_val & fbb_mask)
586 			info->opp_sel = TI_ABB_FAST_OPP;
587 		else if (rbb_mask || fbb_mask)
588 			info->opp_sel = TI_ABB_NOMINAL_OPP;
589 
590 		dev_dbg(dev,
591 			"[%d]v=%d efusev=0x%x final ABB=%d\n",
592 			i, *volt_table, efuse_val, info->opp_sel);
593 
594 		/* Use recommended Vset bits from Efuse */
595 		if (!abb->ldo_base) {
596 			if (vset_mask)
597 				dev_err(dev, "prop'%s':v=%d vst=%x LDO base?\n",
598 					pname, *volt_table, vset_mask);
599 			continue;
600 		}
601 		info->vset = (efuse_val & vset_mask) >> __ffs(vset_mask);
602 		dev_dbg(dev, "[%d]v=%d vset=%x\n", i, *volt_table, info->vset);
603 check_abb:
604 		switch (info->opp_sel) {
605 		case TI_ABB_NOMINAL_OPP:
606 		case TI_ABB_FAST_OPP:
607 		case TI_ABB_SLOW_OPP:
608 			/* Valid values */
609 			break;
610 		default:
611 			dev_err(dev, "%s:[%d]v=%d, ABB=%d is invalid! Abort!\n",
612 				__func__, i, *volt_table, info->opp_sel);
613 			return -EINVAL;
614 		}
615 	}
616 
617 	/* Setup the min/max voltage constraints from the supported list */
618 	c->min_uV = min_uV;
619 	c->max_uV = max_uV;
620 
621 	return 0;
622 }
623 
624 static const struct regulator_ops ti_abb_reg_ops = {
625 	.list_voltage = regulator_list_voltage_table,
626 
627 	.set_voltage_sel = ti_abb_set_voltage_sel,
628 	.get_voltage_sel = ti_abb_get_voltage_sel,
629 };
630 
631 /* Default ABB block offsets, IF this changes in future, create new one */
632 static const struct ti_abb_reg abb_regs_v1 = {
633 	/* WARNING: registers are wrongly documented in TRM */
634 	.setup_off		= 0x04,
635 	.control_off		= 0x00,
636 
637 	.sr2_wtcnt_value_mask	= (0xff << 8),
638 	.fbb_sel_mask		= (0x01 << 2),
639 	.rbb_sel_mask		= (0x01 << 1),
640 	.sr2_en_mask		= (0x01 << 0),
641 
642 	.opp_change_mask	= (0x01 << 2),
643 	.opp_sel_mask		= (0x03 << 0),
644 };
645 
646 static const struct ti_abb_reg abb_regs_v2 = {
647 	.setup_off		= 0x00,
648 	.control_off		= 0x04,
649 
650 	.sr2_wtcnt_value_mask	= (0xff << 8),
651 	.fbb_sel_mask		= (0x01 << 2),
652 	.rbb_sel_mask		= (0x01 << 1),
653 	.sr2_en_mask		= (0x01 << 0),
654 
655 	.opp_change_mask	= (0x01 << 2),
656 	.opp_sel_mask		= (0x03 << 0),
657 };
658 
659 static const struct ti_abb_reg abb_regs_generic = {
660 	.sr2_wtcnt_value_mask	= (0xff << 8),
661 	.fbb_sel_mask		= (0x01 << 2),
662 	.rbb_sel_mask		= (0x01 << 1),
663 	.sr2_en_mask		= (0x01 << 0),
664 
665 	.opp_change_mask	= (0x01 << 2),
666 	.opp_sel_mask		= (0x03 << 0),
667 };
668 
669 static const struct of_device_id ti_abb_of_match[] = {
670 	{.compatible = "ti,abb-v1", .data = &abb_regs_v1},
671 	{.compatible = "ti,abb-v2", .data = &abb_regs_v2},
672 	{.compatible = "ti,abb-v3", .data = &abb_regs_generic},
673 	{ },
674 };
675 
676 MODULE_DEVICE_TABLE(of, ti_abb_of_match);
677 
678 /**
679  * ti_abb_probe() - Initialize an ABB ldo instance
680  * @pdev: ABB platform device
681  *
682  * Initializes an individual ABB LDO for required Body-Bias. ABB is used to
683  * additional bias supply to SoC modules for power savings or mandatory stability
684  * configuration at certain Operating Performance Points(OPPs).
685  *
686  * Return: 0 on success or appropriate error value when fails
687  */
ti_abb_probe(struct platform_device * pdev)688 static int ti_abb_probe(struct platform_device *pdev)
689 {
690 	struct device *dev = &pdev->dev;
691 	const struct of_device_id *match;
692 	struct resource *res;
693 	struct ti_abb *abb;
694 	struct regulator_init_data *initdata = NULL;
695 	struct regulator_dev *rdev = NULL;
696 	struct regulator_desc *desc;
697 	struct regulation_constraints *c;
698 	struct regulator_config config = { };
699 	char *pname;
700 	int ret = 0;
701 
702 	match = of_match_device(ti_abb_of_match, dev);
703 	if (!match) {
704 		/* We do not expect this to happen */
705 		dev_err(dev, "%s: Unable to match device\n", __func__);
706 		return -ENODEV;
707 	}
708 	if (!match->data) {
709 		dev_err(dev, "%s: Bad data in match\n", __func__);
710 		return -EINVAL;
711 	}
712 
713 	abb = devm_kzalloc(dev, sizeof(struct ti_abb), GFP_KERNEL);
714 	if (!abb)
715 		return -ENOMEM;
716 	abb->regs = match->data;
717 
718 	/* Map ABB resources */
719 	if (abb->regs->setup_off || abb->regs->control_off) {
720 		abb->base = devm_platform_ioremap_resource_byname(pdev, "base-address");
721 		if (IS_ERR(abb->base))
722 			return PTR_ERR(abb->base);
723 
724 		abb->setup_reg = abb->base + abb->regs->setup_off;
725 		abb->control_reg = abb->base + abb->regs->control_off;
726 
727 	} else {
728 		abb->control_reg = devm_platform_ioremap_resource_byname(pdev, "control-address");
729 		if (IS_ERR(abb->control_reg))
730 			return PTR_ERR(abb->control_reg);
731 
732 		abb->setup_reg = devm_platform_ioremap_resource_byname(pdev, "setup-address");
733 		if (IS_ERR(abb->setup_reg))
734 			return PTR_ERR(abb->setup_reg);
735 	}
736 
737 	abb->int_base = devm_platform_ioremap_resource_byname(pdev, "int-address");
738 	if (IS_ERR(abb->int_base))
739 		return PTR_ERR(abb->int_base);
740 
741 	/* Map Optional resources */
742 	pname = "efuse-address";
743 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, pname);
744 	if (!res) {
745 		dev_dbg(dev, "Missing '%s' IO resource\n", pname);
746 		ret = -ENODEV;
747 		goto skip_opt;
748 	}
749 
750 	/*
751 	 * We may have shared efuse register offsets which are read-only
752 	 * between domains
753 	 */
754 	abb->efuse_base = devm_ioremap(dev, res->start,
755 					       resource_size(res));
756 	if (!abb->efuse_base) {
757 		dev_err(dev, "Unable to map '%s'\n", pname);
758 		return -ENOMEM;
759 	}
760 
761 	pname = "ldo-address";
762 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, pname);
763 	if (!res) {
764 		dev_dbg(dev, "Missing '%s' IO resource\n", pname);
765 		ret = -ENODEV;
766 		goto skip_opt;
767 	}
768 	abb->ldo_base = devm_ioremap_resource(dev, res);
769 	if (IS_ERR(abb->ldo_base))
770 		return PTR_ERR(abb->ldo_base);
771 
772 	/* IF ldo_base is set, the following are mandatory */
773 	pname = "ti,ldovbb-override-mask";
774 	ret =
775 	    of_property_read_u32(pdev->dev.of_node, pname,
776 				 &abb->ldovbb_override_mask);
777 	if (ret) {
778 		dev_err(dev, "Missing '%s' (%d)\n", pname, ret);
779 		return ret;
780 	}
781 	if (!abb->ldovbb_override_mask) {
782 		dev_err(dev, "Invalid property:'%s' set as 0!\n", pname);
783 		return -EINVAL;
784 	}
785 
786 	pname = "ti,ldovbb-vset-mask";
787 	ret =
788 	    of_property_read_u32(pdev->dev.of_node, pname,
789 				 &abb->ldovbb_vset_mask);
790 	if (ret) {
791 		dev_err(dev, "Missing '%s' (%d)\n", pname, ret);
792 		return ret;
793 	}
794 	if (!abb->ldovbb_vset_mask) {
795 		dev_err(dev, "Invalid property:'%s' set as 0!\n", pname);
796 		return -EINVAL;
797 	}
798 
799 skip_opt:
800 	pname = "ti,tranxdone-status-mask";
801 	ret =
802 	    of_property_read_u32(pdev->dev.of_node, pname,
803 				 &abb->txdone_mask);
804 	if (ret) {
805 		dev_err(dev, "Missing '%s' (%d)\n", pname, ret);
806 		return ret;
807 	}
808 	if (!abb->txdone_mask) {
809 		dev_err(dev, "Invalid property:'%s' set as 0!\n", pname);
810 		return -EINVAL;
811 	}
812 
813 	initdata = of_get_regulator_init_data(dev, pdev->dev.of_node,
814 					      &abb->rdesc);
815 	if (!initdata) {
816 		dev_err(dev, "%s: Unable to alloc regulator init data\n",
817 			__func__);
818 		return -ENOMEM;
819 	}
820 
821 	/* init ABB opp_sel table */
822 	ret = ti_abb_init_table(dev, abb, initdata);
823 	if (ret)
824 		return ret;
825 
826 	/* init ABB timing */
827 	ret = ti_abb_init_timings(dev, abb);
828 	if (ret)
829 		return ret;
830 
831 	desc = &abb->rdesc;
832 	desc->name = dev_name(dev);
833 	desc->owner = THIS_MODULE;
834 	desc->type = REGULATOR_VOLTAGE;
835 	desc->ops = &ti_abb_reg_ops;
836 
837 	c = &initdata->constraints;
838 	if (desc->n_voltages > 1)
839 		c->valid_ops_mask |= REGULATOR_CHANGE_VOLTAGE;
840 	c->always_on = true;
841 
842 	config.dev = dev;
843 	config.init_data = initdata;
844 	config.driver_data = abb;
845 	config.of_node = pdev->dev.of_node;
846 
847 	rdev = devm_regulator_register(dev, desc, &config);
848 	if (IS_ERR(rdev)) {
849 		ret = PTR_ERR(rdev);
850 		dev_err(dev, "%s: failed to register regulator(%d)\n",
851 			__func__, ret);
852 		return ret;
853 	}
854 	platform_set_drvdata(pdev, rdev);
855 
856 	/* Enable the ldo if not already done by bootloader */
857 	ti_abb_rmw(abb->regs->sr2_en_mask, 1, abb->setup_reg);
858 
859 	return 0;
860 }
861 
862 MODULE_ALIAS("platform:ti_abb");
863 
864 static struct platform_driver ti_abb_driver = {
865 	.probe = ti_abb_probe,
866 	.driver = {
867 		   .name = "ti_abb",
868 		   .of_match_table = of_match_ptr(ti_abb_of_match),
869 		   },
870 };
871 module_platform_driver(ti_abb_driver);
872 
873 MODULE_DESCRIPTION("Texas Instruments ABB LDO regulator driver");
874 MODULE_AUTHOR("Texas Instruments Inc.");
875 MODULE_LICENSE("GPL v2");
876