1 /*
2 * Copyright (c) 2015, Sony Mobile Communications AB.
3 * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 and
7 * only version 2 as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 */
14
15 #include <linux/module.h>
16 #include <linux/of.h>
17 #include <linux/of_device.h>
18 #include <linux/platform_device.h>
19 #include <linux/regulator/driver.h>
20 #include <linux/regulator/machine.h>
21 #include <linux/regulator/of_regulator.h>
22 #include <linux/soc/qcom/smd-rpm.h>
23
24 struct qcom_rpm_reg {
25 struct device *dev;
26
27 struct qcom_smd_rpm *rpm;
28
29 u32 type;
30 u32 id;
31
32 struct regulator_desc desc;
33
34 int is_enabled;
35 int uV;
36 };
37
38 struct rpm_regulator_req {
39 __le32 key;
40 __le32 nbytes;
41 __le32 value;
42 };
43
44 #define RPM_KEY_SWEN 0x6e657773 /* "swen" */
45 #define RPM_KEY_UV 0x00007675 /* "uv" */
46 #define RPM_KEY_MA 0x0000616d /* "ma" */
47
rpm_reg_write_active(struct qcom_rpm_reg * vreg,struct rpm_regulator_req * req,size_t size)48 static int rpm_reg_write_active(struct qcom_rpm_reg *vreg,
49 struct rpm_regulator_req *req,
50 size_t size)
51 {
52 return qcom_rpm_smd_write(vreg->rpm,
53 QCOM_SMD_RPM_ACTIVE_STATE,
54 vreg->type,
55 vreg->id,
56 req, size);
57 }
58
rpm_reg_enable(struct regulator_dev * rdev)59 static int rpm_reg_enable(struct regulator_dev *rdev)
60 {
61 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
62 struct rpm_regulator_req req;
63 int ret;
64
65 req.key = cpu_to_le32(RPM_KEY_SWEN);
66 req.nbytes = cpu_to_le32(sizeof(u32));
67 req.value = cpu_to_le32(1);
68
69 ret = rpm_reg_write_active(vreg, &req, sizeof(req));
70 if (!ret)
71 vreg->is_enabled = 1;
72
73 return ret;
74 }
75
rpm_reg_is_enabled(struct regulator_dev * rdev)76 static int rpm_reg_is_enabled(struct regulator_dev *rdev)
77 {
78 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
79
80 return vreg->is_enabled;
81 }
82
rpm_reg_disable(struct regulator_dev * rdev)83 static int rpm_reg_disable(struct regulator_dev *rdev)
84 {
85 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
86 struct rpm_regulator_req req;
87 int ret;
88
89 req.key = cpu_to_le32(RPM_KEY_SWEN);
90 req.nbytes = cpu_to_le32(sizeof(u32));
91 req.value = 0;
92
93 ret = rpm_reg_write_active(vreg, &req, sizeof(req));
94 if (!ret)
95 vreg->is_enabled = 0;
96
97 return ret;
98 }
99
rpm_reg_get_voltage(struct regulator_dev * rdev)100 static int rpm_reg_get_voltage(struct regulator_dev *rdev)
101 {
102 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
103
104 return vreg->uV;
105 }
106
rpm_reg_set_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)107 static int rpm_reg_set_voltage(struct regulator_dev *rdev,
108 int min_uV,
109 int max_uV,
110 unsigned *selector)
111 {
112 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
113 struct rpm_regulator_req req;
114 int ret = 0;
115
116 req.key = cpu_to_le32(RPM_KEY_UV);
117 req.nbytes = cpu_to_le32(sizeof(u32));
118 req.value = cpu_to_le32(min_uV);
119
120 ret = rpm_reg_write_active(vreg, &req, sizeof(req));
121 if (!ret)
122 vreg->uV = min_uV;
123
124 return ret;
125 }
126
rpm_reg_set_load(struct regulator_dev * rdev,int load_uA)127 static int rpm_reg_set_load(struct regulator_dev *rdev, int load_uA)
128 {
129 struct qcom_rpm_reg *vreg = rdev_get_drvdata(rdev);
130 struct rpm_regulator_req req;
131
132 req.key = cpu_to_le32(RPM_KEY_MA);
133 req.nbytes = cpu_to_le32(sizeof(u32));
134 req.value = cpu_to_le32(load_uA / 1000);
135
136 return rpm_reg_write_active(vreg, &req, sizeof(req));
137 }
138
139 static const struct regulator_ops rpm_smps_ldo_ops = {
140 .enable = rpm_reg_enable,
141 .disable = rpm_reg_disable,
142 .is_enabled = rpm_reg_is_enabled,
143
144 .get_voltage = rpm_reg_get_voltage,
145 .set_voltage = rpm_reg_set_voltage,
146
147 .set_load = rpm_reg_set_load,
148 };
149
150 static const struct regulator_ops rpm_switch_ops = {
151 .enable = rpm_reg_enable,
152 .disable = rpm_reg_disable,
153 .is_enabled = rpm_reg_is_enabled,
154 };
155
156 static const struct regulator_desc pm8x41_hfsmps = {
157 .linear_ranges = (struct regulator_linear_range[]) {
158 REGULATOR_LINEAR_RANGE( 375000, 0, 95, 12500),
159 REGULATOR_LINEAR_RANGE(1550000, 96, 158, 25000),
160 },
161 .n_linear_ranges = 2,
162 .n_voltages = 159,
163 .ops = &rpm_smps_ldo_ops,
164 };
165
166 static const struct regulator_desc pm8841_ftsmps = {
167 .linear_ranges = (struct regulator_linear_range[]) {
168 REGULATOR_LINEAR_RANGE(350000, 0, 184, 5000),
169 REGULATOR_LINEAR_RANGE(1280000, 185, 261, 10000),
170 },
171 .n_linear_ranges = 2,
172 .n_voltages = 262,
173 .ops = &rpm_smps_ldo_ops,
174 };
175
176 static const struct regulator_desc pm8941_boost = {
177 .linear_ranges = (struct regulator_linear_range[]) {
178 REGULATOR_LINEAR_RANGE(4000000, 0, 30, 50000),
179 },
180 .n_linear_ranges = 1,
181 .n_voltages = 31,
182 .ops = &rpm_smps_ldo_ops,
183 };
184
185 static const struct regulator_desc pm8941_pldo = {
186 .linear_ranges = (struct regulator_linear_range[]) {
187 REGULATOR_LINEAR_RANGE( 750000, 0, 63, 12500),
188 REGULATOR_LINEAR_RANGE(1550000, 64, 126, 25000),
189 REGULATOR_LINEAR_RANGE(3100000, 127, 163, 50000),
190 },
191 .n_linear_ranges = 3,
192 .n_voltages = 164,
193 .ops = &rpm_smps_ldo_ops,
194 };
195
196 static const struct regulator_desc pm8941_nldo = {
197 .linear_ranges = (struct regulator_linear_range[]) {
198 REGULATOR_LINEAR_RANGE(750000, 0, 63, 12500),
199 },
200 .n_linear_ranges = 1,
201 .n_voltages = 64,
202 .ops = &rpm_smps_ldo_ops,
203 };
204
205 static const struct regulator_desc pm8941_lnldo = {
206 .fixed_uV = 1740000,
207 .n_voltages = 1,
208 .ops = &rpm_smps_ldo_ops,
209 };
210
211 static const struct regulator_desc pm8941_switch = {
212 .ops = &rpm_switch_ops,
213 };
214
215 struct rpm_regulator_data {
216 const char *name;
217 u32 type;
218 u32 id;
219 const struct regulator_desc *desc;
220 const char *supply;
221 };
222
223 static const struct rpm_regulator_data rpm_pm8841_regulators[] = {
224 { "s1", QCOM_SMD_RPM_SMPB, 1, &pm8x41_hfsmps, "vdd_s1" },
225 { "s2", QCOM_SMD_RPM_SMPB, 2, &pm8841_ftsmps, "vdd_s2" },
226 { "s3", QCOM_SMD_RPM_SMPB, 3, &pm8x41_hfsmps, "vdd_s3" },
227 { "s4", QCOM_SMD_RPM_SMPB, 4, &pm8841_ftsmps, "vdd_s4" },
228 { "s5", QCOM_SMD_RPM_SMPB, 5, &pm8841_ftsmps, "vdd_s5" },
229 { "s6", QCOM_SMD_RPM_SMPB, 6, &pm8841_ftsmps, "vdd_s6" },
230 { "s7", QCOM_SMD_RPM_SMPB, 7, &pm8841_ftsmps, "vdd_s7" },
231 { "s8", QCOM_SMD_RPM_SMPB, 8, &pm8841_ftsmps, "vdd_s8" },
232 {}
233 };
234
235 static const struct rpm_regulator_data rpm_pm8941_regulators[] = {
236 { "s1", QCOM_SMD_RPM_SMPA, 1, &pm8x41_hfsmps, "vdd_s1" },
237 { "s2", QCOM_SMD_RPM_SMPA, 2, &pm8x41_hfsmps, "vdd_s2" },
238 { "s3", QCOM_SMD_RPM_SMPA, 3, &pm8x41_hfsmps, "vdd_s3" },
239 { "s4", QCOM_SMD_RPM_BOOST, 1, &pm8941_boost },
240
241 { "l1", QCOM_SMD_RPM_LDOA, 1, &pm8941_nldo, "vdd_l1_l3" },
242 { "l2", QCOM_SMD_RPM_LDOA, 2, &pm8941_nldo, "vdd_l2_lvs1_2_3" },
243 { "l3", QCOM_SMD_RPM_LDOA, 3, &pm8941_nldo, "vdd_l1_l3" },
244 { "l4", QCOM_SMD_RPM_LDOA, 4, &pm8941_nldo, "vdd_l4_l11" },
245 { "l5", QCOM_SMD_RPM_LDOA, 5, &pm8941_lnldo, "vdd_l5_l7" },
246 { "l6", QCOM_SMD_RPM_LDOA, 6, &pm8941_pldo, "vdd_l6_l12_l14_l15" },
247 { "l7", QCOM_SMD_RPM_LDOA, 7, &pm8941_lnldo, "vdd_l5_l7" },
248 { "l8", QCOM_SMD_RPM_LDOA, 8, &pm8941_pldo, "vdd_l8_l16_l18_l19" },
249 { "l9", QCOM_SMD_RPM_LDOA, 9, &pm8941_pldo, "vdd_l9_l10_l17_l22" },
250 { "l10", QCOM_SMD_RPM_LDOA, 10, &pm8941_pldo, "vdd_l9_l10_l17_l22" },
251 { "l11", QCOM_SMD_RPM_LDOA, 11, &pm8941_nldo, "vdd_l4_l11" },
252 { "l12", QCOM_SMD_RPM_LDOA, 12, &pm8941_pldo, "vdd_l6_l12_l14_l15" },
253 { "l13", QCOM_SMD_RPM_LDOA, 13, &pm8941_pldo, "vdd_l13_l20_l23_l24" },
254 { "l14", QCOM_SMD_RPM_LDOA, 14, &pm8941_pldo, "vdd_l6_l12_l14_l15" },
255 { "l15", QCOM_SMD_RPM_LDOA, 15, &pm8941_pldo, "vdd_l6_l12_l14_l15" },
256 { "l16", QCOM_SMD_RPM_LDOA, 16, &pm8941_pldo, "vdd_l8_l16_l18_l19" },
257 { "l17", QCOM_SMD_RPM_LDOA, 17, &pm8941_pldo, "vdd_l9_l10_l17_l22" },
258 { "l18", QCOM_SMD_RPM_LDOA, 18, &pm8941_pldo, "vdd_l8_l16_l18_l19" },
259 { "l19", QCOM_SMD_RPM_LDOA, 19, &pm8941_pldo, "vdd_l8_l16_l18_l19" },
260 { "l20", QCOM_SMD_RPM_LDOA, 20, &pm8941_pldo, "vdd_l13_l20_l23_l24" },
261 { "l21", QCOM_SMD_RPM_LDOA, 21, &pm8941_pldo, "vdd_l21" },
262 { "l22", QCOM_SMD_RPM_LDOA, 22, &pm8941_pldo, "vdd_l9_l10_l17_l22" },
263 { "l23", QCOM_SMD_RPM_LDOA, 23, &pm8941_pldo, "vdd_l13_l20_l23_l24" },
264 { "l24", QCOM_SMD_RPM_LDOA, 24, &pm8941_pldo, "vdd_l13_l20_l23_l24" },
265
266 { "lvs1", QCOM_SMD_RPM_VSA, 1, &pm8941_switch, "vdd_l2_lvs1_2_3" },
267 { "lvs2", QCOM_SMD_RPM_VSA, 2, &pm8941_switch, "vdd_l2_lvs1_2_3" },
268 { "lvs3", QCOM_SMD_RPM_VSA, 3, &pm8941_switch, "vdd_l2_lvs1_2_3" },
269
270 { "5vs1", QCOM_SMD_RPM_VSA, 4, &pm8941_switch, "vin_5vs" },
271 { "5vs2", QCOM_SMD_RPM_VSA, 5, &pm8941_switch, "vin_5vs" },
272
273 {}
274 };
275
276 static const struct of_device_id rpm_of_match[] = {
277 { .compatible = "qcom,rpm-pm8841-regulators", .data = &rpm_pm8841_regulators },
278 { .compatible = "qcom,rpm-pm8941-regulators", .data = &rpm_pm8941_regulators },
279 {}
280 };
281 MODULE_DEVICE_TABLE(of, rpm_of_match);
282
rpm_reg_probe(struct platform_device * pdev)283 static int rpm_reg_probe(struct platform_device *pdev)
284 {
285 const struct rpm_regulator_data *reg;
286 const struct of_device_id *match;
287 struct regulator_config config = { };
288 struct regulator_dev *rdev;
289 struct qcom_rpm_reg *vreg;
290 struct qcom_smd_rpm *rpm;
291
292 rpm = dev_get_drvdata(pdev->dev.parent);
293 if (!rpm) {
294 dev_err(&pdev->dev, "unable to retrieve handle to rpm\n");
295 return -ENODEV;
296 }
297
298 match = of_match_device(rpm_of_match, &pdev->dev);
299 for (reg = match->data; reg->name; reg++) {
300 vreg = devm_kzalloc(&pdev->dev, sizeof(*vreg), GFP_KERNEL);
301 if (!vreg)
302 return -ENOMEM;
303
304 vreg->dev = &pdev->dev;
305 vreg->type = reg->type;
306 vreg->id = reg->id;
307 vreg->rpm = rpm;
308
309 memcpy(&vreg->desc, reg->desc, sizeof(vreg->desc));
310
311 vreg->desc.id = -1;
312 vreg->desc.owner = THIS_MODULE;
313 vreg->desc.type = REGULATOR_VOLTAGE;
314 vreg->desc.name = reg->name;
315 vreg->desc.supply_name = reg->supply;
316 vreg->desc.of_match = reg->name;
317
318 config.dev = &pdev->dev;
319 config.driver_data = vreg;
320 rdev = devm_regulator_register(&pdev->dev, &vreg->desc, &config);
321 if (IS_ERR(rdev)) {
322 dev_err(&pdev->dev, "failed to register %s\n", reg->name);
323 return PTR_ERR(rdev);
324 }
325 }
326
327 return 0;
328 }
329
330 static struct platform_driver rpm_reg_driver = {
331 .probe = rpm_reg_probe,
332 .driver = {
333 .name = "qcom_rpm_smd_regulator",
334 .of_match_table = rpm_of_match,
335 },
336 };
337
rpm_reg_init(void)338 static int __init rpm_reg_init(void)
339 {
340 return platform_driver_register(&rpm_reg_driver);
341 }
342 subsys_initcall(rpm_reg_init);
343
rpm_reg_exit(void)344 static void __exit rpm_reg_exit(void)
345 {
346 platform_driver_unregister(&rpm_reg_driver);
347 }
348 module_exit(rpm_reg_exit)
349
350 MODULE_DESCRIPTION("Qualcomm RPM regulator driver");
351 MODULE_LICENSE("GPL v2");
352