1 /* 2 * Copyright (C) 2014-2015 Samsung Electronics 3 * Przemyslaw Marczak <p.marczak@samsung.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 <dm/uclass-internal.h> 12 #include <power/pmic.h> 13 #include <power/regulator.h> 14 15 DECLARE_GLOBAL_DATA_PTR; 16 17 int regulator_mode(struct udevice *dev, struct dm_regulator_mode **modep) 18 { 19 struct dm_regulator_uclass_platdata *uc_pdata; 20 21 *modep = NULL; 22 23 uc_pdata = dev_get_uclass_platdata(dev); 24 if (!uc_pdata) 25 return -ENXIO; 26 27 *modep = uc_pdata->mode; 28 return uc_pdata->mode_count; 29 } 30 31 int regulator_get_value(struct udevice *dev) 32 { 33 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 34 35 if (!ops || !ops->get_value) 36 return -ENOSYS; 37 38 return ops->get_value(dev); 39 } 40 41 int regulator_set_value(struct udevice *dev, int uV) 42 { 43 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 44 struct dm_regulator_uclass_platdata *uc_pdata; 45 u32 old_uV = -ENODATA, us; 46 int ret; 47 48 uc_pdata = dev_get_uclass_platdata(dev); 49 if (uc_pdata->min_uV != -ENODATA && uV < uc_pdata->min_uV) 50 return -EINVAL; 51 if (uc_pdata->max_uV != -ENODATA && uV > uc_pdata->max_uV) 52 return -EINVAL; 53 54 if (!ops || !ops->set_value) 55 return -ENOSYS; 56 57 if (uc_pdata->ramp_delay != -ENODATA) { 58 if (!ops->get_value) 59 return -ENOSYS; 60 old_uV = ops->get_value(dev); 61 if (old_uV < 0) 62 return -EINVAL; 63 } 64 65 ret = ops->set_value(dev, uV); 66 67 if (!ret && (old_uV != -ENODATA) && (old_uV != uV)) { 68 us = DIV_ROUND_UP(abs(uV - old_uV), uc_pdata->ramp_delay); 69 udelay(us); 70 debug("%s: ramp=%d, old_uV=%d, uV=%d, us=%d\n", 71 uc_pdata->name, uc_pdata->ramp_delay, old_uV, uV, us); 72 } 73 74 return ret; 75 } 76 77 int regulator_set_suspend_value(struct udevice *dev, int uV) 78 { 79 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 80 81 if (!ops || !ops->set_suspend_value) 82 return -ENOSYS; 83 84 return ops->set_suspend_value(dev, uV); 85 } 86 87 /* 88 * To be called with at most caution as there is no check 89 * before setting the actual voltage value. 90 */ 91 int regulator_set_value_force(struct udevice *dev, int uV) 92 { 93 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 94 95 if (!ops || !ops->set_value) 96 return -ENOSYS; 97 98 return ops->set_value(dev, uV); 99 } 100 101 int regulator_get_current(struct udevice *dev) 102 { 103 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 104 105 if (!ops || !ops->get_current) 106 return -ENOSYS; 107 108 return ops->get_current(dev); 109 } 110 111 int regulator_set_current(struct udevice *dev, int uA) 112 { 113 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 114 struct dm_regulator_uclass_platdata *uc_pdata; 115 116 uc_pdata = dev_get_uclass_platdata(dev); 117 if (uc_pdata->min_uA != -ENODATA && uA < uc_pdata->min_uA) 118 return -EINVAL; 119 if (uc_pdata->max_uA != -ENODATA && uA > uc_pdata->max_uA) 120 return -EINVAL; 121 122 if (!ops || !ops->set_current) 123 return -ENOSYS; 124 125 return ops->set_current(dev, uA); 126 } 127 128 int regulator_get_enable(struct udevice *dev) 129 { 130 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 131 132 if (!ops || !ops->get_enable) 133 return -ENOSYS; 134 135 return ops->get_enable(dev); 136 } 137 138 int regulator_set_enable(struct udevice *dev, bool enable) 139 { 140 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 141 142 if (!ops || !ops->set_enable) 143 return -ENOSYS; 144 145 return ops->set_enable(dev, enable); 146 } 147 148 int regulator_set_suspend_enable(struct udevice *dev, bool enable) 149 { 150 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 151 152 if (!ops || !ops->set_suspend_enable) 153 return -ENOSYS; 154 155 return ops->set_suspend_enable(dev, enable); 156 } 157 158 int regulator_set_ramp_delay(struct udevice *dev, u32 ramp_delay) 159 { 160 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 161 162 if (!ops || !ops->set_ramp_delay) 163 return -ENOSYS; 164 165 return ops->set_ramp_delay(dev, ramp_delay); 166 } 167 168 int regulator_get_mode(struct udevice *dev) 169 { 170 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 171 172 if (!ops || !ops->get_mode) 173 return -ENOSYS; 174 175 return ops->get_mode(dev); 176 } 177 178 int regulator_set_mode(struct udevice *dev, int mode) 179 { 180 const struct dm_regulator_ops *ops = dev_get_driver_ops(dev); 181 182 if (!ops || !ops->set_mode) 183 return -ENOSYS; 184 185 return ops->set_mode(dev, mode); 186 } 187 188 int regulator_get_by_platname(const char *plat_name, struct udevice **devp) 189 { 190 struct dm_regulator_uclass_platdata *uc_pdata; 191 struct udevice *dev; 192 int ret; 193 194 *devp = NULL; 195 196 for (ret = uclass_find_first_device(UCLASS_REGULATOR, &dev); dev; 197 ret = uclass_find_next_device(&dev)) { 198 if (ret) { 199 debug("regulator %s, ret=%d\n", dev->name, ret); 200 continue; 201 } 202 203 uc_pdata = dev_get_uclass_platdata(dev); 204 if (!uc_pdata || strcmp(plat_name, uc_pdata->name)) 205 continue; 206 207 return uclass_get_device_tail(dev, 0, devp); 208 } 209 210 debug("%s: can't find: %s, ret=%d\n", __func__, plat_name, ret); 211 212 return -ENODEV; 213 } 214 215 int regulator_get_by_devname(const char *devname, struct udevice **devp) 216 { 217 return uclass_get_device_by_name(UCLASS_REGULATOR, devname, devp); 218 } 219 220 int device_get_supply_regulator(struct udevice *dev, const char *supply_name, 221 struct udevice **devp) 222 { 223 return uclass_get_device_by_phandle(UCLASS_REGULATOR, dev, 224 supply_name, devp); 225 } 226 227 int regulator_autoset(struct udevice *dev) 228 { 229 struct dm_regulator_uclass_platdata *uc_pdata; 230 int ret = 0; 231 232 uc_pdata = dev_get_uclass_platdata(dev); 233 234 if (uc_pdata->ramp_delay != -ENODATA) 235 regulator_set_ramp_delay(dev, uc_pdata->ramp_delay); 236 237 /* 238 * Suspend configure is not necessary and should not influence normal 239 * configure, so that we set "ret=0" even failed here. 240 */ 241 ret = regulator_set_suspend_enable(dev, uc_pdata->suspend_on); 242 if (!ret && uc_pdata->suspend_on) 243 regulator_set_suspend_value(dev, uc_pdata->suspend_uV); 244 else 245 ret = 0; 246 247 if (!uc_pdata->always_on && !uc_pdata->boot_on) 248 return -EMEDIUMTYPE; 249 250 if (uc_pdata->flags & REGULATOR_FLAG_AUTOSET_UV) 251 ret = regulator_set_value(dev, uc_pdata->min_uV); 252 if (uc_pdata->init_uV > 0) 253 ret = regulator_set_value(dev, uc_pdata->init_uV); 254 if (!ret && (uc_pdata->flags & REGULATOR_FLAG_AUTOSET_UA)) 255 ret = regulator_set_current(dev, uc_pdata->min_uA); 256 257 if (!ret) 258 ret = regulator_set_enable(dev, true); 259 260 return ret; 261 } 262 263 static void regulator_show(struct udevice *dev, int ret) 264 { 265 struct dm_regulator_uclass_platdata *uc_pdata; 266 267 uc_pdata = dev_get_uclass_platdata(dev); 268 269 printf("%s@%s: ", dev->name, uc_pdata->name); 270 printf("%duV <-> %duV, set %duV, %s", 271 uc_pdata->min_uV, uc_pdata->max_uV, uc_pdata->min_uV, 272 (uc_pdata->always_on || uc_pdata->boot_on) ? 273 "enabling" : "not enabling"); 274 if (ret) 275 printf(" (ret: %d)", ret); 276 277 printf("; supsend %duV, %s", 278 uc_pdata->suspend_uV, 279 uc_pdata->suspend_on ? "enabling" : "not enabling"); 280 if (uc_pdata->init_uV != -ENODATA) 281 printf("; init %duV", uc_pdata->init_uV); 282 283 printf("\n"); 284 } 285 286 int regulator_autoset_by_name(const char *platname, struct udevice **devp) 287 { 288 struct udevice *dev; 289 int ret; 290 291 ret = regulator_get_by_platname(platname, &dev); 292 if (devp) 293 *devp = dev; 294 if (ret) { 295 debug("Can get the regulator: %s (err=%d)\n", platname, ret); 296 return ret; 297 } 298 299 return regulator_autoset(dev); 300 } 301 302 int regulator_list_autoset(const char *list_platname[], 303 struct udevice *list_devp[], 304 bool verbose) 305 { 306 struct udevice *dev; 307 int error = 0, i = 0, ret; 308 309 while (list_platname[i]) { 310 ret = regulator_autoset_by_name(list_platname[i], &dev); 311 if (ret != -EMEDIUMTYPE && verbose) 312 regulator_show(dev, ret); 313 if (ret & !error) 314 error = ret; 315 316 if (list_devp) 317 list_devp[i] = dev; 318 319 i++; 320 } 321 322 return error; 323 } 324 325 static bool regulator_name_is_unique(struct udevice *check_dev, 326 const char *check_name) 327 { 328 struct dm_regulator_uclass_platdata *uc_pdata; 329 struct udevice *dev; 330 int check_len = strlen(check_name); 331 int ret; 332 int len; 333 334 for (ret = uclass_find_first_device(UCLASS_REGULATOR, &dev); dev; 335 ret = uclass_find_next_device(&dev)) { 336 if (ret || dev == check_dev) 337 continue; 338 339 uc_pdata = dev_get_uclass_platdata(dev); 340 len = strlen(uc_pdata->name); 341 if (len != check_len) 342 continue; 343 344 if (!strcmp(uc_pdata->name, check_name)) 345 return false; 346 } 347 348 return true; 349 } 350 351 static int regulator_post_bind(struct udevice *dev) 352 { 353 struct dm_regulator_uclass_platdata *uc_pdata; 354 const char *property = "regulator-name"; 355 356 uc_pdata = dev_get_uclass_platdata(dev); 357 358 /* Regulator's mandatory constraint */ 359 uc_pdata->name = dev_read_string(dev, property); 360 if (!uc_pdata->name) { 361 debug("%s: dev '%s' has no property '%s'\n", 362 __func__, dev->name, property); 363 uc_pdata->name = dev_read_name(dev); 364 if (!uc_pdata->name) 365 return -EINVAL; 366 } 367 368 if (regulator_name_is_unique(dev, uc_pdata->name)) 369 return 0; 370 371 debug("'%s' of dev: '%s', has nonunique value: '%s\n", 372 property, dev->name, uc_pdata->name); 373 374 return -EINVAL; 375 } 376 377 static int regulator_pre_probe(struct udevice *dev) 378 { 379 struct dm_regulator_uclass_platdata *uc_pdata; 380 ofnode node; 381 382 uc_pdata = dev_get_uclass_platdata(dev); 383 if (!uc_pdata) 384 return -ENXIO; 385 386 /* Regulator's optional constraints */ 387 uc_pdata->min_uV = dev_read_u32_default(dev, "regulator-min-microvolt", 388 -ENODATA); 389 uc_pdata->max_uV = dev_read_u32_default(dev, "regulator-max-microvolt", 390 -ENODATA); 391 uc_pdata->init_uV = dev_read_u32_default(dev, "regulator-init-microvolt", 392 -ENODATA); 393 uc_pdata->min_uA = dev_read_u32_default(dev, "regulator-min-microamp", 394 -ENODATA); 395 uc_pdata->max_uA = dev_read_u32_default(dev, "regulator-max-microamp", 396 -ENODATA); 397 uc_pdata->always_on = dev_read_bool(dev, "regulator-always-on"); 398 uc_pdata->boot_on = dev_read_bool(dev, "regulator-boot-on"); 399 uc_pdata->ramp_delay = dev_read_u32_default(dev, "regulator-ramp-delay", 400 -ENODATA); 401 node = dev_read_subnode(dev, "regulator-state-mem"); 402 if (ofnode_valid(node)) { 403 uc_pdata->suspend_on = !ofnode_read_bool(node, "regulator-off-in-suspend"); 404 if (ofnode_read_u32(node, "regulator-suspend-microvolt", &uc_pdata->suspend_uV)) 405 uc_pdata->suspend_uV = uc_pdata->max_uA; 406 } else { 407 uc_pdata->suspend_on = true; 408 uc_pdata->suspend_uV = uc_pdata->max_uA; 409 } 410 411 /* Those values are optional (-ENODATA if unset) */ 412 if ((uc_pdata->min_uV != -ENODATA) && 413 (uc_pdata->max_uV != -ENODATA) && 414 (uc_pdata->min_uV == uc_pdata->max_uV)) 415 uc_pdata->flags |= REGULATOR_FLAG_AUTOSET_UV; 416 417 /* Those values are optional (-ENODATA if unset) */ 418 if ((uc_pdata->min_uA != -ENODATA) && 419 (uc_pdata->max_uA != -ENODATA) && 420 (uc_pdata->min_uA == uc_pdata->max_uA)) 421 uc_pdata->flags |= REGULATOR_FLAG_AUTOSET_UA; 422 423 debug("dev.name=%s: min_uV=%d, max_uV=%d, boot-on=%d, always-on=%d, " 424 "off-in-suspend=%d, suspend_volt=%d\n", 425 dev->name, uc_pdata->min_uV, uc_pdata->max_uV, uc_pdata->boot_on, 426 uc_pdata->always_on, !uc_pdata->suspend_on, uc_pdata->suspend_uV); 427 428 return 0; 429 } 430 431 int regulators_enable_boot_on(bool verbose) 432 { 433 struct udevice *dev; 434 struct uclass *uc; 435 int ret; 436 437 ret = uclass_get(UCLASS_REGULATOR, &uc); 438 if (ret) 439 return ret; 440 for (uclass_first_device(UCLASS_REGULATOR, &dev); 441 dev; 442 uclass_next_device(&dev)) { 443 ret = regulator_autoset(dev); 444 if (ret == -EMEDIUMTYPE) 445 ret = 0; 446 if (verbose) 447 regulator_show(dev, ret); 448 if (ret == -ENOSYS) 449 ret = 0; 450 } 451 452 return ret; 453 } 454 455 UCLASS_DRIVER(regulator) = { 456 .id = UCLASS_REGULATOR, 457 .name = "regulator", 458 .post_bind = regulator_post_bind, 459 .pre_probe = regulator_pre_probe, 460 .per_device_platdata_auto_alloc_size = 461 sizeof(struct dm_regulator_uclass_platdata), 462 }; 463