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 | |
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 | |
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 | |
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(map: rdev->regmap, reg: S2MPA01_REG_RAMP1, |
189 | mask: 1 << enable_shift, val: 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(map: rdev->regmap, reg: ramp_reg, mask: 0x3 << ramp_shift, |
199 | val: ramp_val << ramp_shift); |
200 | |
201 | ramp_disable: |
202 | return regmap_update_bits(map: rdev->regmap, reg: S2MPA01_REG_RAMP1, |
203 | mask: 1 << enable_shift, val: 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 | |
339 | static int s2mpa01_pmic_probe(struct platform_device *pdev) |
340 | { |
341 | struct sec_pmic_dev *iodev = dev_get_drvdata(dev: pdev->dev.parent); |
342 | struct regulator_config config = { }; |
343 | struct s2mpa01_info *s2mpa01; |
344 | int i; |
345 | |
346 | s2mpa01 = devm_kzalloc(dev: &pdev->dev, size: 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(dev: &pdev->dev, |
358 | regulator_desc: ®ulators[i], config: &config); |
359 | if (IS_ERR(ptr: rdev)) { |
360 | dev_err(&pdev->dev, "regulator init failed for %d\n" , |
361 | i); |
362 | return PTR_ERR(ptr: 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 | |