1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // Copyright (c) 2013 Samsung Electronics Co., Ltd
4 // http://www.samsung.com
5
6 #include <linux/bug.h>
7 #include <linux/err.h>
8 #include <linux/slab.h>
9 #include <linux/module.h>
10 #include <linux/of.h>
11 #include <linux/regmap.h>
12 #include <linux/platform_device.h>
13 #include <linux/regulator/driver.h>
14 #include <linux/regulator/machine.h>
15 #include <linux/regulator/of_regulator.h>
16 #include <linux/mfd/samsung/core.h>
17 #include <linux/mfd/samsung/s2mpa01.h>
18
19 struct s2mpa01_info {
20 int ramp_delay24;
21 int ramp_delay3;
22 int ramp_delay5;
23 int ramp_delay16;
24 int ramp_delay7;
25 int ramp_delay8910;
26 };
27
get_ramp_delay(int ramp_delay)28 static int get_ramp_delay(int ramp_delay)
29 {
30 unsigned char cnt = 0;
31
32 ramp_delay /= 6250;
33
34 while (true) {
35 ramp_delay = ramp_delay >> 1;
36 if (ramp_delay == 0)
37 break;
38 cnt++;
39 }
40
41 if (cnt > 3)
42 cnt = 3;
43
44 return cnt;
45 }
46
s2mpa01_regulator_set_voltage_time_sel(struct regulator_dev * rdev,unsigned int old_selector,unsigned int new_selector)47 static int s2mpa01_regulator_set_voltage_time_sel(struct regulator_dev *rdev,
48 unsigned int old_selector,
49 unsigned int new_selector)
50 {
51 struct s2mpa01_info *s2mpa01 = rdev_get_drvdata(rdev);
52 unsigned int ramp_delay = 0;
53 int old_volt, new_volt;
54
55 switch (rdev_get_id(rdev)) {
56 case S2MPA01_BUCK2:
57 case S2MPA01_BUCK4:
58 ramp_delay = s2mpa01->ramp_delay24;
59 break;
60 case S2MPA01_BUCK3:
61 ramp_delay = s2mpa01->ramp_delay3;
62 break;
63 case S2MPA01_BUCK5:
64 ramp_delay = s2mpa01->ramp_delay5;
65 break;
66 case S2MPA01_BUCK1:
67 case S2MPA01_BUCK6:
68 ramp_delay = s2mpa01->ramp_delay16;
69 break;
70 case S2MPA01_BUCK7:
71 ramp_delay = s2mpa01->ramp_delay7;
72 break;
73 case S2MPA01_BUCK8:
74 case S2MPA01_BUCK9:
75 case S2MPA01_BUCK10:
76 ramp_delay = s2mpa01->ramp_delay8910;
77 break;
78 }
79
80 if (ramp_delay == 0)
81 ramp_delay = rdev->desc->ramp_delay;
82
83 old_volt = rdev->desc->min_uV + (rdev->desc->uV_step * old_selector);
84 new_volt = rdev->desc->min_uV + (rdev->desc->uV_step * new_selector);
85
86 return DIV_ROUND_UP(abs(new_volt - old_volt), ramp_delay);
87 }
88
s2mpa01_set_ramp_delay(struct regulator_dev * rdev,int ramp_delay)89 static int s2mpa01_set_ramp_delay(struct regulator_dev *rdev, int ramp_delay)
90 {
91 struct s2mpa01_info *s2mpa01 = rdev_get_drvdata(rdev);
92 unsigned int ramp_val, ramp_shift, ramp_reg = S2MPA01_REG_RAMP2;
93 unsigned int ramp_enable = 1, enable_shift = 0;
94 int ret;
95
96 switch (rdev_get_id(rdev)) {
97 case S2MPA01_BUCK1:
98 enable_shift = S2MPA01_BUCK1_RAMP_EN_SHIFT;
99 if (!ramp_delay) {
100 ramp_enable = 0;
101 break;
102 }
103
104 if (ramp_delay > s2mpa01->ramp_delay16)
105 s2mpa01->ramp_delay16 = ramp_delay;
106 else
107 ramp_delay = s2mpa01->ramp_delay16;
108
109 ramp_shift = S2MPA01_BUCK16_RAMP_SHIFT;
110 break;
111 case S2MPA01_BUCK2:
112 enable_shift = S2MPA01_BUCK2_RAMP_EN_SHIFT;
113 if (!ramp_delay) {
114 ramp_enable = 0;
115 break;
116 }
117
118 if (ramp_delay > s2mpa01->ramp_delay24)
119 s2mpa01->ramp_delay24 = ramp_delay;
120 else
121 ramp_delay = s2mpa01->ramp_delay24;
122
123 ramp_shift = S2MPA01_BUCK24_RAMP_SHIFT;
124 ramp_reg = S2MPA01_REG_RAMP1;
125 break;
126 case S2MPA01_BUCK3:
127 enable_shift = S2MPA01_BUCK3_RAMP_EN_SHIFT;
128 if (!ramp_delay) {
129 ramp_enable = 0;
130 break;
131 }
132
133 s2mpa01->ramp_delay3 = ramp_delay;
134 ramp_shift = S2MPA01_BUCK3_RAMP_SHIFT;
135 ramp_reg = S2MPA01_REG_RAMP1;
136 break;
137 case S2MPA01_BUCK4:
138 enable_shift = S2MPA01_BUCK4_RAMP_EN_SHIFT;
139 if (!ramp_delay) {
140 ramp_enable = 0;
141 break;
142 }
143
144 if (ramp_delay > s2mpa01->ramp_delay24)
145 s2mpa01->ramp_delay24 = ramp_delay;
146 else
147 ramp_delay = s2mpa01->ramp_delay24;
148
149 ramp_shift = S2MPA01_BUCK24_RAMP_SHIFT;
150 ramp_reg = S2MPA01_REG_RAMP1;
151 break;
152 case S2MPA01_BUCK5:
153 s2mpa01->ramp_delay5 = ramp_delay;
154 ramp_shift = S2MPA01_BUCK5_RAMP_SHIFT;
155 break;
156 case S2MPA01_BUCK6:
157 if (ramp_delay > s2mpa01->ramp_delay16)
158 s2mpa01->ramp_delay16 = ramp_delay;
159 else
160 ramp_delay = s2mpa01->ramp_delay16;
161
162 ramp_shift = S2MPA01_BUCK16_RAMP_SHIFT;
163 break;
164 case S2MPA01_BUCK7:
165 s2mpa01->ramp_delay7 = ramp_delay;
166 ramp_shift = S2MPA01_BUCK7_RAMP_SHIFT;
167 break;
168 case S2MPA01_BUCK8:
169 case S2MPA01_BUCK9:
170 case S2MPA01_BUCK10:
171 if (ramp_delay > s2mpa01->ramp_delay8910)
172 s2mpa01->ramp_delay8910 = ramp_delay;
173 else
174 ramp_delay = s2mpa01->ramp_delay8910;
175
176 ramp_shift = S2MPA01_BUCK8910_RAMP_SHIFT;
177 break;
178 default:
179 return 0;
180 }
181
182 if (!ramp_enable)
183 goto ramp_disable;
184
185 /* Ramp delay can be enabled/disabled only for buck[1234] */
186 if (rdev_get_id(rdev) >= S2MPA01_BUCK1 &&
187 rdev_get_id(rdev) <= S2MPA01_BUCK4) {
188 ret = regmap_update_bits(rdev->regmap, S2MPA01_REG_RAMP1,
189 1 << enable_shift, 1 << enable_shift);
190 if (ret) {
191 dev_err(&rdev->dev, "failed to enable ramp rate\n");
192 return ret;
193 }
194 }
195
196 ramp_val = get_ramp_delay(ramp_delay);
197
198 return regmap_update_bits(rdev->regmap, ramp_reg, 0x3 << ramp_shift,
199 ramp_val << ramp_shift);
200
201 ramp_disable:
202 return regmap_update_bits(rdev->regmap, S2MPA01_REG_RAMP1,
203 1 << enable_shift, 0);
204 }
205
206 static const struct regulator_ops s2mpa01_ldo_ops = {
207 .list_voltage = regulator_list_voltage_linear,
208 .map_voltage = regulator_map_voltage_linear,
209 .is_enabled = regulator_is_enabled_regmap,
210 .enable = regulator_enable_regmap,
211 .disable = regulator_disable_regmap,
212 .get_voltage_sel = regulator_get_voltage_sel_regmap,
213 .set_voltage_sel = regulator_set_voltage_sel_regmap,
214 .set_voltage_time_sel = regulator_set_voltage_time_sel,
215 };
216
217 static const struct regulator_ops s2mpa01_buck_ops = {
218 .list_voltage = regulator_list_voltage_linear,
219 .map_voltage = regulator_map_voltage_linear,
220 .is_enabled = regulator_is_enabled_regmap,
221 .enable = regulator_enable_regmap,
222 .disable = regulator_disable_regmap,
223 .get_voltage_sel = regulator_get_voltage_sel_regmap,
224 .set_voltage_sel = regulator_set_voltage_sel_regmap,
225 .set_voltage_time_sel = s2mpa01_regulator_set_voltage_time_sel,
226 .set_ramp_delay = s2mpa01_set_ramp_delay,
227 };
228
229 #define regulator_desc_ldo(num, step) { \
230 .name = "LDO"#num, \
231 .of_match = of_match_ptr("LDO"#num), \
232 .regulators_node = of_match_ptr("regulators"), \
233 .id = S2MPA01_LDO##num, \
234 .ops = &s2mpa01_ldo_ops, \
235 .type = REGULATOR_VOLTAGE, \
236 .owner = THIS_MODULE, \
237 .min_uV = MIN_800_MV, \
238 .uV_step = step, \
239 .n_voltages = S2MPA01_LDO_N_VOLTAGES, \
240 .vsel_reg = S2MPA01_REG_L1CTRL + num - 1, \
241 .vsel_mask = S2MPA01_LDO_VSEL_MASK, \
242 .enable_reg = S2MPA01_REG_L1CTRL + num - 1, \
243 .enable_mask = S2MPA01_ENABLE_MASK \
244 }
245
246 #define regulator_desc_buck1_4(num) { \
247 .name = "BUCK"#num, \
248 .of_match = of_match_ptr("BUCK"#num), \
249 .regulators_node = of_match_ptr("regulators"), \
250 .id = S2MPA01_BUCK##num, \
251 .ops = &s2mpa01_buck_ops, \
252 .type = REGULATOR_VOLTAGE, \
253 .owner = THIS_MODULE, \
254 .min_uV = MIN_600_MV, \
255 .uV_step = STEP_6_25_MV, \
256 .n_voltages = S2MPA01_BUCK_N_VOLTAGES, \
257 .ramp_delay = S2MPA01_RAMP_DELAY, \
258 .vsel_reg = S2MPA01_REG_B1CTRL2 + (num - 1) * 2, \
259 .vsel_mask = S2MPA01_BUCK_VSEL_MASK, \
260 .enable_reg = S2MPA01_REG_B1CTRL1 + (num - 1) * 2, \
261 .enable_mask = S2MPA01_ENABLE_MASK \
262 }
263
264 #define regulator_desc_buck5 { \
265 .name = "BUCK5", \
266 .of_match = of_match_ptr("BUCK5"), \
267 .regulators_node = of_match_ptr("regulators"), \
268 .id = S2MPA01_BUCK5, \
269 .ops = &s2mpa01_buck_ops, \
270 .type = REGULATOR_VOLTAGE, \
271 .owner = THIS_MODULE, \
272 .min_uV = MIN_800_MV, \
273 .uV_step = STEP_6_25_MV, \
274 .n_voltages = S2MPA01_BUCK_N_VOLTAGES, \
275 .ramp_delay = S2MPA01_RAMP_DELAY, \
276 .vsel_reg = S2MPA01_REG_B5CTRL2, \
277 .vsel_mask = S2MPA01_BUCK_VSEL_MASK, \
278 .enable_reg = S2MPA01_REG_B5CTRL1, \
279 .enable_mask = S2MPA01_ENABLE_MASK \
280 }
281
282 #define regulator_desc_buck6_10(num, min, step) { \
283 .name = "BUCK"#num, \
284 .of_match = of_match_ptr("BUCK"#num), \
285 .regulators_node = of_match_ptr("regulators"), \
286 .id = S2MPA01_BUCK##num, \
287 .ops = &s2mpa01_buck_ops, \
288 .type = REGULATOR_VOLTAGE, \
289 .owner = THIS_MODULE, \
290 .min_uV = min, \
291 .uV_step = step, \
292 .n_voltages = S2MPA01_BUCK_N_VOLTAGES, \
293 .ramp_delay = S2MPA01_RAMP_DELAY, \
294 .vsel_reg = S2MPA01_REG_B6CTRL2 + (num - 6) * 2, \
295 .vsel_mask = S2MPA01_BUCK_VSEL_MASK, \
296 .enable_reg = S2MPA01_REG_B6CTRL1 + (num - 6) * 2, \
297 .enable_mask = S2MPA01_ENABLE_MASK \
298 }
299
300 static const struct regulator_desc regulators[] = {
301 regulator_desc_ldo(1, STEP_25_MV),
302 regulator_desc_ldo(2, STEP_50_MV),
303 regulator_desc_ldo(3, STEP_50_MV),
304 regulator_desc_ldo(4, STEP_50_MV),
305 regulator_desc_ldo(5, STEP_25_MV),
306 regulator_desc_ldo(6, STEP_25_MV),
307 regulator_desc_ldo(7, STEP_50_MV),
308 regulator_desc_ldo(8, STEP_50_MV),
309 regulator_desc_ldo(9, STEP_50_MV),
310 regulator_desc_ldo(10, STEP_50_MV),
311 regulator_desc_ldo(11, STEP_50_MV),
312 regulator_desc_ldo(12, STEP_50_MV),
313 regulator_desc_ldo(13, STEP_50_MV),
314 regulator_desc_ldo(14, STEP_50_MV),
315 regulator_desc_ldo(15, STEP_50_MV),
316 regulator_desc_ldo(16, STEP_50_MV),
317 regulator_desc_ldo(17, STEP_50_MV),
318 regulator_desc_ldo(18, STEP_50_MV),
319 regulator_desc_ldo(19, STEP_50_MV),
320 regulator_desc_ldo(20, STEP_50_MV),
321 regulator_desc_ldo(21, STEP_50_MV),
322 regulator_desc_ldo(22, STEP_50_MV),
323 regulator_desc_ldo(23, STEP_50_MV),
324 regulator_desc_ldo(24, STEP_50_MV),
325 regulator_desc_ldo(25, STEP_50_MV),
326 regulator_desc_ldo(26, STEP_25_MV),
327 regulator_desc_buck1_4(1),
328 regulator_desc_buck1_4(2),
329 regulator_desc_buck1_4(3),
330 regulator_desc_buck1_4(4),
331 regulator_desc_buck5,
332 regulator_desc_buck6_10(6, MIN_600_MV, STEP_6_25_MV),
333 regulator_desc_buck6_10(7, MIN_600_MV, STEP_6_25_MV),
334 regulator_desc_buck6_10(8, MIN_800_MV, STEP_12_5_MV),
335 regulator_desc_buck6_10(9, MIN_1500_MV, STEP_12_5_MV),
336 regulator_desc_buck6_10(10, MIN_1000_MV, STEP_12_5_MV),
337 };
338
s2mpa01_pmic_probe(struct platform_device * pdev)339 static int s2mpa01_pmic_probe(struct platform_device *pdev)
340 {
341 struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent);
342 struct regulator_config config = { };
343 struct s2mpa01_info *s2mpa01;
344 int i;
345
346 s2mpa01 = devm_kzalloc(&pdev->dev, sizeof(*s2mpa01), GFP_KERNEL);
347 if (!s2mpa01)
348 return -ENOMEM;
349
350 config.dev = iodev->dev;
351 config.regmap = iodev->regmap_pmic;
352 config.driver_data = s2mpa01;
353
354 for (i = 0; i < S2MPA01_REGULATOR_MAX; i++) {
355 struct regulator_dev *rdev;
356
357 rdev = devm_regulator_register(&pdev->dev,
358 ®ulators[i], &config);
359 if (IS_ERR(rdev)) {
360 dev_err(&pdev->dev, "regulator init failed for %d\n",
361 i);
362 return PTR_ERR(rdev);
363 }
364 }
365
366 return 0;
367 }
368
369 static const struct platform_device_id s2mpa01_pmic_id[] = {
370 { "s2mpa01-pmic", 0},
371 { },
372 };
373 MODULE_DEVICE_TABLE(platform, s2mpa01_pmic_id);
374
375 static struct platform_driver s2mpa01_pmic_driver = {
376 .driver = {
377 .name = "s2mpa01-pmic",
378 .probe_type = PROBE_PREFER_ASYNCHRONOUS,
379 },
380 .probe = s2mpa01_pmic_probe,
381 .id_table = s2mpa01_pmic_id,
382 };
383
384 module_platform_driver(s2mpa01_pmic_driver);
385
386 /* Module information */
387 MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
388 MODULE_AUTHOR("Sachin Kamat <sachin.kamat@samsung.com>");
389 MODULE_DESCRIPTION("Samsung S2MPA01 Regulator Driver");
390 MODULE_LICENSE("GPL");
391