]> git.sur5r.net Git - u-boot/blob - drivers/power/regulator/pbias_regulator.c
regulator: pbias: don't evaluate variable before assignment
[u-boot] / drivers / power / regulator / pbias_regulator.c
1 /*
2  * (C) Copyright 2016 Texas Instruments Incorporated, <www.ti.com>
3  * Jean-Jacques Hiblot <jjhiblot@ti.com>
4  *
5  * SPDX-License-Identifier:     GPL-2.0+
6  */
7
8 #include <common.h>
9 #include <errno.h>
10 #include <dm.h>
11 #include <power/pmic.h>
12 #include <power/regulator.h>
13 #include <regmap.h>
14 #include <syscon.h>
15 #include <linux/bitops.h>
16 #include <linux/ioport.h>
17 #include <dm/read.h>
18
19 DECLARE_GLOBAL_DATA_PTR;
20
21 struct pbias_reg_info {
22         u32 enable;
23         u32 enable_mask;
24         u32 disable_val;
25         u32 vmode;
26         unsigned int enable_time;
27         char *name;
28 };
29
30 struct pbias_priv {
31         struct regmap *regmap;
32         int offset;
33 };
34
35 static const struct pmic_child_info pmic_children_info[] = {
36         { .prefix = "pbias", .driver = "pbias_regulator"},
37         { },
38 };
39
40 static int pbias_write(struct udevice *dev, uint reg, const uint8_t *buff,
41                        int len)
42 {
43         struct pbias_priv *priv = dev_get_priv(dev);
44         u32 val = *(u32 *)buff;
45
46         if (len != 4)
47                 return -EINVAL;
48
49         return regmap_write(priv->regmap, priv->offset, val);
50 }
51
52 static int pbias_read(struct udevice *dev, uint reg, uint8_t *buff, int len)
53 {
54         struct pbias_priv *priv = dev_get_priv(dev);
55
56         if (len != 4)
57                 return -EINVAL;
58
59         return regmap_read(priv->regmap, priv->offset, (u32 *)buff);
60 }
61
62 static int pbias_ofdata_to_platdata(struct udevice *dev)
63 {
64         struct pbias_priv *priv = dev_get_priv(dev);
65         struct udevice *syscon;
66         struct regmap *regmap;
67         struct resource res;
68         int err;
69
70         err = uclass_get_device_by_phandle(UCLASS_SYSCON, dev,
71                                            "syscon", &syscon);
72         if (err) {
73                 pr_err("%s: unable to find syscon device (%d)\n", __func__,
74                       err);
75                 return err;
76         }
77
78         regmap = syscon_get_regmap(syscon);
79         if (IS_ERR(regmap)) {
80                 pr_err("%s: unable to find regmap (%ld)\n", __func__,
81                       PTR_ERR(regmap));
82                 return PTR_ERR(regmap);
83         }
84         priv->regmap = regmap;
85
86         err = dev_read_resource(dev, 0, &res);
87         if (err) {
88                 pr_err("%s: unable to find offset (%d)\n", __func__, err);
89                 return err;
90         }
91         priv->offset = res.start;
92
93         return 0;
94 }
95
96 static int pbias_bind(struct udevice *dev)
97 {
98         int children;
99
100         children = pmic_bind_children(dev, dev->node, pmic_children_info);
101         if (!children)
102                 debug("%s: %s - no child found\n", __func__, dev->name);
103
104         return 0;
105 }
106
107 static struct dm_pmic_ops pbias_ops = {
108         .read = pbias_read,
109         .write = pbias_write,
110 };
111
112 static const struct udevice_id pbias_ids[] = {
113         { .compatible = "ti,pbias-dra7" },
114         { }
115 };
116
117 U_BOOT_DRIVER(pbias_pmic) = {
118         .name = "pbias_pmic",
119         .id = UCLASS_PMIC,
120         .of_match = pbias_ids,
121         .bind = pbias_bind,
122         .ops = &pbias_ops,
123         .ofdata_to_platdata = pbias_ofdata_to_platdata,
124         .priv_auto_alloc_size = sizeof(struct pbias_priv),
125 };
126
127 static const struct pbias_reg_info pbias_mmc_omap2430 = {
128         .enable = BIT(1),
129         .enable_mask = BIT(1),
130         .vmode = BIT(0),
131         .disable_val = 0,
132         .enable_time = 100,
133         .name = "pbias_mmc_omap2430"
134 };
135
136 static const struct pbias_reg_info pbias_sim_omap3 = {
137         .enable = BIT(9),
138         .enable_mask = BIT(9),
139         .vmode = BIT(8),
140         .enable_time = 100,
141         .name = "pbias_sim_omap3"
142 };
143
144 static const struct pbias_reg_info pbias_mmc_omap4 = {
145         .enable = BIT(26) | BIT(22),
146         .enable_mask = BIT(26) | BIT(25) | BIT(22),
147         .disable_val = BIT(25),
148         .vmode = BIT(21),
149         .enable_time = 100,
150         .name = "pbias_mmc_omap4"
151 };
152
153 static const struct pbias_reg_info pbias_mmc_omap5 = {
154         .enable = BIT(27) | BIT(26),
155         .enable_mask = BIT(27) | BIT(25) | BIT(26),
156         .disable_val = BIT(25),
157         .vmode = BIT(21),
158         .enable_time = 100,
159         .name = "pbias_mmc_omap5"
160 };
161
162 static const struct pbias_reg_info *pbias_reg_infos[] = {
163         &pbias_mmc_omap5,
164         &pbias_mmc_omap4,
165         &pbias_sim_omap3,
166         &pbias_mmc_omap2430,
167         NULL
168 };
169
170 static int pbias_regulator_probe(struct udevice *dev)
171 {
172         const struct pbias_reg_info **p = pbias_reg_infos;
173         struct dm_regulator_uclass_platdata *uc_pdata;
174
175         uc_pdata = dev_get_uclass_platdata(dev);
176
177         while (*p) {
178                 int rc;
179
180                 rc = dev_read_stringlist_search(dev, "regulator-name",
181                                                 (*p)->name);
182                 if (rc >= 0) {
183                         debug("found regulator %s\n", (*p)->name);
184                         break;
185                 } else if (rc != -ENODATA) {
186                         return rc;
187                 }
188                 p++;
189         }
190         if (!*p) {
191                 int i = 0;
192                 const char *s;
193
194                 debug("regulator ");
195                 while (dev_read_string_index(dev, "regulator-name", i++, &s) >= 0)
196                         debug("%s'%s' ", (i > 1) ? ", " : "", s);
197                 debug("%s not supported\n", (i > 2) ? "are" : "is");
198                 return -EINVAL;
199         }
200
201         uc_pdata->type = REGULATOR_TYPE_OTHER;
202         dev->priv = (void *)*p;
203
204         return 0;
205 }
206
207 static int pbias_regulator_get_value(struct udevice *dev)
208 {
209         const struct pbias_reg_info *p = dev_get_priv(dev);
210         int rc;
211         u32 reg;
212
213         rc = pmic_read(dev->parent, 0, (uint8_t *)&reg, sizeof(reg));
214         if (rc)
215                 return rc;
216
217         debug("%s voltage id %s\n", p->name,
218               (reg & p->vmode) ? "3.0v" : "1.8v");
219         return (reg & p->vmode) ? 3000000 : 1800000;
220 }
221
222 static int pbias_regulator_set_value(struct udevice *dev, int uV)
223 {
224         const struct pbias_reg_info *p = dev_get_priv(dev);
225         int rc;
226         u32 reg;
227
228         rc = pmic_read(dev->parent, 0, (uint8_t *)&reg, sizeof(reg));
229         if (rc)
230                 return rc;
231
232         if (uV == 3000000)
233                 reg |= p->vmode;
234         else if (uV == 1800000)
235                 reg &= ~p->vmode;
236         else
237                 return -EINVAL;
238
239         debug("Setting %s voltage to %s\n", p->name,
240               (reg & p->vmode) ? "3.0v" : "1.8v");
241
242         return pmic_write(dev->parent, 0, (uint8_t *)&reg, sizeof(reg));
243 }
244
245 static int pbias_regulator_get_enable(struct udevice *dev)
246 {
247         const struct pbias_reg_info *p = dev_get_priv(dev);
248         int rc;
249         u32 reg;
250
251         rc = pmic_read(dev->parent, 0, (uint8_t *)&reg, sizeof(reg));
252         if (rc)
253                 return rc;
254
255         debug("%s id %s\n", p->name,
256               (reg & p->enable_mask) == (p->disable_val) ? "on" : "off");
257
258         return (reg & p->enable_mask) == (p->disable_val);
259 }
260
261 static int pbias_regulator_set_enable(struct udevice *dev, bool enable)
262 {
263         const struct pbias_reg_info *p = dev_get_priv(dev);
264         int rc;
265         u32 reg;
266
267         debug("Turning %s %s\n", enable ? "on" : "off", p->name);
268
269         rc = pmic_read(dev->parent, 0, (uint8_t *)&reg, sizeof(reg));
270         if (rc)
271                 return rc;
272
273         reg &= ~p->enable_mask;
274         if (enable)
275                 reg |= p->enable;
276         else
277                 reg |= p->disable_val;
278
279         rc = pmic_write(dev->parent, 0, (uint8_t *)&reg, sizeof(reg));
280         if (rc)
281                 return rc;
282
283         if (enable)
284                 udelay(p->enable_time);
285
286         return 0;
287 }
288
289 static const struct dm_regulator_ops pbias_regulator_ops = {
290         .get_value  = pbias_regulator_get_value,
291         .set_value  = pbias_regulator_set_value,
292         .get_enable = pbias_regulator_get_enable,
293         .set_enable = pbias_regulator_set_enable,
294 };
295
296 U_BOOT_DRIVER(pbias_regulator) = {
297         .name = "pbias_regulator",
298         .id = UCLASS_REGULATOR,
299         .ops = &pbias_regulator_ops,
300         .probe = pbias_regulator_probe,
301 };