core.c revision 52b84dac436a681fa51dad2b9e57b6ea50309cbd
1/* 2 * core.c -- Voltage/Current Regulator framework. 3 * 4 * Copyright 2007, 2008 Wolfson Microelectronics PLC. 5 * Copyright 2008 SlimLogic Ltd. 6 * 7 * Author: Liam Girdwood <lrg@slimlogic.co.uk> 8 * 9 * This program is free software; you can redistribute it and/or modify it 10 * under the terms of the GNU General Public License as published by the 11 * Free Software Foundation; either version 2 of the License, or (at your 12 * option) any later version. 13 * 14 */ 15 16#include <linux/kernel.h> 17#include <linux/init.h> 18#include <linux/debugfs.h> 19#include <linux/device.h> 20#include <linux/slab.h> 21#include <linux/async.h> 22#include <linux/err.h> 23#include <linux/mutex.h> 24#include <linux/suspend.h> 25#include <linux/delay.h> 26#include <linux/gpio.h> 27#include <linux/of.h> 28#include <linux/regmap.h> 29#include <linux/regulator/of_regulator.h> 30#include <linux/regulator/consumer.h> 31#include <linux/regulator/driver.h> 32#include <linux/regulator/machine.h> 33#include <linux/module.h> 34 35#define CREATE_TRACE_POINTS 36#include <trace/events/regulator.h> 37 38#include "dummy.h" 39 40#define rdev_crit(rdev, fmt, ...) \ 41 pr_crit("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__) 42#define rdev_err(rdev, fmt, ...) \ 43 pr_err("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__) 44#define rdev_warn(rdev, fmt, ...) \ 45 pr_warn("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__) 46#define rdev_info(rdev, fmt, ...) \ 47 pr_info("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__) 48#define rdev_dbg(rdev, fmt, ...) \ 49 pr_debug("%s: " fmt, rdev_get_name(rdev), ##__VA_ARGS__) 50 51static DEFINE_MUTEX(regulator_list_mutex); 52static LIST_HEAD(regulator_list); 53static LIST_HEAD(regulator_map_list); 54static bool has_full_constraints; 55static bool board_wants_dummy_regulator; 56 57static struct dentry *debugfs_root; 58 59/* 60 * struct regulator_map 61 * 62 * Used to provide symbolic supply names to devices. 63 */ 64struct regulator_map { 65 struct list_head list; 66 const char *dev_name; /* The dev_name() for the consumer */ 67 const char *supply; 68 struct regulator_dev *regulator; 69}; 70 71/* 72 * struct regulator 73 * 74 * One for each consumer device. 75 */ 76struct regulator { 77 struct device *dev; 78 struct list_head list; 79 unsigned int always_on:1; 80 int uA_load; 81 int min_uV; 82 int max_uV; 83 char *supply_name; 84 struct device_attribute dev_attr; 85 struct regulator_dev *rdev; 86 struct dentry *debugfs; 87}; 88 89static int _regulator_is_enabled(struct regulator_dev *rdev); 90static int _regulator_disable(struct regulator_dev *rdev); 91static int _regulator_get_voltage(struct regulator_dev *rdev); 92static int _regulator_get_current_limit(struct regulator_dev *rdev); 93static unsigned int _regulator_get_mode(struct regulator_dev *rdev); 94static void _notifier_call_chain(struct regulator_dev *rdev, 95 unsigned long event, void *data); 96static int _regulator_do_set_voltage(struct regulator_dev *rdev, 97 int min_uV, int max_uV); 98static struct regulator *create_regulator(struct regulator_dev *rdev, 99 struct device *dev, 100 const char *supply_name); 101 102static const char *rdev_get_name(struct regulator_dev *rdev) 103{ 104 if (rdev->constraints && rdev->constraints->name) 105 return rdev->constraints->name; 106 else if (rdev->desc->name) 107 return rdev->desc->name; 108 else 109 return ""; 110} 111 112/** 113 * of_get_regulator - get a regulator device node based on supply name 114 * @dev: Device pointer for the consumer (of regulator) device 115 * @supply: regulator supply name 116 * 117 * Extract the regulator device node corresponding to the supply name. 118 * retruns the device node corresponding to the regulator if found, else 119 * returns NULL. 120 */ 121static struct device_node *of_get_regulator(struct device *dev, const char *supply) 122{ 123 struct device_node *regnode = NULL; 124 char prop_name[32]; /* 32 is max size of property name */ 125 126 dev_dbg(dev, "Looking up %s-supply from device tree\n", supply); 127 128 snprintf(prop_name, 32, "%s-supply", supply); 129 regnode = of_parse_phandle(dev->of_node, prop_name, 0); 130 131 if (!regnode) { 132 dev_dbg(dev, "Looking up %s property in node %s failed", 133 prop_name, dev->of_node->full_name); 134 return NULL; 135 } 136 return regnode; 137} 138 139static int _regulator_can_change_status(struct regulator_dev *rdev) 140{ 141 if (!rdev->constraints) 142 return 0; 143 144 if (rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_STATUS) 145 return 1; 146 else 147 return 0; 148} 149 150/* Platform voltage constraint check */ 151static int regulator_check_voltage(struct regulator_dev *rdev, 152 int *min_uV, int *max_uV) 153{ 154 BUG_ON(*min_uV > *max_uV); 155 156 if (!rdev->constraints) { 157 rdev_err(rdev, "no constraints\n"); 158 return -ENODEV; 159 } 160 if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_VOLTAGE)) { 161 rdev_err(rdev, "operation not allowed\n"); 162 return -EPERM; 163 } 164 165 if (*max_uV > rdev->constraints->max_uV) 166 *max_uV = rdev->constraints->max_uV; 167 if (*min_uV < rdev->constraints->min_uV) 168 *min_uV = rdev->constraints->min_uV; 169 170 if (*min_uV > *max_uV) { 171 rdev_err(rdev, "unsupportable voltage range: %d-%duV\n", 172 *min_uV, *max_uV); 173 return -EINVAL; 174 } 175 176 return 0; 177} 178 179/* Make sure we select a voltage that suits the needs of all 180 * regulator consumers 181 */ 182static int regulator_check_consumers(struct regulator_dev *rdev, 183 int *min_uV, int *max_uV) 184{ 185 struct regulator *regulator; 186 187 list_for_each_entry(regulator, &rdev->consumer_list, list) { 188 /* 189 * Assume consumers that didn't say anything are OK 190 * with anything in the constraint range. 191 */ 192 if (!regulator->min_uV && !regulator->max_uV) 193 continue; 194 195 if (*max_uV > regulator->max_uV) 196 *max_uV = regulator->max_uV; 197 if (*min_uV < regulator->min_uV) 198 *min_uV = regulator->min_uV; 199 } 200 201 if (*min_uV > *max_uV) 202 return -EINVAL; 203 204 return 0; 205} 206 207/* current constraint check */ 208static int regulator_check_current_limit(struct regulator_dev *rdev, 209 int *min_uA, int *max_uA) 210{ 211 BUG_ON(*min_uA > *max_uA); 212 213 if (!rdev->constraints) { 214 rdev_err(rdev, "no constraints\n"); 215 return -ENODEV; 216 } 217 if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_CURRENT)) { 218 rdev_err(rdev, "operation not allowed\n"); 219 return -EPERM; 220 } 221 222 if (*max_uA > rdev->constraints->max_uA) 223 *max_uA = rdev->constraints->max_uA; 224 if (*min_uA < rdev->constraints->min_uA) 225 *min_uA = rdev->constraints->min_uA; 226 227 if (*min_uA > *max_uA) { 228 rdev_err(rdev, "unsupportable current range: %d-%duA\n", 229 *min_uA, *max_uA); 230 return -EINVAL; 231 } 232 233 return 0; 234} 235 236/* operating mode constraint check */ 237static int regulator_mode_constrain(struct regulator_dev *rdev, int *mode) 238{ 239 switch (*mode) { 240 case REGULATOR_MODE_FAST: 241 case REGULATOR_MODE_NORMAL: 242 case REGULATOR_MODE_IDLE: 243 case REGULATOR_MODE_STANDBY: 244 break; 245 default: 246 rdev_err(rdev, "invalid mode %x specified\n", *mode); 247 return -EINVAL; 248 } 249 250 if (!rdev->constraints) { 251 rdev_err(rdev, "no constraints\n"); 252 return -ENODEV; 253 } 254 if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_MODE)) { 255 rdev_err(rdev, "operation not allowed\n"); 256 return -EPERM; 257 } 258 259 /* The modes are bitmasks, the most power hungry modes having 260 * the lowest values. If the requested mode isn't supported 261 * try higher modes. */ 262 while (*mode) { 263 if (rdev->constraints->valid_modes_mask & *mode) 264 return 0; 265 *mode /= 2; 266 } 267 268 return -EINVAL; 269} 270 271/* dynamic regulator mode switching constraint check */ 272static int regulator_check_drms(struct regulator_dev *rdev) 273{ 274 if (!rdev->constraints) { 275 rdev_err(rdev, "no constraints\n"); 276 return -ENODEV; 277 } 278 if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_DRMS)) { 279 rdev_err(rdev, "operation not allowed\n"); 280 return -EPERM; 281 } 282 return 0; 283} 284 285static ssize_t regulator_uV_show(struct device *dev, 286 struct device_attribute *attr, char *buf) 287{ 288 struct regulator_dev *rdev = dev_get_drvdata(dev); 289 ssize_t ret; 290 291 mutex_lock(&rdev->mutex); 292 ret = sprintf(buf, "%d\n", _regulator_get_voltage(rdev)); 293 mutex_unlock(&rdev->mutex); 294 295 return ret; 296} 297static DEVICE_ATTR(microvolts, 0444, regulator_uV_show, NULL); 298 299static ssize_t regulator_uA_show(struct device *dev, 300 struct device_attribute *attr, char *buf) 301{ 302 struct regulator_dev *rdev = dev_get_drvdata(dev); 303 304 return sprintf(buf, "%d\n", _regulator_get_current_limit(rdev)); 305} 306static DEVICE_ATTR(microamps, 0444, regulator_uA_show, NULL); 307 308static ssize_t regulator_name_show(struct device *dev, 309 struct device_attribute *attr, char *buf) 310{ 311 struct regulator_dev *rdev = dev_get_drvdata(dev); 312 313 return sprintf(buf, "%s\n", rdev_get_name(rdev)); 314} 315 316static ssize_t regulator_print_opmode(char *buf, int mode) 317{ 318 switch (mode) { 319 case REGULATOR_MODE_FAST: 320 return sprintf(buf, "fast\n"); 321 case REGULATOR_MODE_NORMAL: 322 return sprintf(buf, "normal\n"); 323 case REGULATOR_MODE_IDLE: 324 return sprintf(buf, "idle\n"); 325 case REGULATOR_MODE_STANDBY: 326 return sprintf(buf, "standby\n"); 327 } 328 return sprintf(buf, "unknown\n"); 329} 330 331static ssize_t regulator_opmode_show(struct device *dev, 332 struct device_attribute *attr, char *buf) 333{ 334 struct regulator_dev *rdev = dev_get_drvdata(dev); 335 336 return regulator_print_opmode(buf, _regulator_get_mode(rdev)); 337} 338static DEVICE_ATTR(opmode, 0444, regulator_opmode_show, NULL); 339 340static ssize_t regulator_print_state(char *buf, int state) 341{ 342 if (state > 0) 343 return sprintf(buf, "enabled\n"); 344 else if (state == 0) 345 return sprintf(buf, "disabled\n"); 346 else 347 return sprintf(buf, "unknown\n"); 348} 349 350static ssize_t regulator_state_show(struct device *dev, 351 struct device_attribute *attr, char *buf) 352{ 353 struct regulator_dev *rdev = dev_get_drvdata(dev); 354 ssize_t ret; 355 356 mutex_lock(&rdev->mutex); 357 ret = regulator_print_state(buf, _regulator_is_enabled(rdev)); 358 mutex_unlock(&rdev->mutex); 359 360 return ret; 361} 362static DEVICE_ATTR(state, 0444, regulator_state_show, NULL); 363 364static ssize_t regulator_status_show(struct device *dev, 365 struct device_attribute *attr, char *buf) 366{ 367 struct regulator_dev *rdev = dev_get_drvdata(dev); 368 int status; 369 char *label; 370 371 status = rdev->desc->ops->get_status(rdev); 372 if (status < 0) 373 return status; 374 375 switch (status) { 376 case REGULATOR_STATUS_OFF: 377 label = "off"; 378 break; 379 case REGULATOR_STATUS_ON: 380 label = "on"; 381 break; 382 case REGULATOR_STATUS_ERROR: 383 label = "error"; 384 break; 385 case REGULATOR_STATUS_FAST: 386 label = "fast"; 387 break; 388 case REGULATOR_STATUS_NORMAL: 389 label = "normal"; 390 break; 391 case REGULATOR_STATUS_IDLE: 392 label = "idle"; 393 break; 394 case REGULATOR_STATUS_STANDBY: 395 label = "standby"; 396 break; 397 case REGULATOR_STATUS_UNDEFINED: 398 label = "undefined"; 399 break; 400 default: 401 return -ERANGE; 402 } 403 404 return sprintf(buf, "%s\n", label); 405} 406static DEVICE_ATTR(status, 0444, regulator_status_show, NULL); 407 408static ssize_t regulator_min_uA_show(struct device *dev, 409 struct device_attribute *attr, char *buf) 410{ 411 struct regulator_dev *rdev = dev_get_drvdata(dev); 412 413 if (!rdev->constraints) 414 return sprintf(buf, "constraint not defined\n"); 415 416 return sprintf(buf, "%d\n", rdev->constraints->min_uA); 417} 418static DEVICE_ATTR(min_microamps, 0444, regulator_min_uA_show, NULL); 419 420static ssize_t regulator_max_uA_show(struct device *dev, 421 struct device_attribute *attr, char *buf) 422{ 423 struct regulator_dev *rdev = dev_get_drvdata(dev); 424 425 if (!rdev->constraints) 426 return sprintf(buf, "constraint not defined\n"); 427 428 return sprintf(buf, "%d\n", rdev->constraints->max_uA); 429} 430static DEVICE_ATTR(max_microamps, 0444, regulator_max_uA_show, NULL); 431 432static ssize_t regulator_min_uV_show(struct device *dev, 433 struct device_attribute *attr, char *buf) 434{ 435 struct regulator_dev *rdev = dev_get_drvdata(dev); 436 437 if (!rdev->constraints) 438 return sprintf(buf, "constraint not defined\n"); 439 440 return sprintf(buf, "%d\n", rdev->constraints->min_uV); 441} 442static DEVICE_ATTR(min_microvolts, 0444, regulator_min_uV_show, NULL); 443 444static ssize_t regulator_max_uV_show(struct device *dev, 445 struct device_attribute *attr, char *buf) 446{ 447 struct regulator_dev *rdev = dev_get_drvdata(dev); 448 449 if (!rdev->constraints) 450 return sprintf(buf, "constraint not defined\n"); 451 452 return sprintf(buf, "%d\n", rdev->constraints->max_uV); 453} 454static DEVICE_ATTR(max_microvolts, 0444, regulator_max_uV_show, NULL); 455 456static ssize_t regulator_total_uA_show(struct device *dev, 457 struct device_attribute *attr, char *buf) 458{ 459 struct regulator_dev *rdev = dev_get_drvdata(dev); 460 struct regulator *regulator; 461 int uA = 0; 462 463 mutex_lock(&rdev->mutex); 464 list_for_each_entry(regulator, &rdev->consumer_list, list) 465 uA += regulator->uA_load; 466 mutex_unlock(&rdev->mutex); 467 return sprintf(buf, "%d\n", uA); 468} 469static DEVICE_ATTR(requested_microamps, 0444, regulator_total_uA_show, NULL); 470 471static ssize_t regulator_num_users_show(struct device *dev, 472 struct device_attribute *attr, char *buf) 473{ 474 struct regulator_dev *rdev = dev_get_drvdata(dev); 475 return sprintf(buf, "%d\n", rdev->use_count); 476} 477 478static ssize_t regulator_type_show(struct device *dev, 479 struct device_attribute *attr, char *buf) 480{ 481 struct regulator_dev *rdev = dev_get_drvdata(dev); 482 483 switch (rdev->desc->type) { 484 case REGULATOR_VOLTAGE: 485 return sprintf(buf, "voltage\n"); 486 case REGULATOR_CURRENT: 487 return sprintf(buf, "current\n"); 488 } 489 return sprintf(buf, "unknown\n"); 490} 491 492static ssize_t regulator_suspend_mem_uV_show(struct device *dev, 493 struct device_attribute *attr, char *buf) 494{ 495 struct regulator_dev *rdev = dev_get_drvdata(dev); 496 497 return sprintf(buf, "%d\n", rdev->constraints->state_mem.uV); 498} 499static DEVICE_ATTR(suspend_mem_microvolts, 0444, 500 regulator_suspend_mem_uV_show, NULL); 501 502static ssize_t regulator_suspend_disk_uV_show(struct device *dev, 503 struct device_attribute *attr, char *buf) 504{ 505 struct regulator_dev *rdev = dev_get_drvdata(dev); 506 507 return sprintf(buf, "%d\n", rdev->constraints->state_disk.uV); 508} 509static DEVICE_ATTR(suspend_disk_microvolts, 0444, 510 regulator_suspend_disk_uV_show, NULL); 511 512static ssize_t regulator_suspend_standby_uV_show(struct device *dev, 513 struct device_attribute *attr, char *buf) 514{ 515 struct regulator_dev *rdev = dev_get_drvdata(dev); 516 517 return sprintf(buf, "%d\n", rdev->constraints->state_standby.uV); 518} 519static DEVICE_ATTR(suspend_standby_microvolts, 0444, 520 regulator_suspend_standby_uV_show, NULL); 521 522static ssize_t regulator_suspend_mem_mode_show(struct device *dev, 523 struct device_attribute *attr, char *buf) 524{ 525 struct regulator_dev *rdev = dev_get_drvdata(dev); 526 527 return regulator_print_opmode(buf, 528 rdev->constraints->state_mem.mode); 529} 530static DEVICE_ATTR(suspend_mem_mode, 0444, 531 regulator_suspend_mem_mode_show, NULL); 532 533static ssize_t regulator_suspend_disk_mode_show(struct device *dev, 534 struct device_attribute *attr, char *buf) 535{ 536 struct regulator_dev *rdev = dev_get_drvdata(dev); 537 538 return regulator_print_opmode(buf, 539 rdev->constraints->state_disk.mode); 540} 541static DEVICE_ATTR(suspend_disk_mode, 0444, 542 regulator_suspend_disk_mode_show, NULL); 543 544static ssize_t regulator_suspend_standby_mode_show(struct device *dev, 545 struct device_attribute *attr, char *buf) 546{ 547 struct regulator_dev *rdev = dev_get_drvdata(dev); 548 549 return regulator_print_opmode(buf, 550 rdev->constraints->state_standby.mode); 551} 552static DEVICE_ATTR(suspend_standby_mode, 0444, 553 regulator_suspend_standby_mode_show, NULL); 554 555static ssize_t regulator_suspend_mem_state_show(struct device *dev, 556 struct device_attribute *attr, char *buf) 557{ 558 struct regulator_dev *rdev = dev_get_drvdata(dev); 559 560 return regulator_print_state(buf, 561 rdev->constraints->state_mem.enabled); 562} 563static DEVICE_ATTR(suspend_mem_state, 0444, 564 regulator_suspend_mem_state_show, NULL); 565 566static ssize_t regulator_suspend_disk_state_show(struct device *dev, 567 struct device_attribute *attr, char *buf) 568{ 569 struct regulator_dev *rdev = dev_get_drvdata(dev); 570 571 return regulator_print_state(buf, 572 rdev->constraints->state_disk.enabled); 573} 574static DEVICE_ATTR(suspend_disk_state, 0444, 575 regulator_suspend_disk_state_show, NULL); 576 577static ssize_t regulator_suspend_standby_state_show(struct device *dev, 578 struct device_attribute *attr, char *buf) 579{ 580 struct regulator_dev *rdev = dev_get_drvdata(dev); 581 582 return regulator_print_state(buf, 583 rdev->constraints->state_standby.enabled); 584} 585static DEVICE_ATTR(suspend_standby_state, 0444, 586 regulator_suspend_standby_state_show, NULL); 587 588 589/* 590 * These are the only attributes are present for all regulators. 591 * Other attributes are a function of regulator functionality. 592 */ 593static struct device_attribute regulator_dev_attrs[] = { 594 __ATTR(name, 0444, regulator_name_show, NULL), 595 __ATTR(num_users, 0444, regulator_num_users_show, NULL), 596 __ATTR(type, 0444, regulator_type_show, NULL), 597 __ATTR_NULL, 598}; 599 600static void regulator_dev_release(struct device *dev) 601{ 602 struct regulator_dev *rdev = dev_get_drvdata(dev); 603 kfree(rdev); 604} 605 606static struct class regulator_class = { 607 .name = "regulator", 608 .dev_release = regulator_dev_release, 609 .dev_attrs = regulator_dev_attrs, 610}; 611 612/* Calculate the new optimum regulator operating mode based on the new total 613 * consumer load. All locks held by caller */ 614static void drms_uA_update(struct regulator_dev *rdev) 615{ 616 struct regulator *sibling; 617 int current_uA = 0, output_uV, input_uV, err; 618 unsigned int mode; 619 620 err = regulator_check_drms(rdev); 621 if (err < 0 || !rdev->desc->ops->get_optimum_mode || 622 (!rdev->desc->ops->get_voltage && 623 !rdev->desc->ops->get_voltage_sel) || 624 !rdev->desc->ops->set_mode) 625 return; 626 627 /* get output voltage */ 628 output_uV = _regulator_get_voltage(rdev); 629 if (output_uV <= 0) 630 return; 631 632 /* get input voltage */ 633 input_uV = 0; 634 if (rdev->supply) 635 input_uV = regulator_get_voltage(rdev->supply); 636 if (input_uV <= 0) 637 input_uV = rdev->constraints->input_uV; 638 if (input_uV <= 0) 639 return; 640 641 /* calc total requested load */ 642 list_for_each_entry(sibling, &rdev->consumer_list, list) 643 current_uA += sibling->uA_load; 644 645 /* now get the optimum mode for our new total regulator load */ 646 mode = rdev->desc->ops->get_optimum_mode(rdev, input_uV, 647 output_uV, current_uA); 648 649 /* check the new mode is allowed */ 650 err = regulator_mode_constrain(rdev, &mode); 651 if (err == 0) 652 rdev->desc->ops->set_mode(rdev, mode); 653} 654 655static int suspend_set_state(struct regulator_dev *rdev, 656 struct regulator_state *rstate) 657{ 658 int ret = 0; 659 660 /* If we have no suspend mode configration don't set anything; 661 * only warn if the driver implements set_suspend_voltage or 662 * set_suspend_mode callback. 663 */ 664 if (!rstate->enabled && !rstate->disabled) { 665 if (rdev->desc->ops->set_suspend_voltage || 666 rdev->desc->ops->set_suspend_mode) 667 rdev_warn(rdev, "No configuration\n"); 668 return 0; 669 } 670 671 if (rstate->enabled && rstate->disabled) { 672 rdev_err(rdev, "invalid configuration\n"); 673 return -EINVAL; 674 } 675 676 if (rstate->enabled && rdev->desc->ops->set_suspend_enable) 677 ret = rdev->desc->ops->set_suspend_enable(rdev); 678 else if (rstate->disabled && rdev->desc->ops->set_suspend_disable) 679 ret = rdev->desc->ops->set_suspend_disable(rdev); 680 else /* OK if set_suspend_enable or set_suspend_disable is NULL */ 681 ret = 0; 682 683 if (ret < 0) { 684 rdev_err(rdev, "failed to enabled/disable\n"); 685 return ret; 686 } 687 688 if (rdev->desc->ops->set_suspend_voltage && rstate->uV > 0) { 689 ret = rdev->desc->ops->set_suspend_voltage(rdev, rstate->uV); 690 if (ret < 0) { 691 rdev_err(rdev, "failed to set voltage\n"); 692 return ret; 693 } 694 } 695 696 if (rdev->desc->ops->set_suspend_mode && rstate->mode > 0) { 697 ret = rdev->desc->ops->set_suspend_mode(rdev, rstate->mode); 698 if (ret < 0) { 699 rdev_err(rdev, "failed to set mode\n"); 700 return ret; 701 } 702 } 703 return ret; 704} 705 706/* locks held by caller */ 707static int suspend_prepare(struct regulator_dev *rdev, suspend_state_t state) 708{ 709 if (!rdev->constraints) 710 return -EINVAL; 711 712 switch (state) { 713 case PM_SUSPEND_STANDBY: 714 return suspend_set_state(rdev, 715 &rdev->constraints->state_standby); 716 case PM_SUSPEND_MEM: 717 return suspend_set_state(rdev, 718 &rdev->constraints->state_mem); 719 case PM_SUSPEND_MAX: 720 return suspend_set_state(rdev, 721 &rdev->constraints->state_disk); 722 default: 723 return -EINVAL; 724 } 725} 726 727static void print_constraints(struct regulator_dev *rdev) 728{ 729 struct regulation_constraints *constraints = rdev->constraints; 730 char buf[80] = ""; 731 int count = 0; 732 int ret; 733 734 if (constraints->min_uV && constraints->max_uV) { 735 if (constraints->min_uV == constraints->max_uV) 736 count += sprintf(buf + count, "%d mV ", 737 constraints->min_uV / 1000); 738 else 739 count += sprintf(buf + count, "%d <--> %d mV ", 740 constraints->min_uV / 1000, 741 constraints->max_uV / 1000); 742 } 743 744 if (!constraints->min_uV || 745 constraints->min_uV != constraints->max_uV) { 746 ret = _regulator_get_voltage(rdev); 747 if (ret > 0) 748 count += sprintf(buf + count, "at %d mV ", ret / 1000); 749 } 750 751 if (constraints->uV_offset) 752 count += sprintf(buf, "%dmV offset ", 753 constraints->uV_offset / 1000); 754 755 if (constraints->min_uA && constraints->max_uA) { 756 if (constraints->min_uA == constraints->max_uA) 757 count += sprintf(buf + count, "%d mA ", 758 constraints->min_uA / 1000); 759 else 760 count += sprintf(buf + count, "%d <--> %d mA ", 761 constraints->min_uA / 1000, 762 constraints->max_uA / 1000); 763 } 764 765 if (!constraints->min_uA || 766 constraints->min_uA != constraints->max_uA) { 767 ret = _regulator_get_current_limit(rdev); 768 if (ret > 0) 769 count += sprintf(buf + count, "at %d mA ", ret / 1000); 770 } 771 772 if (constraints->valid_modes_mask & REGULATOR_MODE_FAST) 773 count += sprintf(buf + count, "fast "); 774 if (constraints->valid_modes_mask & REGULATOR_MODE_NORMAL) 775 count += sprintf(buf + count, "normal "); 776 if (constraints->valid_modes_mask & REGULATOR_MODE_IDLE) 777 count += sprintf(buf + count, "idle "); 778 if (constraints->valid_modes_mask & REGULATOR_MODE_STANDBY) 779 count += sprintf(buf + count, "standby"); 780 781 if (!count) 782 sprintf(buf, "no parameters"); 783 784 rdev_info(rdev, "%s\n", buf); 785 786 if ((constraints->min_uV != constraints->max_uV) && 787 !(constraints->valid_ops_mask & REGULATOR_CHANGE_VOLTAGE)) 788 rdev_warn(rdev, 789 "Voltage range but no REGULATOR_CHANGE_VOLTAGE\n"); 790} 791 792static int machine_constraints_voltage(struct regulator_dev *rdev, 793 struct regulation_constraints *constraints) 794{ 795 struct regulator_ops *ops = rdev->desc->ops; 796 int ret; 797 798 /* do we need to apply the constraint voltage */ 799 if (rdev->constraints->apply_uV && 800 rdev->constraints->min_uV == rdev->constraints->max_uV) { 801 ret = _regulator_do_set_voltage(rdev, 802 rdev->constraints->min_uV, 803 rdev->constraints->max_uV); 804 if (ret < 0) { 805 rdev_err(rdev, "failed to apply %duV constraint\n", 806 rdev->constraints->min_uV); 807 return ret; 808 } 809 } 810 811 /* constrain machine-level voltage specs to fit 812 * the actual range supported by this regulator. 813 */ 814 if (ops->list_voltage && rdev->desc->n_voltages) { 815 int count = rdev->desc->n_voltages; 816 int i; 817 int min_uV = INT_MAX; 818 int max_uV = INT_MIN; 819 int cmin = constraints->min_uV; 820 int cmax = constraints->max_uV; 821 822 /* it's safe to autoconfigure fixed-voltage supplies 823 and the constraints are used by list_voltage. */ 824 if (count == 1 && !cmin) { 825 cmin = 1; 826 cmax = INT_MAX; 827 constraints->min_uV = cmin; 828 constraints->max_uV = cmax; 829 } 830 831 /* voltage constraints are optional */ 832 if ((cmin == 0) && (cmax == 0)) 833 return 0; 834 835 /* else require explicit machine-level constraints */ 836 if (cmin <= 0 || cmax <= 0 || cmax < cmin) { 837 rdev_err(rdev, "invalid voltage constraints\n"); 838 return -EINVAL; 839 } 840 841 /* initial: [cmin..cmax] valid, [min_uV..max_uV] not */ 842 for (i = 0; i < count; i++) { 843 int value; 844 845 value = ops->list_voltage(rdev, i); 846 if (value <= 0) 847 continue; 848 849 /* maybe adjust [min_uV..max_uV] */ 850 if (value >= cmin && value < min_uV) 851 min_uV = value; 852 if (value <= cmax && value > max_uV) 853 max_uV = value; 854 } 855 856 /* final: [min_uV..max_uV] valid iff constraints valid */ 857 if (max_uV < min_uV) { 858 rdev_err(rdev, "unsupportable voltage constraints\n"); 859 return -EINVAL; 860 } 861 862 /* use regulator's subset of machine constraints */ 863 if (constraints->min_uV < min_uV) { 864 rdev_dbg(rdev, "override min_uV, %d -> %d\n", 865 constraints->min_uV, min_uV); 866 constraints->min_uV = min_uV; 867 } 868 if (constraints->max_uV > max_uV) { 869 rdev_dbg(rdev, "override max_uV, %d -> %d\n", 870 constraints->max_uV, max_uV); 871 constraints->max_uV = max_uV; 872 } 873 } 874 875 return 0; 876} 877 878/** 879 * set_machine_constraints - sets regulator constraints 880 * @rdev: regulator source 881 * @constraints: constraints to apply 882 * 883 * Allows platform initialisation code to define and constrain 884 * regulator circuits e.g. valid voltage/current ranges, etc. NOTE: 885 * Constraints *must* be set by platform code in order for some 886 * regulator operations to proceed i.e. set_voltage, set_current_limit, 887 * set_mode. 888 */ 889static int set_machine_constraints(struct regulator_dev *rdev, 890 const struct regulation_constraints *constraints) 891{ 892 int ret = 0; 893 struct regulator_ops *ops = rdev->desc->ops; 894 895 if (constraints) 896 rdev->constraints = kmemdup(constraints, sizeof(*constraints), 897 GFP_KERNEL); 898 else 899 rdev->constraints = kzalloc(sizeof(*constraints), 900 GFP_KERNEL); 901 if (!rdev->constraints) 902 return -ENOMEM; 903 904 ret = machine_constraints_voltage(rdev, rdev->constraints); 905 if (ret != 0) 906 goto out; 907 908 /* do we need to setup our suspend state */ 909 if (rdev->constraints->initial_state) { 910 ret = suspend_prepare(rdev, rdev->constraints->initial_state); 911 if (ret < 0) { 912 rdev_err(rdev, "failed to set suspend state\n"); 913 goto out; 914 } 915 } 916 917 if (rdev->constraints->initial_mode) { 918 if (!ops->set_mode) { 919 rdev_err(rdev, "no set_mode operation\n"); 920 ret = -EINVAL; 921 goto out; 922 } 923 924 ret = ops->set_mode(rdev, rdev->constraints->initial_mode); 925 if (ret < 0) { 926 rdev_err(rdev, "failed to set initial mode: %d\n", ret); 927 goto out; 928 } 929 } 930 931 /* If the constraints say the regulator should be on at this point 932 * and we have control then make sure it is enabled. 933 */ 934 if ((rdev->constraints->always_on || rdev->constraints->boot_on) && 935 ops->enable) { 936 ret = ops->enable(rdev); 937 if (ret < 0) { 938 rdev_err(rdev, "failed to enable\n"); 939 goto out; 940 } 941 } 942 943 if (rdev->constraints->ramp_delay && ops->set_ramp_delay) { 944 ret = ops->set_ramp_delay(rdev, rdev->constraints->ramp_delay); 945 if (ret < 0) { 946 rdev_err(rdev, "failed to set ramp_delay\n"); 947 goto out; 948 } 949 } 950 951 print_constraints(rdev); 952 return 0; 953out: 954 kfree(rdev->constraints); 955 rdev->constraints = NULL; 956 return ret; 957} 958 959/** 960 * set_supply - set regulator supply regulator 961 * @rdev: regulator name 962 * @supply_rdev: supply regulator name 963 * 964 * Called by platform initialisation code to set the supply regulator for this 965 * regulator. This ensures that a regulators supply will also be enabled by the 966 * core if it's child is enabled. 967 */ 968static int set_supply(struct regulator_dev *rdev, 969 struct regulator_dev *supply_rdev) 970{ 971 int err; 972 973 rdev_info(rdev, "supplied by %s\n", rdev_get_name(supply_rdev)); 974 975 rdev->supply = create_regulator(supply_rdev, &rdev->dev, "SUPPLY"); 976 if (rdev->supply == NULL) { 977 err = -ENOMEM; 978 return err; 979 } 980 supply_rdev->open_count++; 981 982 return 0; 983} 984 985/** 986 * set_consumer_device_supply - Bind a regulator to a symbolic supply 987 * @rdev: regulator source 988 * @consumer_dev_name: dev_name() string for device supply applies to 989 * @supply: symbolic name for supply 990 * 991 * Allows platform initialisation code to map physical regulator 992 * sources to symbolic names for supplies for use by devices. Devices 993 * should use these symbolic names to request regulators, avoiding the 994 * need to provide board-specific regulator names as platform data. 995 */ 996static int set_consumer_device_supply(struct regulator_dev *rdev, 997 const char *consumer_dev_name, 998 const char *supply) 999{ 1000 struct regulator_map *node; 1001 int has_dev; 1002 1003 if (supply == NULL) 1004 return -EINVAL; 1005 1006 if (consumer_dev_name != NULL) 1007 has_dev = 1; 1008 else 1009 has_dev = 0; 1010 1011 list_for_each_entry(node, ®ulator_map_list, list) { 1012 if (node->dev_name && consumer_dev_name) { 1013 if (strcmp(node->dev_name, consumer_dev_name) != 0) 1014 continue; 1015 } else if (node->dev_name || consumer_dev_name) { 1016 continue; 1017 } 1018 1019 if (strcmp(node->supply, supply) != 0) 1020 continue; 1021 1022 pr_debug("%s: %s/%s is '%s' supply; fail %s/%s\n", 1023 consumer_dev_name, 1024 dev_name(&node->regulator->dev), 1025 node->regulator->desc->name, 1026 supply, 1027 dev_name(&rdev->dev), rdev_get_name(rdev)); 1028 return -EBUSY; 1029 } 1030 1031 node = kzalloc(sizeof(struct regulator_map), GFP_KERNEL); 1032 if (node == NULL) 1033 return -ENOMEM; 1034 1035 node->regulator = rdev; 1036 node->supply = supply; 1037 1038 if (has_dev) { 1039 node->dev_name = kstrdup(consumer_dev_name, GFP_KERNEL); 1040 if (node->dev_name == NULL) { 1041 kfree(node); 1042 return -ENOMEM; 1043 } 1044 } 1045 1046 list_add(&node->list, ®ulator_map_list); 1047 return 0; 1048} 1049 1050static void unset_regulator_supplies(struct regulator_dev *rdev) 1051{ 1052 struct regulator_map *node, *n; 1053 1054 list_for_each_entry_safe(node, n, ®ulator_map_list, list) { 1055 if (rdev == node->regulator) { 1056 list_del(&node->list); 1057 kfree(node->dev_name); 1058 kfree(node); 1059 } 1060 } 1061} 1062 1063#define REG_STR_SIZE 64 1064 1065static struct regulator *create_regulator(struct regulator_dev *rdev, 1066 struct device *dev, 1067 const char *supply_name) 1068{ 1069 struct regulator *regulator; 1070 char buf[REG_STR_SIZE]; 1071 int err, size; 1072 1073 regulator = kzalloc(sizeof(*regulator), GFP_KERNEL); 1074 if (regulator == NULL) 1075 return NULL; 1076 1077 mutex_lock(&rdev->mutex); 1078 regulator->rdev = rdev; 1079 list_add(®ulator->list, &rdev->consumer_list); 1080 1081 if (dev) { 1082 regulator->dev = dev; 1083 1084 /* Add a link to the device sysfs entry */ 1085 size = scnprintf(buf, REG_STR_SIZE, "%s-%s", 1086 dev->kobj.name, supply_name); 1087 if (size >= REG_STR_SIZE) 1088 goto overflow_err; 1089 1090 regulator->supply_name = kstrdup(buf, GFP_KERNEL); 1091 if (regulator->supply_name == NULL) 1092 goto overflow_err; 1093 1094 err = sysfs_create_link(&rdev->dev.kobj, &dev->kobj, 1095 buf); 1096 if (err) { 1097 rdev_warn(rdev, "could not add device link %s err %d\n", 1098 dev->kobj.name, err); 1099 /* non-fatal */ 1100 } 1101 } else { 1102 regulator->supply_name = kstrdup(supply_name, GFP_KERNEL); 1103 if (regulator->supply_name == NULL) 1104 goto overflow_err; 1105 } 1106 1107 regulator->debugfs = debugfs_create_dir(regulator->supply_name, 1108 rdev->debugfs); 1109 if (!regulator->debugfs) { 1110 rdev_warn(rdev, "Failed to create debugfs directory\n"); 1111 } else { 1112 debugfs_create_u32("uA_load", 0444, regulator->debugfs, 1113 ®ulator->uA_load); 1114 debugfs_create_u32("min_uV", 0444, regulator->debugfs, 1115 ®ulator->min_uV); 1116 debugfs_create_u32("max_uV", 0444, regulator->debugfs, 1117 ®ulator->max_uV); 1118 } 1119 1120 /* 1121 * Check now if the regulator is an always on regulator - if 1122 * it is then we don't need to do nearly so much work for 1123 * enable/disable calls. 1124 */ 1125 if (!_regulator_can_change_status(rdev) && 1126 _regulator_is_enabled(rdev)) 1127 regulator->always_on = true; 1128 1129 mutex_unlock(&rdev->mutex); 1130 return regulator; 1131overflow_err: 1132 list_del(®ulator->list); 1133 kfree(regulator); 1134 mutex_unlock(&rdev->mutex); 1135 return NULL; 1136} 1137 1138static int _regulator_get_enable_time(struct regulator_dev *rdev) 1139{ 1140 if (!rdev->desc->ops->enable_time) 1141 return rdev->desc->enable_time; 1142 return rdev->desc->ops->enable_time(rdev); 1143} 1144 1145static struct regulator_dev *regulator_dev_lookup(struct device *dev, 1146 const char *supply, 1147 int *ret) 1148{ 1149 struct regulator_dev *r; 1150 struct device_node *node; 1151 struct regulator_map *map; 1152 const char *devname = NULL; 1153 1154 /* first do a dt based lookup */ 1155 if (dev && dev->of_node) { 1156 node = of_get_regulator(dev, supply); 1157 if (node) { 1158 list_for_each_entry(r, ®ulator_list, list) 1159 if (r->dev.parent && 1160 node == r->dev.of_node) 1161 return r; 1162 } else { 1163 /* 1164 * If we couldn't even get the node then it's 1165 * not just that the device didn't register 1166 * yet, there's no node and we'll never 1167 * succeed. 1168 */ 1169 *ret = -ENODEV; 1170 } 1171 } 1172 1173 /* if not found, try doing it non-dt way */ 1174 if (dev) 1175 devname = dev_name(dev); 1176 1177 list_for_each_entry(r, ®ulator_list, list) 1178 if (strcmp(rdev_get_name(r), supply) == 0) 1179 return r; 1180 1181 list_for_each_entry(map, ®ulator_map_list, list) { 1182 /* If the mapping has a device set up it must match */ 1183 if (map->dev_name && 1184 (!devname || strcmp(map->dev_name, devname))) 1185 continue; 1186 1187 if (strcmp(map->supply, supply) == 0) 1188 return map->regulator; 1189 } 1190 1191 1192 return NULL; 1193} 1194 1195/* Internal regulator request function */ 1196static struct regulator *_regulator_get(struct device *dev, const char *id, 1197 int exclusive) 1198{ 1199 struct regulator_dev *rdev; 1200 struct regulator *regulator = ERR_PTR(-EPROBE_DEFER); 1201 const char *devname = NULL; 1202 int ret; 1203 1204 if (id == NULL) { 1205 pr_err("get() with no identifier\n"); 1206 return regulator; 1207 } 1208 1209 if (dev) 1210 devname = dev_name(dev); 1211 1212 mutex_lock(®ulator_list_mutex); 1213 1214 rdev = regulator_dev_lookup(dev, id, &ret); 1215 if (rdev) 1216 goto found; 1217 1218 if (board_wants_dummy_regulator) { 1219 rdev = dummy_regulator_rdev; 1220 goto found; 1221 } 1222 1223#ifdef CONFIG_REGULATOR_DUMMY 1224 if (!devname) 1225 devname = "deviceless"; 1226 1227 /* If the board didn't flag that it was fully constrained then 1228 * substitute in a dummy regulator so consumers can continue. 1229 */ 1230 if (!has_full_constraints) { 1231 pr_warn("%s supply %s not found, using dummy regulator\n", 1232 devname, id); 1233 rdev = dummy_regulator_rdev; 1234 goto found; 1235 } 1236#endif 1237 1238 mutex_unlock(®ulator_list_mutex); 1239 return regulator; 1240 1241found: 1242 if (rdev->exclusive) { 1243 regulator = ERR_PTR(-EPERM); 1244 goto out; 1245 } 1246 1247 if (exclusive && rdev->open_count) { 1248 regulator = ERR_PTR(-EBUSY); 1249 goto out; 1250 } 1251 1252 if (!try_module_get(rdev->owner)) 1253 goto out; 1254 1255 regulator = create_regulator(rdev, dev, id); 1256 if (regulator == NULL) { 1257 regulator = ERR_PTR(-ENOMEM); 1258 module_put(rdev->owner); 1259 goto out; 1260 } 1261 1262 rdev->open_count++; 1263 if (exclusive) { 1264 rdev->exclusive = 1; 1265 1266 ret = _regulator_is_enabled(rdev); 1267 if (ret > 0) 1268 rdev->use_count = 1; 1269 else 1270 rdev->use_count = 0; 1271 } 1272 1273out: 1274 mutex_unlock(®ulator_list_mutex); 1275 1276 return regulator; 1277} 1278 1279/** 1280 * regulator_get - lookup and obtain a reference to a regulator. 1281 * @dev: device for regulator "consumer" 1282 * @id: Supply name or regulator ID. 1283 * 1284 * Returns a struct regulator corresponding to the regulator producer, 1285 * or IS_ERR() condition containing errno. 1286 * 1287 * Use of supply names configured via regulator_set_device_supply() is 1288 * strongly encouraged. It is recommended that the supply name used 1289 * should match the name used for the supply and/or the relevant 1290 * device pins in the datasheet. 1291 */ 1292struct regulator *regulator_get(struct device *dev, const char *id) 1293{ 1294 return _regulator_get(dev, id, 0); 1295} 1296EXPORT_SYMBOL_GPL(regulator_get); 1297 1298static void devm_regulator_release(struct device *dev, void *res) 1299{ 1300 regulator_put(*(struct regulator **)res); 1301} 1302 1303/** 1304 * devm_regulator_get - Resource managed regulator_get() 1305 * @dev: device for regulator "consumer" 1306 * @id: Supply name or regulator ID. 1307 * 1308 * Managed regulator_get(). Regulators returned from this function are 1309 * automatically regulator_put() on driver detach. See regulator_get() for more 1310 * information. 1311 */ 1312struct regulator *devm_regulator_get(struct device *dev, const char *id) 1313{ 1314 struct regulator **ptr, *regulator; 1315 1316 ptr = devres_alloc(devm_regulator_release, sizeof(*ptr), GFP_KERNEL); 1317 if (!ptr) 1318 return ERR_PTR(-ENOMEM); 1319 1320 regulator = regulator_get(dev, id); 1321 if (!IS_ERR(regulator)) { 1322 *ptr = regulator; 1323 devres_add(dev, ptr); 1324 } else { 1325 devres_free(ptr); 1326 } 1327 1328 return regulator; 1329} 1330EXPORT_SYMBOL_GPL(devm_regulator_get); 1331 1332/** 1333 * regulator_get_exclusive - obtain exclusive access to a regulator. 1334 * @dev: device for regulator "consumer" 1335 * @id: Supply name or regulator ID. 1336 * 1337 * Returns a struct regulator corresponding to the regulator producer, 1338 * or IS_ERR() condition containing errno. Other consumers will be 1339 * unable to obtain this reference is held and the use count for the 1340 * regulator will be initialised to reflect the current state of the 1341 * regulator. 1342 * 1343 * This is intended for use by consumers which cannot tolerate shared 1344 * use of the regulator such as those which need to force the 1345 * regulator off for correct operation of the hardware they are 1346 * controlling. 1347 * 1348 * Use of supply names configured via regulator_set_device_supply() is 1349 * strongly encouraged. It is recommended that the supply name used 1350 * should match the name used for the supply and/or the relevant 1351 * device pins in the datasheet. 1352 */ 1353struct regulator *regulator_get_exclusive(struct device *dev, const char *id) 1354{ 1355 return _regulator_get(dev, id, 1); 1356} 1357EXPORT_SYMBOL_GPL(regulator_get_exclusive); 1358 1359/** 1360 * regulator_put - "free" the regulator source 1361 * @regulator: regulator source 1362 * 1363 * Note: drivers must ensure that all regulator_enable calls made on this 1364 * regulator source are balanced by regulator_disable calls prior to calling 1365 * this function. 1366 */ 1367void regulator_put(struct regulator *regulator) 1368{ 1369 struct regulator_dev *rdev; 1370 1371 if (regulator == NULL || IS_ERR(regulator)) 1372 return; 1373 1374 mutex_lock(®ulator_list_mutex); 1375 rdev = regulator->rdev; 1376 1377 debugfs_remove_recursive(regulator->debugfs); 1378 1379 /* remove any sysfs entries */ 1380 if (regulator->dev) 1381 sysfs_remove_link(&rdev->dev.kobj, regulator->supply_name); 1382 kfree(regulator->supply_name); 1383 list_del(®ulator->list); 1384 kfree(regulator); 1385 1386 rdev->open_count--; 1387 rdev->exclusive = 0; 1388 1389 module_put(rdev->owner); 1390 mutex_unlock(®ulator_list_mutex); 1391} 1392EXPORT_SYMBOL_GPL(regulator_put); 1393 1394static int devm_regulator_match(struct device *dev, void *res, void *data) 1395{ 1396 struct regulator **r = res; 1397 if (!r || !*r) { 1398 WARN_ON(!r || !*r); 1399 return 0; 1400 } 1401 return *r == data; 1402} 1403 1404/** 1405 * devm_regulator_put - Resource managed regulator_put() 1406 * @regulator: regulator to free 1407 * 1408 * Deallocate a regulator allocated with devm_regulator_get(). Normally 1409 * this function will not need to be called and the resource management 1410 * code will ensure that the resource is freed. 1411 */ 1412void devm_regulator_put(struct regulator *regulator) 1413{ 1414 int rc; 1415 1416 rc = devres_release(regulator->dev, devm_regulator_release, 1417 devm_regulator_match, regulator); 1418 if (rc != 0) 1419 WARN_ON(rc); 1420} 1421EXPORT_SYMBOL_GPL(devm_regulator_put); 1422 1423static int _regulator_do_enable(struct regulator_dev *rdev) 1424{ 1425 int ret, delay; 1426 1427 /* Query before enabling in case configuration dependent. */ 1428 ret = _regulator_get_enable_time(rdev); 1429 if (ret >= 0) { 1430 delay = ret; 1431 } else { 1432 rdev_warn(rdev, "enable_time() failed: %d\n", ret); 1433 delay = 0; 1434 } 1435 1436 trace_regulator_enable(rdev_get_name(rdev)); 1437 1438 if (rdev->ena_gpio) { 1439 gpio_set_value_cansleep(rdev->ena_gpio, 1440 !rdev->ena_gpio_invert); 1441 rdev->ena_gpio_state = 1; 1442 } else if (rdev->desc->ops->enable) { 1443 ret = rdev->desc->ops->enable(rdev); 1444 if (ret < 0) 1445 return ret; 1446 } else { 1447 return -EINVAL; 1448 } 1449 1450 /* Allow the regulator to ramp; it would be useful to extend 1451 * this for bulk operations so that the regulators can ramp 1452 * together. */ 1453 trace_regulator_enable_delay(rdev_get_name(rdev)); 1454 1455 if (delay >= 1000) { 1456 mdelay(delay / 1000); 1457 udelay(delay % 1000); 1458 } else if (delay) { 1459 udelay(delay); 1460 } 1461 1462 trace_regulator_enable_complete(rdev_get_name(rdev)); 1463 1464 return 0; 1465} 1466 1467/* locks held by regulator_enable() */ 1468static int _regulator_enable(struct regulator_dev *rdev) 1469{ 1470 int ret; 1471 1472 /* check voltage and requested load before enabling */ 1473 if (rdev->constraints && 1474 (rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_DRMS)) 1475 drms_uA_update(rdev); 1476 1477 if (rdev->use_count == 0) { 1478 /* The regulator may on if it's not switchable or left on */ 1479 ret = _regulator_is_enabled(rdev); 1480 if (ret == -EINVAL || ret == 0) { 1481 if (!_regulator_can_change_status(rdev)) 1482 return -EPERM; 1483 1484 ret = _regulator_do_enable(rdev); 1485 if (ret < 0) 1486 return ret; 1487 1488 } else if (ret < 0) { 1489 rdev_err(rdev, "is_enabled() failed: %d\n", ret); 1490 return ret; 1491 } 1492 /* Fallthrough on positive return values - already enabled */ 1493 } 1494 1495 rdev->use_count++; 1496 1497 return 0; 1498} 1499 1500/** 1501 * regulator_enable - enable regulator output 1502 * @regulator: regulator source 1503 * 1504 * Request that the regulator be enabled with the regulator output at 1505 * the predefined voltage or current value. Calls to regulator_enable() 1506 * must be balanced with calls to regulator_disable(). 1507 * 1508 * NOTE: the output value can be set by other drivers, boot loader or may be 1509 * hardwired in the regulator. 1510 */ 1511int regulator_enable(struct regulator *regulator) 1512{ 1513 struct regulator_dev *rdev = regulator->rdev; 1514 int ret = 0; 1515 1516 if (regulator->always_on) 1517 return 0; 1518 1519 if (rdev->supply) { 1520 ret = regulator_enable(rdev->supply); 1521 if (ret != 0) 1522 return ret; 1523 } 1524 1525 mutex_lock(&rdev->mutex); 1526 ret = _regulator_enable(rdev); 1527 mutex_unlock(&rdev->mutex); 1528 1529 if (ret != 0 && rdev->supply) 1530 regulator_disable(rdev->supply); 1531 1532 return ret; 1533} 1534EXPORT_SYMBOL_GPL(regulator_enable); 1535 1536static int _regulator_do_disable(struct regulator_dev *rdev) 1537{ 1538 int ret; 1539 1540 trace_regulator_disable(rdev_get_name(rdev)); 1541 1542 if (rdev->ena_gpio) { 1543 gpio_set_value_cansleep(rdev->ena_gpio, 1544 rdev->ena_gpio_invert); 1545 rdev->ena_gpio_state = 0; 1546 1547 } else if (rdev->desc->ops->disable) { 1548 ret = rdev->desc->ops->disable(rdev); 1549 if (ret != 0) 1550 return ret; 1551 } 1552 1553 trace_regulator_disable_complete(rdev_get_name(rdev)); 1554 1555 _notifier_call_chain(rdev, REGULATOR_EVENT_DISABLE, 1556 NULL); 1557 return 0; 1558} 1559 1560/* locks held by regulator_disable() */ 1561static int _regulator_disable(struct regulator_dev *rdev) 1562{ 1563 int ret = 0; 1564 1565 if (WARN(rdev->use_count <= 0, 1566 "unbalanced disables for %s\n", rdev_get_name(rdev))) 1567 return -EIO; 1568 1569 /* are we the last user and permitted to disable ? */ 1570 if (rdev->use_count == 1 && 1571 (rdev->constraints && !rdev->constraints->always_on)) { 1572 1573 /* we are last user */ 1574 if (_regulator_can_change_status(rdev)) { 1575 ret = _regulator_do_disable(rdev); 1576 if (ret < 0) { 1577 rdev_err(rdev, "failed to disable\n"); 1578 return ret; 1579 } 1580 } 1581 1582 rdev->use_count = 0; 1583 } else if (rdev->use_count > 1) { 1584 1585 if (rdev->constraints && 1586 (rdev->constraints->valid_ops_mask & 1587 REGULATOR_CHANGE_DRMS)) 1588 drms_uA_update(rdev); 1589 1590 rdev->use_count--; 1591 } 1592 1593 return ret; 1594} 1595 1596/** 1597 * regulator_disable - disable regulator output 1598 * @regulator: regulator source 1599 * 1600 * Disable the regulator output voltage or current. Calls to 1601 * regulator_enable() must be balanced with calls to 1602 * regulator_disable(). 1603 * 1604 * NOTE: this will only disable the regulator output if no other consumer 1605 * devices have it enabled, the regulator device supports disabling and 1606 * machine constraints permit this operation. 1607 */ 1608int regulator_disable(struct regulator *regulator) 1609{ 1610 struct regulator_dev *rdev = regulator->rdev; 1611 int ret = 0; 1612 1613 if (regulator->always_on) 1614 return 0; 1615 1616 mutex_lock(&rdev->mutex); 1617 ret = _regulator_disable(rdev); 1618 mutex_unlock(&rdev->mutex); 1619 1620 if (ret == 0 && rdev->supply) 1621 regulator_disable(rdev->supply); 1622 1623 return ret; 1624} 1625EXPORT_SYMBOL_GPL(regulator_disable); 1626 1627/* locks held by regulator_force_disable() */ 1628static int _regulator_force_disable(struct regulator_dev *rdev) 1629{ 1630 int ret = 0; 1631 1632 /* force disable */ 1633 if (rdev->desc->ops->disable) { 1634 /* ah well, who wants to live forever... */ 1635 ret = rdev->desc->ops->disable(rdev); 1636 if (ret < 0) { 1637 rdev_err(rdev, "failed to force disable\n"); 1638 return ret; 1639 } 1640 /* notify other consumers that power has been forced off */ 1641 _notifier_call_chain(rdev, REGULATOR_EVENT_FORCE_DISABLE | 1642 REGULATOR_EVENT_DISABLE, NULL); 1643 } 1644 1645 return ret; 1646} 1647 1648/** 1649 * regulator_force_disable - force disable regulator output 1650 * @regulator: regulator source 1651 * 1652 * Forcibly disable the regulator output voltage or current. 1653 * NOTE: this *will* disable the regulator output even if other consumer 1654 * devices have it enabled. This should be used for situations when device 1655 * damage will likely occur if the regulator is not disabled (e.g. over temp). 1656 */ 1657int regulator_force_disable(struct regulator *regulator) 1658{ 1659 struct regulator_dev *rdev = regulator->rdev; 1660 int ret; 1661 1662 mutex_lock(&rdev->mutex); 1663 regulator->uA_load = 0; 1664 ret = _regulator_force_disable(regulator->rdev); 1665 mutex_unlock(&rdev->mutex); 1666 1667 if (rdev->supply) 1668 while (rdev->open_count--) 1669 regulator_disable(rdev->supply); 1670 1671 return ret; 1672} 1673EXPORT_SYMBOL_GPL(regulator_force_disable); 1674 1675static void regulator_disable_work(struct work_struct *work) 1676{ 1677 struct regulator_dev *rdev = container_of(work, struct regulator_dev, 1678 disable_work.work); 1679 int count, i, ret; 1680 1681 mutex_lock(&rdev->mutex); 1682 1683 BUG_ON(!rdev->deferred_disables); 1684 1685 count = rdev->deferred_disables; 1686 rdev->deferred_disables = 0; 1687 1688 for (i = 0; i < count; i++) { 1689 ret = _regulator_disable(rdev); 1690 if (ret != 0) 1691 rdev_err(rdev, "Deferred disable failed: %d\n", ret); 1692 } 1693 1694 mutex_unlock(&rdev->mutex); 1695 1696 if (rdev->supply) { 1697 for (i = 0; i < count; i++) { 1698 ret = regulator_disable(rdev->supply); 1699 if (ret != 0) { 1700 rdev_err(rdev, 1701 "Supply disable failed: %d\n", ret); 1702 } 1703 } 1704 } 1705} 1706 1707/** 1708 * regulator_disable_deferred - disable regulator output with delay 1709 * @regulator: regulator source 1710 * @ms: miliseconds until the regulator is disabled 1711 * 1712 * Execute regulator_disable() on the regulator after a delay. This 1713 * is intended for use with devices that require some time to quiesce. 1714 * 1715 * NOTE: this will only disable the regulator output if no other consumer 1716 * devices have it enabled, the regulator device supports disabling and 1717 * machine constraints permit this operation. 1718 */ 1719int regulator_disable_deferred(struct regulator *regulator, int ms) 1720{ 1721 struct regulator_dev *rdev = regulator->rdev; 1722 int ret; 1723 1724 if (regulator->always_on) 1725 return 0; 1726 1727 if (!ms) 1728 return regulator_disable(regulator); 1729 1730 mutex_lock(&rdev->mutex); 1731 rdev->deferred_disables++; 1732 mutex_unlock(&rdev->mutex); 1733 1734 ret = schedule_delayed_work(&rdev->disable_work, 1735 msecs_to_jiffies(ms)); 1736 if (ret < 0) 1737 return ret; 1738 else 1739 return 0; 1740} 1741EXPORT_SYMBOL_GPL(regulator_disable_deferred); 1742 1743/** 1744 * regulator_is_enabled_regmap - standard is_enabled() for regmap users 1745 * 1746 * @rdev: regulator to operate on 1747 * 1748 * Regulators that use regmap for their register I/O can set the 1749 * enable_reg and enable_mask fields in their descriptor and then use 1750 * this as their is_enabled operation, saving some code. 1751 */ 1752int regulator_is_enabled_regmap(struct regulator_dev *rdev) 1753{ 1754 unsigned int val; 1755 int ret; 1756 1757 ret = regmap_read(rdev->regmap, rdev->desc->enable_reg, &val); 1758 if (ret != 0) 1759 return ret; 1760 1761 return (val & rdev->desc->enable_mask) != 0; 1762} 1763EXPORT_SYMBOL_GPL(regulator_is_enabled_regmap); 1764 1765/** 1766 * regulator_enable_regmap - standard enable() for regmap users 1767 * 1768 * @rdev: regulator to operate on 1769 * 1770 * Regulators that use regmap for their register I/O can set the 1771 * enable_reg and enable_mask fields in their descriptor and then use 1772 * this as their enable() operation, saving some code. 1773 */ 1774int regulator_enable_regmap(struct regulator_dev *rdev) 1775{ 1776 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, 1777 rdev->desc->enable_mask, 1778 rdev->desc->enable_mask); 1779} 1780EXPORT_SYMBOL_GPL(regulator_enable_regmap); 1781 1782/** 1783 * regulator_disable_regmap - standard disable() for regmap users 1784 * 1785 * @rdev: regulator to operate on 1786 * 1787 * Regulators that use regmap for their register I/O can set the 1788 * enable_reg and enable_mask fields in their descriptor and then use 1789 * this as their disable() operation, saving some code. 1790 */ 1791int regulator_disable_regmap(struct regulator_dev *rdev) 1792{ 1793 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, 1794 rdev->desc->enable_mask, 0); 1795} 1796EXPORT_SYMBOL_GPL(regulator_disable_regmap); 1797 1798static int _regulator_is_enabled(struct regulator_dev *rdev) 1799{ 1800 /* A GPIO control always takes precedence */ 1801 if (rdev->ena_gpio) 1802 return rdev->ena_gpio_state; 1803 1804 /* If we don't know then assume that the regulator is always on */ 1805 if (!rdev->desc->ops->is_enabled) 1806 return 1; 1807 1808 return rdev->desc->ops->is_enabled(rdev); 1809} 1810 1811/** 1812 * regulator_is_enabled - is the regulator output enabled 1813 * @regulator: regulator source 1814 * 1815 * Returns positive if the regulator driver backing the source/client 1816 * has requested that the device be enabled, zero if it hasn't, else a 1817 * negative errno code. 1818 * 1819 * Note that the device backing this regulator handle can have multiple 1820 * users, so it might be enabled even if regulator_enable() was never 1821 * called for this particular source. 1822 */ 1823int regulator_is_enabled(struct regulator *regulator) 1824{ 1825 int ret; 1826 1827 if (regulator->always_on) 1828 return 1; 1829 1830 mutex_lock(®ulator->rdev->mutex); 1831 ret = _regulator_is_enabled(regulator->rdev); 1832 mutex_unlock(®ulator->rdev->mutex); 1833 1834 return ret; 1835} 1836EXPORT_SYMBOL_GPL(regulator_is_enabled); 1837 1838/** 1839 * regulator_count_voltages - count regulator_list_voltage() selectors 1840 * @regulator: regulator source 1841 * 1842 * Returns number of selectors, or negative errno. Selectors are 1843 * numbered starting at zero, and typically correspond to bitfields 1844 * in hardware registers. 1845 */ 1846int regulator_count_voltages(struct regulator *regulator) 1847{ 1848 struct regulator_dev *rdev = regulator->rdev; 1849 1850 return rdev->desc->n_voltages ? : -EINVAL; 1851} 1852EXPORT_SYMBOL_GPL(regulator_count_voltages); 1853 1854/** 1855 * regulator_list_voltage_linear - List voltages with simple calculation 1856 * 1857 * @rdev: Regulator device 1858 * @selector: Selector to convert into a voltage 1859 * 1860 * Regulators with a simple linear mapping between voltages and 1861 * selectors can set min_uV and uV_step in the regulator descriptor 1862 * and then use this function as their list_voltage() operation, 1863 */ 1864int regulator_list_voltage_linear(struct regulator_dev *rdev, 1865 unsigned int selector) 1866{ 1867 if (selector >= rdev->desc->n_voltages) 1868 return -EINVAL; 1869 1870 return rdev->desc->min_uV + (rdev->desc->uV_step * selector); 1871} 1872EXPORT_SYMBOL_GPL(regulator_list_voltage_linear); 1873 1874/** 1875 * regulator_list_voltage_table - List voltages with table based mapping 1876 * 1877 * @rdev: Regulator device 1878 * @selector: Selector to convert into a voltage 1879 * 1880 * Regulators with table based mapping between voltages and 1881 * selectors can set volt_table in the regulator descriptor 1882 * and then use this function as their list_voltage() operation. 1883 */ 1884int regulator_list_voltage_table(struct regulator_dev *rdev, 1885 unsigned int selector) 1886{ 1887 if (!rdev->desc->volt_table) { 1888 BUG_ON(!rdev->desc->volt_table); 1889 return -EINVAL; 1890 } 1891 1892 if (selector >= rdev->desc->n_voltages) 1893 return -EINVAL; 1894 1895 return rdev->desc->volt_table[selector]; 1896} 1897EXPORT_SYMBOL_GPL(regulator_list_voltage_table); 1898 1899/** 1900 * regulator_list_voltage - enumerate supported voltages 1901 * @regulator: regulator source 1902 * @selector: identify voltage to list 1903 * Context: can sleep 1904 * 1905 * Returns a voltage that can be passed to @regulator_set_voltage(), 1906 * zero if this selector code can't be used on this system, or a 1907 * negative errno. 1908 */ 1909int regulator_list_voltage(struct regulator *regulator, unsigned selector) 1910{ 1911 struct regulator_dev *rdev = regulator->rdev; 1912 struct regulator_ops *ops = rdev->desc->ops; 1913 int ret; 1914 1915 if (!ops->list_voltage || selector >= rdev->desc->n_voltages) 1916 return -EINVAL; 1917 1918 mutex_lock(&rdev->mutex); 1919 ret = ops->list_voltage(rdev, selector); 1920 mutex_unlock(&rdev->mutex); 1921 1922 if (ret > 0) { 1923 if (ret < rdev->constraints->min_uV) 1924 ret = 0; 1925 else if (ret > rdev->constraints->max_uV) 1926 ret = 0; 1927 } 1928 1929 return ret; 1930} 1931EXPORT_SYMBOL_GPL(regulator_list_voltage); 1932 1933/** 1934 * regulator_is_supported_voltage - check if a voltage range can be supported 1935 * 1936 * @regulator: Regulator to check. 1937 * @min_uV: Minimum required voltage in uV. 1938 * @max_uV: Maximum required voltage in uV. 1939 * 1940 * Returns a boolean or a negative error code. 1941 */ 1942int regulator_is_supported_voltage(struct regulator *regulator, 1943 int min_uV, int max_uV) 1944{ 1945 struct regulator_dev *rdev = regulator->rdev; 1946 int i, voltages, ret; 1947 1948 /* If we can't change voltage check the current voltage */ 1949 if (!(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_VOLTAGE)) { 1950 ret = regulator_get_voltage(regulator); 1951 if (ret >= 0) 1952 return (min_uV >= ret && ret <= max_uV); 1953 else 1954 return ret; 1955 } 1956 1957 ret = regulator_count_voltages(regulator); 1958 if (ret < 0) 1959 return ret; 1960 voltages = ret; 1961 1962 for (i = 0; i < voltages; i++) { 1963 ret = regulator_list_voltage(regulator, i); 1964 1965 if (ret >= min_uV && ret <= max_uV) 1966 return 1; 1967 } 1968 1969 return 0; 1970} 1971EXPORT_SYMBOL_GPL(regulator_is_supported_voltage); 1972 1973/** 1974 * regulator_get_voltage_sel_regmap - standard get_voltage_sel for regmap users 1975 * 1976 * @rdev: regulator to operate on 1977 * 1978 * Regulators that use regmap for their register I/O can set the 1979 * vsel_reg and vsel_mask fields in their descriptor and then use this 1980 * as their get_voltage_vsel operation, saving some code. 1981 */ 1982int regulator_get_voltage_sel_regmap(struct regulator_dev *rdev) 1983{ 1984 unsigned int val; 1985 int ret; 1986 1987 ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); 1988 if (ret != 0) 1989 return ret; 1990 1991 val &= rdev->desc->vsel_mask; 1992 val >>= ffs(rdev->desc->vsel_mask) - 1; 1993 1994 return val; 1995} 1996EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_regmap); 1997 1998/** 1999 * regulator_set_voltage_sel_regmap - standard set_voltage_sel for regmap users 2000 * 2001 * @rdev: regulator to operate on 2002 * @sel: Selector to set 2003 * 2004 * Regulators that use regmap for their register I/O can set the 2005 * vsel_reg and vsel_mask fields in their descriptor and then use this 2006 * as their set_voltage_vsel operation, saving some code. 2007 */ 2008int regulator_set_voltage_sel_regmap(struct regulator_dev *rdev, unsigned sel) 2009{ 2010 sel <<= ffs(rdev->desc->vsel_mask) - 1; 2011 2012 return regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, 2013 rdev->desc->vsel_mask, sel); 2014} 2015EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_regmap); 2016 2017/** 2018 * regulator_map_voltage_iterate - map_voltage() based on list_voltage() 2019 * 2020 * @rdev: Regulator to operate on 2021 * @min_uV: Lower bound for voltage 2022 * @max_uV: Upper bound for voltage 2023 * 2024 * Drivers implementing set_voltage_sel() and list_voltage() can use 2025 * this as their map_voltage() operation. It will find a suitable 2026 * voltage by calling list_voltage() until it gets something in bounds 2027 * for the requested voltages. 2028 */ 2029int regulator_map_voltage_iterate(struct regulator_dev *rdev, 2030 int min_uV, int max_uV) 2031{ 2032 int best_val = INT_MAX; 2033 int selector = 0; 2034 int i, ret; 2035 2036 /* Find the smallest voltage that falls within the specified 2037 * range. 2038 */ 2039 for (i = 0; i < rdev->desc->n_voltages; i++) { 2040 ret = rdev->desc->ops->list_voltage(rdev, i); 2041 if (ret < 0) 2042 continue; 2043 2044 if (ret < best_val && ret >= min_uV && ret <= max_uV) { 2045 best_val = ret; 2046 selector = i; 2047 } 2048 } 2049 2050 if (best_val != INT_MAX) 2051 return selector; 2052 else 2053 return -EINVAL; 2054} 2055EXPORT_SYMBOL_GPL(regulator_map_voltage_iterate); 2056 2057/** 2058 * regulator_map_voltage_linear - map_voltage() for simple linear mappings 2059 * 2060 * @rdev: Regulator to operate on 2061 * @min_uV: Lower bound for voltage 2062 * @max_uV: Upper bound for voltage 2063 * 2064 * Drivers providing min_uV and uV_step in their regulator_desc can 2065 * use this as their map_voltage() operation. 2066 */ 2067int regulator_map_voltage_linear(struct regulator_dev *rdev, 2068 int min_uV, int max_uV) 2069{ 2070 int ret, voltage; 2071 2072 /* Allow uV_step to be 0 for fixed voltage */ 2073 if (rdev->desc->n_voltages == 1 && rdev->desc->uV_step == 0) { 2074 if (min_uV <= rdev->desc->min_uV && rdev->desc->min_uV <= max_uV) 2075 return 0; 2076 else 2077 return -EINVAL; 2078 } 2079 2080 if (!rdev->desc->uV_step) { 2081 BUG_ON(!rdev->desc->uV_step); 2082 return -EINVAL; 2083 } 2084 2085 if (min_uV < rdev->desc->min_uV) 2086 min_uV = rdev->desc->min_uV; 2087 2088 ret = DIV_ROUND_UP(min_uV - rdev->desc->min_uV, rdev->desc->uV_step); 2089 if (ret < 0) 2090 return ret; 2091 2092 /* Map back into a voltage to verify we're still in bounds */ 2093 voltage = rdev->desc->ops->list_voltage(rdev, ret); 2094 if (voltage < min_uV || voltage > max_uV) 2095 return -EINVAL; 2096 2097 return ret; 2098} 2099EXPORT_SYMBOL_GPL(regulator_map_voltage_linear); 2100 2101static int _regulator_do_set_voltage(struct regulator_dev *rdev, 2102 int min_uV, int max_uV) 2103{ 2104 int ret; 2105 int delay = 0; 2106 int best_val = 0; 2107 unsigned int selector; 2108 int old_selector = -1; 2109 2110 trace_regulator_set_voltage(rdev_get_name(rdev), min_uV, max_uV); 2111 2112 min_uV += rdev->constraints->uV_offset; 2113 max_uV += rdev->constraints->uV_offset; 2114 2115 /* 2116 * If we can't obtain the old selector there is not enough 2117 * info to call set_voltage_time_sel(). 2118 */ 2119 if (_regulator_is_enabled(rdev) && 2120 rdev->desc->ops->set_voltage_time_sel && 2121 rdev->desc->ops->get_voltage_sel) { 2122 old_selector = rdev->desc->ops->get_voltage_sel(rdev); 2123 if (old_selector < 0) 2124 return old_selector; 2125 } 2126 2127 if (rdev->desc->ops->set_voltage) { 2128 ret = rdev->desc->ops->set_voltage(rdev, min_uV, max_uV, 2129 &selector); 2130 2131 if (ret >= 0) { 2132 if (rdev->desc->ops->list_voltage) 2133 best_val = rdev->desc->ops->list_voltage(rdev, 2134 selector); 2135 else 2136 best_val = _regulator_get_voltage(rdev); 2137 } 2138 2139 } else if (rdev->desc->ops->set_voltage_sel) { 2140 if (rdev->desc->ops->map_voltage) { 2141 ret = rdev->desc->ops->map_voltage(rdev, min_uV, 2142 max_uV); 2143 } else { 2144 if (rdev->desc->ops->list_voltage == 2145 regulator_list_voltage_linear) 2146 ret = regulator_map_voltage_linear(rdev, 2147 min_uV, max_uV); 2148 else 2149 ret = regulator_map_voltage_iterate(rdev, 2150 min_uV, max_uV); 2151 } 2152 2153 if (ret >= 0) { 2154 best_val = rdev->desc->ops->list_voltage(rdev, ret); 2155 if (min_uV <= best_val && max_uV >= best_val) { 2156 selector = ret; 2157 ret = rdev->desc->ops->set_voltage_sel(rdev, 2158 ret); 2159 } else { 2160 ret = -EINVAL; 2161 } 2162 } 2163 } else { 2164 ret = -EINVAL; 2165 } 2166 2167 /* Call set_voltage_time_sel if successfully obtained old_selector */ 2168 if (ret == 0 && _regulator_is_enabled(rdev) && old_selector >= 0 && 2169 rdev->desc->ops->set_voltage_time_sel) { 2170 2171 delay = rdev->desc->ops->set_voltage_time_sel(rdev, 2172 old_selector, selector); 2173 if (delay < 0) { 2174 rdev_warn(rdev, "set_voltage_time_sel() failed: %d\n", 2175 delay); 2176 delay = 0; 2177 } 2178 2179 /* Insert any necessary delays */ 2180 if (delay >= 1000) { 2181 mdelay(delay / 1000); 2182 udelay(delay % 1000); 2183 } else if (delay) { 2184 udelay(delay); 2185 } 2186 } 2187 2188 if (ret == 0 && best_val >= 0) { 2189 unsigned long data = best_val; 2190 2191 _notifier_call_chain(rdev, REGULATOR_EVENT_VOLTAGE_CHANGE, 2192 (void *)data); 2193 } 2194 2195 trace_regulator_set_voltage_complete(rdev_get_name(rdev), best_val); 2196 2197 return ret; 2198} 2199 2200/** 2201 * regulator_set_voltage - set regulator output voltage 2202 * @regulator: regulator source 2203 * @min_uV: Minimum required voltage in uV 2204 * @max_uV: Maximum acceptable voltage in uV 2205 * 2206 * Sets a voltage regulator to the desired output voltage. This can be set 2207 * during any regulator state. IOW, regulator can be disabled or enabled. 2208 * 2209 * If the regulator is enabled then the voltage will change to the new value 2210 * immediately otherwise if the regulator is disabled the regulator will 2211 * output at the new voltage when enabled. 2212 * 2213 * NOTE: If the regulator is shared between several devices then the lowest 2214 * request voltage that meets the system constraints will be used. 2215 * Regulator system constraints must be set for this regulator before 2216 * calling this function otherwise this call will fail. 2217 */ 2218int regulator_set_voltage(struct regulator *regulator, int min_uV, int max_uV) 2219{ 2220 struct regulator_dev *rdev = regulator->rdev; 2221 int ret = 0; 2222 2223 mutex_lock(&rdev->mutex); 2224 2225 /* If we're setting the same range as last time the change 2226 * should be a noop (some cpufreq implementations use the same 2227 * voltage for multiple frequencies, for example). 2228 */ 2229 if (regulator->min_uV == min_uV && regulator->max_uV == max_uV) 2230 goto out; 2231 2232 /* sanity check */ 2233 if (!rdev->desc->ops->set_voltage && 2234 !rdev->desc->ops->set_voltage_sel) { 2235 ret = -EINVAL; 2236 goto out; 2237 } 2238 2239 /* constraints check */ 2240 ret = regulator_check_voltage(rdev, &min_uV, &max_uV); 2241 if (ret < 0) 2242 goto out; 2243 regulator->min_uV = min_uV; 2244 regulator->max_uV = max_uV; 2245 2246 ret = regulator_check_consumers(rdev, &min_uV, &max_uV); 2247 if (ret < 0) 2248 goto out; 2249 2250 ret = _regulator_do_set_voltage(rdev, min_uV, max_uV); 2251 2252out: 2253 mutex_unlock(&rdev->mutex); 2254 return ret; 2255} 2256EXPORT_SYMBOL_GPL(regulator_set_voltage); 2257 2258/** 2259 * regulator_set_voltage_time - get raise/fall time 2260 * @regulator: regulator source 2261 * @old_uV: starting voltage in microvolts 2262 * @new_uV: target voltage in microvolts 2263 * 2264 * Provided with the starting and ending voltage, this function attempts to 2265 * calculate the time in microseconds required to rise or fall to this new 2266 * voltage. 2267 */ 2268int regulator_set_voltage_time(struct regulator *regulator, 2269 int old_uV, int new_uV) 2270{ 2271 struct regulator_dev *rdev = regulator->rdev; 2272 struct regulator_ops *ops = rdev->desc->ops; 2273 int old_sel = -1; 2274 int new_sel = -1; 2275 int voltage; 2276 int i; 2277 2278 /* Currently requires operations to do this */ 2279 if (!ops->list_voltage || !ops->set_voltage_time_sel 2280 || !rdev->desc->n_voltages) 2281 return -EINVAL; 2282 2283 for (i = 0; i < rdev->desc->n_voltages; i++) { 2284 /* We only look for exact voltage matches here */ 2285 voltage = regulator_list_voltage(regulator, i); 2286 if (voltage < 0) 2287 return -EINVAL; 2288 if (voltage == 0) 2289 continue; 2290 if (voltage == old_uV) 2291 old_sel = i; 2292 if (voltage == new_uV) 2293 new_sel = i; 2294 } 2295 2296 if (old_sel < 0 || new_sel < 0) 2297 return -EINVAL; 2298 2299 return ops->set_voltage_time_sel(rdev, old_sel, new_sel); 2300} 2301EXPORT_SYMBOL_GPL(regulator_set_voltage_time); 2302 2303/** 2304 * regulator_set_voltage_time_sel - get raise/fall time 2305 * @rdev: regulator source device 2306 * @old_selector: selector for starting voltage 2307 * @new_selector: selector for target voltage 2308 * 2309 * Provided with the starting and target voltage selectors, this function 2310 * returns time in microseconds required to rise or fall to this new voltage 2311 * 2312 * Drivers providing ramp_delay in regulation_constraints can use this as their 2313 * set_voltage_time_sel() operation. 2314 */ 2315int regulator_set_voltage_time_sel(struct regulator_dev *rdev, 2316 unsigned int old_selector, 2317 unsigned int new_selector) 2318{ 2319 unsigned int ramp_delay = 0; 2320 int old_volt, new_volt; 2321 2322 if (rdev->constraints->ramp_delay) 2323 ramp_delay = rdev->constraints->ramp_delay; 2324 else if (rdev->desc->ramp_delay) 2325 ramp_delay = rdev->desc->ramp_delay; 2326 2327 if (ramp_delay == 0) { 2328 rdev_warn(rdev, "ramp_delay not set\n"); 2329 return 0; 2330 } 2331 2332 /* sanity check */ 2333 if (!rdev->desc->ops->list_voltage) 2334 return -EINVAL; 2335 2336 old_volt = rdev->desc->ops->list_voltage(rdev, old_selector); 2337 new_volt = rdev->desc->ops->list_voltage(rdev, new_selector); 2338 2339 return DIV_ROUND_UP(abs(new_volt - old_volt), ramp_delay); 2340} 2341EXPORT_SYMBOL_GPL(regulator_set_voltage_time_sel); 2342 2343/** 2344 * regulator_sync_voltage - re-apply last regulator output voltage 2345 * @regulator: regulator source 2346 * 2347 * Re-apply the last configured voltage. This is intended to be used 2348 * where some external control source the consumer is cooperating with 2349 * has caused the configured voltage to change. 2350 */ 2351int regulator_sync_voltage(struct regulator *regulator) 2352{ 2353 struct regulator_dev *rdev = regulator->rdev; 2354 int ret, min_uV, max_uV; 2355 2356 mutex_lock(&rdev->mutex); 2357 2358 if (!rdev->desc->ops->set_voltage && 2359 !rdev->desc->ops->set_voltage_sel) { 2360 ret = -EINVAL; 2361 goto out; 2362 } 2363 2364 /* This is only going to work if we've had a voltage configured. */ 2365 if (!regulator->min_uV && !regulator->max_uV) { 2366 ret = -EINVAL; 2367 goto out; 2368 } 2369 2370 min_uV = regulator->min_uV; 2371 max_uV = regulator->max_uV; 2372 2373 /* This should be a paranoia check... */ 2374 ret = regulator_check_voltage(rdev, &min_uV, &max_uV); 2375 if (ret < 0) 2376 goto out; 2377 2378 ret = regulator_check_consumers(rdev, &min_uV, &max_uV); 2379 if (ret < 0) 2380 goto out; 2381 2382 ret = _regulator_do_set_voltage(rdev, min_uV, max_uV); 2383 2384out: 2385 mutex_unlock(&rdev->mutex); 2386 return ret; 2387} 2388EXPORT_SYMBOL_GPL(regulator_sync_voltage); 2389 2390static int _regulator_get_voltage(struct regulator_dev *rdev) 2391{ 2392 int sel, ret; 2393 2394 if (rdev->desc->ops->get_voltage_sel) { 2395 sel = rdev->desc->ops->get_voltage_sel(rdev); 2396 if (sel < 0) 2397 return sel; 2398 ret = rdev->desc->ops->list_voltage(rdev, sel); 2399 } else if (rdev->desc->ops->get_voltage) { 2400 ret = rdev->desc->ops->get_voltage(rdev); 2401 } else if (rdev->desc->ops->list_voltage) { 2402 ret = rdev->desc->ops->list_voltage(rdev, 0); 2403 } else { 2404 return -EINVAL; 2405 } 2406 2407 if (ret < 0) 2408 return ret; 2409 return ret - rdev->constraints->uV_offset; 2410} 2411 2412/** 2413 * regulator_get_voltage - get regulator output voltage 2414 * @regulator: regulator source 2415 * 2416 * This returns the current regulator voltage in uV. 2417 * 2418 * NOTE: If the regulator is disabled it will return the voltage value. This 2419 * function should not be used to determine regulator state. 2420 */ 2421int regulator_get_voltage(struct regulator *regulator) 2422{ 2423 int ret; 2424 2425 mutex_lock(®ulator->rdev->mutex); 2426 2427 ret = _regulator_get_voltage(regulator->rdev); 2428 2429 mutex_unlock(®ulator->rdev->mutex); 2430 2431 return ret; 2432} 2433EXPORT_SYMBOL_GPL(regulator_get_voltage); 2434 2435/** 2436 * regulator_set_current_limit - set regulator output current limit 2437 * @regulator: regulator source 2438 * @min_uA: Minimuum supported current in uA 2439 * @max_uA: Maximum supported current in uA 2440 * 2441 * Sets current sink to the desired output current. This can be set during 2442 * any regulator state. IOW, regulator can be disabled or enabled. 2443 * 2444 * If the regulator is enabled then the current will change to the new value 2445 * immediately otherwise if the regulator is disabled the regulator will 2446 * output at the new current when enabled. 2447 * 2448 * NOTE: Regulator system constraints must be set for this regulator before 2449 * calling this function otherwise this call will fail. 2450 */ 2451int regulator_set_current_limit(struct regulator *regulator, 2452 int min_uA, int max_uA) 2453{ 2454 struct regulator_dev *rdev = regulator->rdev; 2455 int ret; 2456 2457 mutex_lock(&rdev->mutex); 2458 2459 /* sanity check */ 2460 if (!rdev->desc->ops->set_current_limit) { 2461 ret = -EINVAL; 2462 goto out; 2463 } 2464 2465 /* constraints check */ 2466 ret = regulator_check_current_limit(rdev, &min_uA, &max_uA); 2467 if (ret < 0) 2468 goto out; 2469 2470 ret = rdev->desc->ops->set_current_limit(rdev, min_uA, max_uA); 2471out: 2472 mutex_unlock(&rdev->mutex); 2473 return ret; 2474} 2475EXPORT_SYMBOL_GPL(regulator_set_current_limit); 2476 2477static int _regulator_get_current_limit(struct regulator_dev *rdev) 2478{ 2479 int ret; 2480 2481 mutex_lock(&rdev->mutex); 2482 2483 /* sanity check */ 2484 if (!rdev->desc->ops->get_current_limit) { 2485 ret = -EINVAL; 2486 goto out; 2487 } 2488 2489 ret = rdev->desc->ops->get_current_limit(rdev); 2490out: 2491 mutex_unlock(&rdev->mutex); 2492 return ret; 2493} 2494 2495/** 2496 * regulator_get_current_limit - get regulator output current 2497 * @regulator: regulator source 2498 * 2499 * This returns the current supplied by the specified current sink in uA. 2500 * 2501 * NOTE: If the regulator is disabled it will return the current value. This 2502 * function should not be used to determine regulator state. 2503 */ 2504int regulator_get_current_limit(struct regulator *regulator) 2505{ 2506 return _regulator_get_current_limit(regulator->rdev); 2507} 2508EXPORT_SYMBOL_GPL(regulator_get_current_limit); 2509 2510/** 2511 * regulator_set_mode - set regulator operating mode 2512 * @regulator: regulator source 2513 * @mode: operating mode - one of the REGULATOR_MODE constants 2514 * 2515 * Set regulator operating mode to increase regulator efficiency or improve 2516 * regulation performance. 2517 * 2518 * NOTE: Regulator system constraints must be set for this regulator before 2519 * calling this function otherwise this call will fail. 2520 */ 2521int regulator_set_mode(struct regulator *regulator, unsigned int mode) 2522{ 2523 struct regulator_dev *rdev = regulator->rdev; 2524 int ret; 2525 int regulator_curr_mode; 2526 2527 mutex_lock(&rdev->mutex); 2528 2529 /* sanity check */ 2530 if (!rdev->desc->ops->set_mode) { 2531 ret = -EINVAL; 2532 goto out; 2533 } 2534 2535 /* return if the same mode is requested */ 2536 if (rdev->desc->ops->get_mode) { 2537 regulator_curr_mode = rdev->desc->ops->get_mode(rdev); 2538 if (regulator_curr_mode == mode) { 2539 ret = 0; 2540 goto out; 2541 } 2542 } 2543 2544 /* constraints check */ 2545 ret = regulator_mode_constrain(rdev, &mode); 2546 if (ret < 0) 2547 goto out; 2548 2549 ret = rdev->desc->ops->set_mode(rdev, mode); 2550out: 2551 mutex_unlock(&rdev->mutex); 2552 return ret; 2553} 2554EXPORT_SYMBOL_GPL(regulator_set_mode); 2555 2556static unsigned int _regulator_get_mode(struct regulator_dev *rdev) 2557{ 2558 int ret; 2559 2560 mutex_lock(&rdev->mutex); 2561 2562 /* sanity check */ 2563 if (!rdev->desc->ops->get_mode) { 2564 ret = -EINVAL; 2565 goto out; 2566 } 2567 2568 ret = rdev->desc->ops->get_mode(rdev); 2569out: 2570 mutex_unlock(&rdev->mutex); 2571 return ret; 2572} 2573 2574/** 2575 * regulator_get_mode - get regulator operating mode 2576 * @regulator: regulator source 2577 * 2578 * Get the current regulator operating mode. 2579 */ 2580unsigned int regulator_get_mode(struct regulator *regulator) 2581{ 2582 return _regulator_get_mode(regulator->rdev); 2583} 2584EXPORT_SYMBOL_GPL(regulator_get_mode); 2585 2586/** 2587 * regulator_set_optimum_mode - set regulator optimum operating mode 2588 * @regulator: regulator source 2589 * @uA_load: load current 2590 * 2591 * Notifies the regulator core of a new device load. This is then used by 2592 * DRMS (if enabled by constraints) to set the most efficient regulator 2593 * operating mode for the new regulator loading. 2594 * 2595 * Consumer devices notify their supply regulator of the maximum power 2596 * they will require (can be taken from device datasheet in the power 2597 * consumption tables) when they change operational status and hence power 2598 * state. Examples of operational state changes that can affect power 2599 * consumption are :- 2600 * 2601 * o Device is opened / closed. 2602 * o Device I/O is about to begin or has just finished. 2603 * o Device is idling in between work. 2604 * 2605 * This information is also exported via sysfs to userspace. 2606 * 2607 * DRMS will sum the total requested load on the regulator and change 2608 * to the most efficient operating mode if platform constraints allow. 2609 * 2610 * Returns the new regulator mode or error. 2611 */ 2612int regulator_set_optimum_mode(struct regulator *regulator, int uA_load) 2613{ 2614 struct regulator_dev *rdev = regulator->rdev; 2615 struct regulator *consumer; 2616 int ret, output_uV, input_uV = 0, total_uA_load = 0; 2617 unsigned int mode; 2618 2619 if (rdev->supply) 2620 input_uV = regulator_get_voltage(rdev->supply); 2621 2622 mutex_lock(&rdev->mutex); 2623 2624 /* 2625 * first check to see if we can set modes at all, otherwise just 2626 * tell the consumer everything is OK. 2627 */ 2628 regulator->uA_load = uA_load; 2629 ret = regulator_check_drms(rdev); 2630 if (ret < 0) { 2631 ret = 0; 2632 goto out; 2633 } 2634 2635 if (!rdev->desc->ops->get_optimum_mode) 2636 goto out; 2637 2638 /* 2639 * we can actually do this so any errors are indicators of 2640 * potential real failure. 2641 */ 2642 ret = -EINVAL; 2643 2644 if (!rdev->desc->ops->set_mode) 2645 goto out; 2646 2647 /* get output voltage */ 2648 output_uV = _regulator_get_voltage(rdev); 2649 if (output_uV <= 0) { 2650 rdev_err(rdev, "invalid output voltage found\n"); 2651 goto out; 2652 } 2653 2654 /* No supply? Use constraint voltage */ 2655 if (input_uV <= 0) 2656 input_uV = rdev->constraints->input_uV; 2657 if (input_uV <= 0) { 2658 rdev_err(rdev, "invalid input voltage found\n"); 2659 goto out; 2660 } 2661 2662 /* calc total requested load for this regulator */ 2663 list_for_each_entry(consumer, &rdev->consumer_list, list) 2664 total_uA_load += consumer->uA_load; 2665 2666 mode = rdev->desc->ops->get_optimum_mode(rdev, 2667 input_uV, output_uV, 2668 total_uA_load); 2669 ret = regulator_mode_constrain(rdev, &mode); 2670 if (ret < 0) { 2671 rdev_err(rdev, "failed to get optimum mode @ %d uA %d -> %d uV\n", 2672 total_uA_load, input_uV, output_uV); 2673 goto out; 2674 } 2675 2676 ret = rdev->desc->ops->set_mode(rdev, mode); 2677 if (ret < 0) { 2678 rdev_err(rdev, "failed to set optimum mode %x\n", mode); 2679 goto out; 2680 } 2681 ret = mode; 2682out: 2683 mutex_unlock(&rdev->mutex); 2684 return ret; 2685} 2686EXPORT_SYMBOL_GPL(regulator_set_optimum_mode); 2687 2688/** 2689 * regulator_register_notifier - register regulator event notifier 2690 * @regulator: regulator source 2691 * @nb: notifier block 2692 * 2693 * Register notifier block to receive regulator events. 2694 */ 2695int regulator_register_notifier(struct regulator *regulator, 2696 struct notifier_block *nb) 2697{ 2698 return blocking_notifier_chain_register(®ulator->rdev->notifier, 2699 nb); 2700} 2701EXPORT_SYMBOL_GPL(regulator_register_notifier); 2702 2703/** 2704 * regulator_unregister_notifier - unregister regulator event notifier 2705 * @regulator: regulator source 2706 * @nb: notifier block 2707 * 2708 * Unregister regulator event notifier block. 2709 */ 2710int regulator_unregister_notifier(struct regulator *regulator, 2711 struct notifier_block *nb) 2712{ 2713 return blocking_notifier_chain_unregister(®ulator->rdev->notifier, 2714 nb); 2715} 2716EXPORT_SYMBOL_GPL(regulator_unregister_notifier); 2717 2718/* notify regulator consumers and downstream regulator consumers. 2719 * Note mutex must be held by caller. 2720 */ 2721static void _notifier_call_chain(struct regulator_dev *rdev, 2722 unsigned long event, void *data) 2723{ 2724 /* call rdev chain first */ 2725 blocking_notifier_call_chain(&rdev->notifier, event, data); 2726} 2727 2728/** 2729 * regulator_bulk_get - get multiple regulator consumers 2730 * 2731 * @dev: Device to supply 2732 * @num_consumers: Number of consumers to register 2733 * @consumers: Configuration of consumers; clients are stored here. 2734 * 2735 * @return 0 on success, an errno on failure. 2736 * 2737 * This helper function allows drivers to get several regulator 2738 * consumers in one operation. If any of the regulators cannot be 2739 * acquired then any regulators that were allocated will be freed 2740 * before returning to the caller. 2741 */ 2742int regulator_bulk_get(struct device *dev, int num_consumers, 2743 struct regulator_bulk_data *consumers) 2744{ 2745 int i; 2746 int ret; 2747 2748 for (i = 0; i < num_consumers; i++) 2749 consumers[i].consumer = NULL; 2750 2751 for (i = 0; i < num_consumers; i++) { 2752 consumers[i].consumer = regulator_get(dev, 2753 consumers[i].supply); 2754 if (IS_ERR(consumers[i].consumer)) { 2755 ret = PTR_ERR(consumers[i].consumer); 2756 dev_err(dev, "Failed to get supply '%s': %d\n", 2757 consumers[i].supply, ret); 2758 consumers[i].consumer = NULL; 2759 goto err; 2760 } 2761 } 2762 2763 return 0; 2764 2765err: 2766 while (--i >= 0) 2767 regulator_put(consumers[i].consumer); 2768 2769 return ret; 2770} 2771EXPORT_SYMBOL_GPL(regulator_bulk_get); 2772 2773/** 2774 * devm_regulator_bulk_get - managed get multiple regulator consumers 2775 * 2776 * @dev: Device to supply 2777 * @num_consumers: Number of consumers to register 2778 * @consumers: Configuration of consumers; clients are stored here. 2779 * 2780 * @return 0 on success, an errno on failure. 2781 * 2782 * This helper function allows drivers to get several regulator 2783 * consumers in one operation with management, the regulators will 2784 * automatically be freed when the device is unbound. If any of the 2785 * regulators cannot be acquired then any regulators that were 2786 * allocated will be freed before returning to the caller. 2787 */ 2788int devm_regulator_bulk_get(struct device *dev, int num_consumers, 2789 struct regulator_bulk_data *consumers) 2790{ 2791 int i; 2792 int ret; 2793 2794 for (i = 0; i < num_consumers; i++) 2795 consumers[i].consumer = NULL; 2796 2797 for (i = 0; i < num_consumers; i++) { 2798 consumers[i].consumer = devm_regulator_get(dev, 2799 consumers[i].supply); 2800 if (IS_ERR(consumers[i].consumer)) { 2801 ret = PTR_ERR(consumers[i].consumer); 2802 dev_err(dev, "Failed to get supply '%s': %d\n", 2803 consumers[i].supply, ret); 2804 consumers[i].consumer = NULL; 2805 goto err; 2806 } 2807 } 2808 2809 return 0; 2810 2811err: 2812 for (i = 0; i < num_consumers && consumers[i].consumer; i++) 2813 devm_regulator_put(consumers[i].consumer); 2814 2815 return ret; 2816} 2817EXPORT_SYMBOL_GPL(devm_regulator_bulk_get); 2818 2819static void regulator_bulk_enable_async(void *data, async_cookie_t cookie) 2820{ 2821 struct regulator_bulk_data *bulk = data; 2822 2823 bulk->ret = regulator_enable(bulk->consumer); 2824} 2825 2826/** 2827 * regulator_bulk_enable - enable multiple regulator consumers 2828 * 2829 * @num_consumers: Number of consumers 2830 * @consumers: Consumer data; clients are stored here. 2831 * @return 0 on success, an errno on failure 2832 * 2833 * This convenience API allows consumers to enable multiple regulator 2834 * clients in a single API call. If any consumers cannot be enabled 2835 * then any others that were enabled will be disabled again prior to 2836 * return. 2837 */ 2838int regulator_bulk_enable(int num_consumers, 2839 struct regulator_bulk_data *consumers) 2840{ 2841 ASYNC_DOMAIN_EXCLUSIVE(async_domain); 2842 int i; 2843 int ret = 0; 2844 2845 for (i = 0; i < num_consumers; i++) { 2846 if (consumers[i].consumer->always_on) 2847 consumers[i].ret = 0; 2848 else 2849 async_schedule_domain(regulator_bulk_enable_async, 2850 &consumers[i], &async_domain); 2851 } 2852 2853 async_synchronize_full_domain(&async_domain); 2854 2855 /* If any consumer failed we need to unwind any that succeeded */ 2856 for (i = 0; i < num_consumers; i++) { 2857 if (consumers[i].ret != 0) { 2858 ret = consumers[i].ret; 2859 goto err; 2860 } 2861 } 2862 2863 return 0; 2864 2865err: 2866 pr_err("Failed to enable %s: %d\n", consumers[i].supply, ret); 2867 while (--i >= 0) 2868 regulator_disable(consumers[i].consumer); 2869 2870 return ret; 2871} 2872EXPORT_SYMBOL_GPL(regulator_bulk_enable); 2873 2874/** 2875 * regulator_bulk_disable - disable multiple regulator consumers 2876 * 2877 * @num_consumers: Number of consumers 2878 * @consumers: Consumer data; clients are stored here. 2879 * @return 0 on success, an errno on failure 2880 * 2881 * This convenience API allows consumers to disable multiple regulator 2882 * clients in a single API call. If any consumers cannot be disabled 2883 * then any others that were disabled will be enabled again prior to 2884 * return. 2885 */ 2886int regulator_bulk_disable(int num_consumers, 2887 struct regulator_bulk_data *consumers) 2888{ 2889 int i; 2890 int ret, r; 2891 2892 for (i = num_consumers - 1; i >= 0; --i) { 2893 ret = regulator_disable(consumers[i].consumer); 2894 if (ret != 0) 2895 goto err; 2896 } 2897 2898 return 0; 2899 2900err: 2901 pr_err("Failed to disable %s: %d\n", consumers[i].supply, ret); 2902 for (++i; i < num_consumers; ++i) { 2903 r = regulator_enable(consumers[i].consumer); 2904 if (r != 0) 2905 pr_err("Failed to reename %s: %d\n", 2906 consumers[i].supply, r); 2907 } 2908 2909 return ret; 2910} 2911EXPORT_SYMBOL_GPL(regulator_bulk_disable); 2912 2913/** 2914 * regulator_bulk_force_disable - force disable multiple regulator consumers 2915 * 2916 * @num_consumers: Number of consumers 2917 * @consumers: Consumer data; clients are stored here. 2918 * @return 0 on success, an errno on failure 2919 * 2920 * This convenience API allows consumers to forcibly disable multiple regulator 2921 * clients in a single API call. 2922 * NOTE: This should be used for situations when device damage will 2923 * likely occur if the regulators are not disabled (e.g. over temp). 2924 * Although regulator_force_disable function call for some consumers can 2925 * return error numbers, the function is called for all consumers. 2926 */ 2927int regulator_bulk_force_disable(int num_consumers, 2928 struct regulator_bulk_data *consumers) 2929{ 2930 int i; 2931 int ret; 2932 2933 for (i = 0; i < num_consumers; i++) 2934 consumers[i].ret = 2935 regulator_force_disable(consumers[i].consumer); 2936 2937 for (i = 0; i < num_consumers; i++) { 2938 if (consumers[i].ret != 0) { 2939 ret = consumers[i].ret; 2940 goto out; 2941 } 2942 } 2943 2944 return 0; 2945out: 2946 return ret; 2947} 2948EXPORT_SYMBOL_GPL(regulator_bulk_force_disable); 2949 2950/** 2951 * regulator_bulk_free - free multiple regulator consumers 2952 * 2953 * @num_consumers: Number of consumers 2954 * @consumers: Consumer data; clients are stored here. 2955 * 2956 * This convenience API allows consumers to free multiple regulator 2957 * clients in a single API call. 2958 */ 2959void regulator_bulk_free(int num_consumers, 2960 struct regulator_bulk_data *consumers) 2961{ 2962 int i; 2963 2964 for (i = 0; i < num_consumers; i++) { 2965 regulator_put(consumers[i].consumer); 2966 consumers[i].consumer = NULL; 2967 } 2968} 2969EXPORT_SYMBOL_GPL(regulator_bulk_free); 2970 2971/** 2972 * regulator_notifier_call_chain - call regulator event notifier 2973 * @rdev: regulator source 2974 * @event: notifier block 2975 * @data: callback-specific data. 2976 * 2977 * Called by regulator drivers to notify clients a regulator event has 2978 * occurred. We also notify regulator clients downstream. 2979 * Note lock must be held by caller. 2980 */ 2981int regulator_notifier_call_chain(struct regulator_dev *rdev, 2982 unsigned long event, void *data) 2983{ 2984 _notifier_call_chain(rdev, event, data); 2985 return NOTIFY_DONE; 2986 2987} 2988EXPORT_SYMBOL_GPL(regulator_notifier_call_chain); 2989 2990/** 2991 * regulator_mode_to_status - convert a regulator mode into a status 2992 * 2993 * @mode: Mode to convert 2994 * 2995 * Convert a regulator mode into a status. 2996 */ 2997int regulator_mode_to_status(unsigned int mode) 2998{ 2999 switch (mode) { 3000 case REGULATOR_MODE_FAST: 3001 return REGULATOR_STATUS_FAST; 3002 case REGULATOR_MODE_NORMAL: 3003 return REGULATOR_STATUS_NORMAL; 3004 case REGULATOR_MODE_IDLE: 3005 return REGULATOR_STATUS_IDLE; 3006 case REGULATOR_MODE_STANDBY: 3007 return REGULATOR_STATUS_STANDBY; 3008 default: 3009 return REGULATOR_STATUS_UNDEFINED; 3010 } 3011} 3012EXPORT_SYMBOL_GPL(regulator_mode_to_status); 3013 3014/* 3015 * To avoid cluttering sysfs (and memory) with useless state, only 3016 * create attributes that can be meaningfully displayed. 3017 */ 3018static int add_regulator_attributes(struct regulator_dev *rdev) 3019{ 3020 struct device *dev = &rdev->dev; 3021 struct regulator_ops *ops = rdev->desc->ops; 3022 int status = 0; 3023 3024 /* some attributes need specific methods to be displayed */ 3025 if ((ops->get_voltage && ops->get_voltage(rdev) >= 0) || 3026 (ops->get_voltage_sel && ops->get_voltage_sel(rdev) >= 0) || 3027 (ops->list_voltage && ops->list_voltage(rdev, 0) >= 0)) { 3028 status = device_create_file(dev, &dev_attr_microvolts); 3029 if (status < 0) 3030 return status; 3031 } 3032 if (ops->get_current_limit) { 3033 status = device_create_file(dev, &dev_attr_microamps); 3034 if (status < 0) 3035 return status; 3036 } 3037 if (ops->get_mode) { 3038 status = device_create_file(dev, &dev_attr_opmode); 3039 if (status < 0) 3040 return status; 3041 } 3042 if (ops->is_enabled) { 3043 status = device_create_file(dev, &dev_attr_state); 3044 if (status < 0) 3045 return status; 3046 } 3047 if (ops->get_status) { 3048 status = device_create_file(dev, &dev_attr_status); 3049 if (status < 0) 3050 return status; 3051 } 3052 3053 /* some attributes are type-specific */ 3054 if (rdev->desc->type == REGULATOR_CURRENT) { 3055 status = device_create_file(dev, &dev_attr_requested_microamps); 3056 if (status < 0) 3057 return status; 3058 } 3059 3060 /* all the other attributes exist to support constraints; 3061 * don't show them if there are no constraints, or if the 3062 * relevant supporting methods are missing. 3063 */ 3064 if (!rdev->constraints) 3065 return status; 3066 3067 /* constraints need specific supporting methods */ 3068 if (ops->set_voltage || ops->set_voltage_sel) { 3069 status = device_create_file(dev, &dev_attr_min_microvolts); 3070 if (status < 0) 3071 return status; 3072 status = device_create_file(dev, &dev_attr_max_microvolts); 3073 if (status < 0) 3074 return status; 3075 } 3076 if (ops->set_current_limit) { 3077 status = device_create_file(dev, &dev_attr_min_microamps); 3078 if (status < 0) 3079 return status; 3080 status = device_create_file(dev, &dev_attr_max_microamps); 3081 if (status < 0) 3082 return status; 3083 } 3084 3085 status = device_create_file(dev, &dev_attr_suspend_standby_state); 3086 if (status < 0) 3087 return status; 3088 status = device_create_file(dev, &dev_attr_suspend_mem_state); 3089 if (status < 0) 3090 return status; 3091 status = device_create_file(dev, &dev_attr_suspend_disk_state); 3092 if (status < 0) 3093 return status; 3094 3095 if (ops->set_suspend_voltage) { 3096 status = device_create_file(dev, 3097 &dev_attr_suspend_standby_microvolts); 3098 if (status < 0) 3099 return status; 3100 status = device_create_file(dev, 3101 &dev_attr_suspend_mem_microvolts); 3102 if (status < 0) 3103 return status; 3104 status = device_create_file(dev, 3105 &dev_attr_suspend_disk_microvolts); 3106 if (status < 0) 3107 return status; 3108 } 3109 3110 if (ops->set_suspend_mode) { 3111 status = device_create_file(dev, 3112 &dev_attr_suspend_standby_mode); 3113 if (status < 0) 3114 return status; 3115 status = device_create_file(dev, 3116 &dev_attr_suspend_mem_mode); 3117 if (status < 0) 3118 return status; 3119 status = device_create_file(dev, 3120 &dev_attr_suspend_disk_mode); 3121 if (status < 0) 3122 return status; 3123 } 3124 3125 return status; 3126} 3127 3128static void rdev_init_debugfs(struct regulator_dev *rdev) 3129{ 3130 rdev->debugfs = debugfs_create_dir(rdev_get_name(rdev), debugfs_root); 3131 if (!rdev->debugfs) { 3132 rdev_warn(rdev, "Failed to create debugfs directory\n"); 3133 return; 3134 } 3135 3136 debugfs_create_u32("use_count", 0444, rdev->debugfs, 3137 &rdev->use_count); 3138 debugfs_create_u32("open_count", 0444, rdev->debugfs, 3139 &rdev->open_count); 3140} 3141 3142/** 3143 * regulator_register - register regulator 3144 * @regulator_desc: regulator to register 3145 * @config: runtime configuration for regulator 3146 * 3147 * Called by regulator drivers to register a regulator. 3148 * Returns 0 on success. 3149 */ 3150struct regulator_dev * 3151regulator_register(const struct regulator_desc *regulator_desc, 3152 const struct regulator_config *config) 3153{ 3154 const struct regulation_constraints *constraints = NULL; 3155 const struct regulator_init_data *init_data; 3156 static atomic_t regulator_no = ATOMIC_INIT(0); 3157 struct regulator_dev *rdev; 3158 struct device *dev; 3159 int ret, i; 3160 const char *supply = NULL; 3161 3162 if (regulator_desc == NULL || config == NULL) 3163 return ERR_PTR(-EINVAL); 3164 3165 dev = config->dev; 3166 WARN_ON(!dev); 3167 3168 if (regulator_desc->name == NULL || regulator_desc->ops == NULL) 3169 return ERR_PTR(-EINVAL); 3170 3171 if (regulator_desc->type != REGULATOR_VOLTAGE && 3172 regulator_desc->type != REGULATOR_CURRENT) 3173 return ERR_PTR(-EINVAL); 3174 3175 /* Only one of each should be implemented */ 3176 WARN_ON(regulator_desc->ops->get_voltage && 3177 regulator_desc->ops->get_voltage_sel); 3178 WARN_ON(regulator_desc->ops->set_voltage && 3179 regulator_desc->ops->set_voltage_sel); 3180 3181 /* If we're using selectors we must implement list_voltage. */ 3182 if (regulator_desc->ops->get_voltage_sel && 3183 !regulator_desc->ops->list_voltage) { 3184 return ERR_PTR(-EINVAL); 3185 } 3186 if (regulator_desc->ops->set_voltage_sel && 3187 !regulator_desc->ops->list_voltage) { 3188 return ERR_PTR(-EINVAL); 3189 } 3190 3191 init_data = config->init_data; 3192 3193 rdev = kzalloc(sizeof(struct regulator_dev), GFP_KERNEL); 3194 if (rdev == NULL) 3195 return ERR_PTR(-ENOMEM); 3196 3197 mutex_lock(®ulator_list_mutex); 3198 3199 mutex_init(&rdev->mutex); 3200 rdev->reg_data = config->driver_data; 3201 rdev->owner = regulator_desc->owner; 3202 rdev->desc = regulator_desc; 3203 if (config->regmap) 3204 rdev->regmap = config->regmap; 3205 else if (dev_get_regmap(dev, NULL)) 3206 rdev->regmap = dev_get_regmap(dev, NULL); 3207 else if (dev->parent) 3208 rdev->regmap = dev_get_regmap(dev->parent, NULL); 3209 INIT_LIST_HEAD(&rdev->consumer_list); 3210 INIT_LIST_HEAD(&rdev->list); 3211 BLOCKING_INIT_NOTIFIER_HEAD(&rdev->notifier); 3212 INIT_DELAYED_WORK(&rdev->disable_work, regulator_disable_work); 3213 3214 /* preform any regulator specific init */ 3215 if (init_data && init_data->regulator_init) { 3216 ret = init_data->regulator_init(rdev->reg_data); 3217 if (ret < 0) 3218 goto clean; 3219 } 3220 3221 /* register with sysfs */ 3222 rdev->dev.class = ®ulator_class; 3223 rdev->dev.of_node = config->of_node; 3224 rdev->dev.parent = dev; 3225 dev_set_name(&rdev->dev, "regulator.%d", 3226 atomic_inc_return(®ulator_no) - 1); 3227 ret = device_register(&rdev->dev); 3228 if (ret != 0) { 3229 put_device(&rdev->dev); 3230 goto clean; 3231 } 3232 3233 dev_set_drvdata(&rdev->dev, rdev); 3234 3235 if (config->ena_gpio) { 3236 ret = gpio_request_one(config->ena_gpio, 3237 GPIOF_DIR_OUT | config->ena_gpio_flags, 3238 rdev_get_name(rdev)); 3239 if (ret != 0) { 3240 rdev_err(rdev, "Failed to request enable GPIO%d: %d\n", 3241 config->ena_gpio, ret); 3242 goto clean; 3243 } 3244 3245 rdev->ena_gpio = config->ena_gpio; 3246 rdev->ena_gpio_invert = config->ena_gpio_invert; 3247 3248 if (config->ena_gpio_flags & GPIOF_OUT_INIT_HIGH) 3249 rdev->ena_gpio_state = 1; 3250 3251 if (rdev->ena_gpio_invert) 3252 rdev->ena_gpio_state = !rdev->ena_gpio_state; 3253 } 3254 3255 /* set regulator constraints */ 3256 if (init_data) 3257 constraints = &init_data->constraints; 3258 3259 ret = set_machine_constraints(rdev, constraints); 3260 if (ret < 0) 3261 goto scrub; 3262 3263 /* add attributes supported by this regulator */ 3264 ret = add_regulator_attributes(rdev); 3265 if (ret < 0) 3266 goto scrub; 3267 3268 if (init_data && init_data->supply_regulator) 3269 supply = init_data->supply_regulator; 3270 else if (regulator_desc->supply_name) 3271 supply = regulator_desc->supply_name; 3272 3273 if (supply) { 3274 struct regulator_dev *r; 3275 3276 r = regulator_dev_lookup(dev, supply, &ret); 3277 3278 if (!r) { 3279 dev_err(dev, "Failed to find supply %s\n", supply); 3280 ret = -EPROBE_DEFER; 3281 goto scrub; 3282 } 3283 3284 ret = set_supply(rdev, r); 3285 if (ret < 0) 3286 goto scrub; 3287 3288 /* Enable supply if rail is enabled */ 3289 if (_regulator_is_enabled(rdev)) { 3290 ret = regulator_enable(rdev->supply); 3291 if (ret < 0) 3292 goto scrub; 3293 } 3294 } 3295 3296 /* add consumers devices */ 3297 if (init_data) { 3298 for (i = 0; i < init_data->num_consumer_supplies; i++) { 3299 ret = set_consumer_device_supply(rdev, 3300 init_data->consumer_supplies[i].dev_name, 3301 init_data->consumer_supplies[i].supply); 3302 if (ret < 0) { 3303 dev_err(dev, "Failed to set supply %s\n", 3304 init_data->consumer_supplies[i].supply); 3305 goto unset_supplies; 3306 } 3307 } 3308 } 3309 3310 list_add(&rdev->list, ®ulator_list); 3311 3312 rdev_init_debugfs(rdev); 3313out: 3314 mutex_unlock(®ulator_list_mutex); 3315 return rdev; 3316 3317unset_supplies: 3318 unset_regulator_supplies(rdev); 3319 3320scrub: 3321 if (rdev->supply) 3322 regulator_put(rdev->supply); 3323 if (rdev->ena_gpio) 3324 gpio_free(rdev->ena_gpio); 3325 kfree(rdev->constraints); 3326 device_unregister(&rdev->dev); 3327 /* device core frees rdev */ 3328 rdev = ERR_PTR(ret); 3329 goto out; 3330 3331clean: 3332 kfree(rdev); 3333 rdev = ERR_PTR(ret); 3334 goto out; 3335} 3336EXPORT_SYMBOL_GPL(regulator_register); 3337 3338/** 3339 * regulator_unregister - unregister regulator 3340 * @rdev: regulator to unregister 3341 * 3342 * Called by regulator drivers to unregister a regulator. 3343 */ 3344void regulator_unregister(struct regulator_dev *rdev) 3345{ 3346 if (rdev == NULL) 3347 return; 3348 3349 if (rdev->supply) 3350 regulator_put(rdev->supply); 3351 mutex_lock(®ulator_list_mutex); 3352 debugfs_remove_recursive(rdev->debugfs); 3353 flush_work_sync(&rdev->disable_work.work); 3354 WARN_ON(rdev->open_count); 3355 unset_regulator_supplies(rdev); 3356 list_del(&rdev->list); 3357 kfree(rdev->constraints); 3358 if (rdev->ena_gpio) 3359 gpio_free(rdev->ena_gpio); 3360 device_unregister(&rdev->dev); 3361 mutex_unlock(®ulator_list_mutex); 3362} 3363EXPORT_SYMBOL_GPL(regulator_unregister); 3364 3365/** 3366 * regulator_suspend_prepare - prepare regulators for system wide suspend 3367 * @state: system suspend state 3368 * 3369 * Configure each regulator with it's suspend operating parameters for state. 3370 * This will usually be called by machine suspend code prior to supending. 3371 */ 3372int regulator_suspend_prepare(suspend_state_t state) 3373{ 3374 struct regulator_dev *rdev; 3375 int ret = 0; 3376 3377 /* ON is handled by regulator active state */ 3378 if (state == PM_SUSPEND_ON) 3379 return -EINVAL; 3380 3381 mutex_lock(®ulator_list_mutex); 3382 list_for_each_entry(rdev, ®ulator_list, list) { 3383 3384 mutex_lock(&rdev->mutex); 3385 ret = suspend_prepare(rdev, state); 3386 mutex_unlock(&rdev->mutex); 3387 3388 if (ret < 0) { 3389 rdev_err(rdev, "failed to prepare\n"); 3390 goto out; 3391 } 3392 } 3393out: 3394 mutex_unlock(®ulator_list_mutex); 3395 return ret; 3396} 3397EXPORT_SYMBOL_GPL(regulator_suspend_prepare); 3398 3399/** 3400 * regulator_suspend_finish - resume regulators from system wide suspend 3401 * 3402 * Turn on regulators that might be turned off by regulator_suspend_prepare 3403 * and that should be turned on according to the regulators properties. 3404 */ 3405int regulator_suspend_finish(void) 3406{ 3407 struct regulator_dev *rdev; 3408 int ret = 0, error; 3409 3410 mutex_lock(®ulator_list_mutex); 3411 list_for_each_entry(rdev, ®ulator_list, list) { 3412 struct regulator_ops *ops = rdev->desc->ops; 3413 3414 mutex_lock(&rdev->mutex); 3415 if ((rdev->use_count > 0 || rdev->constraints->always_on) && 3416 ops->enable) { 3417 error = ops->enable(rdev); 3418 if (error) 3419 ret = error; 3420 } else { 3421 if (!has_full_constraints) 3422 goto unlock; 3423 if (!ops->disable) 3424 goto unlock; 3425 if (!_regulator_is_enabled(rdev)) 3426 goto unlock; 3427 3428 error = ops->disable(rdev); 3429 if (error) 3430 ret = error; 3431 } 3432unlock: 3433 mutex_unlock(&rdev->mutex); 3434 } 3435 mutex_unlock(®ulator_list_mutex); 3436 return ret; 3437} 3438EXPORT_SYMBOL_GPL(regulator_suspend_finish); 3439 3440/** 3441 * regulator_has_full_constraints - the system has fully specified constraints 3442 * 3443 * Calling this function will cause the regulator API to disable all 3444 * regulators which have a zero use count and don't have an always_on 3445 * constraint in a late_initcall. 3446 * 3447 * The intention is that this will become the default behaviour in a 3448 * future kernel release so users are encouraged to use this facility 3449 * now. 3450 */ 3451void regulator_has_full_constraints(void) 3452{ 3453 has_full_constraints = 1; 3454} 3455EXPORT_SYMBOL_GPL(regulator_has_full_constraints); 3456 3457/** 3458 * regulator_use_dummy_regulator - Provide a dummy regulator when none is found 3459 * 3460 * Calling this function will cause the regulator API to provide a 3461 * dummy regulator to consumers if no physical regulator is found, 3462 * allowing most consumers to proceed as though a regulator were 3463 * configured. This allows systems such as those with software 3464 * controllable regulators for the CPU core only to be brought up more 3465 * readily. 3466 */ 3467void regulator_use_dummy_regulator(void) 3468{ 3469 board_wants_dummy_regulator = true; 3470} 3471EXPORT_SYMBOL_GPL(regulator_use_dummy_regulator); 3472 3473/** 3474 * rdev_get_drvdata - get rdev regulator driver data 3475 * @rdev: regulator 3476 * 3477 * Get rdev regulator driver private data. This call can be used in the 3478 * regulator driver context. 3479 */ 3480void *rdev_get_drvdata(struct regulator_dev *rdev) 3481{ 3482 return rdev->reg_data; 3483} 3484EXPORT_SYMBOL_GPL(rdev_get_drvdata); 3485 3486/** 3487 * regulator_get_drvdata - get regulator driver data 3488 * @regulator: regulator 3489 * 3490 * Get regulator driver private data. This call can be used in the consumer 3491 * driver context when non API regulator specific functions need to be called. 3492 */ 3493void *regulator_get_drvdata(struct regulator *regulator) 3494{ 3495 return regulator->rdev->reg_data; 3496} 3497EXPORT_SYMBOL_GPL(regulator_get_drvdata); 3498 3499/** 3500 * regulator_set_drvdata - set regulator driver data 3501 * @regulator: regulator 3502 * @data: data 3503 */ 3504void regulator_set_drvdata(struct regulator *regulator, void *data) 3505{ 3506 regulator->rdev->reg_data = data; 3507} 3508EXPORT_SYMBOL_GPL(regulator_set_drvdata); 3509 3510/** 3511 * regulator_get_id - get regulator ID 3512 * @rdev: regulator 3513 */ 3514int rdev_get_id(struct regulator_dev *rdev) 3515{ 3516 return rdev->desc->id; 3517} 3518EXPORT_SYMBOL_GPL(rdev_get_id); 3519 3520struct device *rdev_get_dev(struct regulator_dev *rdev) 3521{ 3522 return &rdev->dev; 3523} 3524EXPORT_SYMBOL_GPL(rdev_get_dev); 3525 3526void *regulator_get_init_drvdata(struct regulator_init_data *reg_init_data) 3527{ 3528 return reg_init_data->driver_data; 3529} 3530EXPORT_SYMBOL_GPL(regulator_get_init_drvdata); 3531 3532#ifdef CONFIG_DEBUG_FS 3533static ssize_t supply_map_read_file(struct file *file, char __user *user_buf, 3534 size_t count, loff_t *ppos) 3535{ 3536 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 3537 ssize_t len, ret = 0; 3538 struct regulator_map *map; 3539 3540 if (!buf) 3541 return -ENOMEM; 3542 3543 list_for_each_entry(map, ®ulator_map_list, list) { 3544 len = snprintf(buf + ret, PAGE_SIZE - ret, 3545 "%s -> %s.%s\n", 3546 rdev_get_name(map->regulator), map->dev_name, 3547 map->supply); 3548 if (len >= 0) 3549 ret += len; 3550 if (ret > PAGE_SIZE) { 3551 ret = PAGE_SIZE; 3552 break; 3553 } 3554 } 3555 3556 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); 3557 3558 kfree(buf); 3559 3560 return ret; 3561} 3562#endif 3563 3564static const struct file_operations supply_map_fops = { 3565#ifdef CONFIG_DEBUG_FS 3566 .read = supply_map_read_file, 3567 .llseek = default_llseek, 3568#endif 3569}; 3570 3571static int __init regulator_init(void) 3572{ 3573 int ret; 3574 3575 ret = class_register(®ulator_class); 3576 3577 debugfs_root = debugfs_create_dir("regulator", NULL); 3578 if (!debugfs_root) 3579 pr_warn("regulator: Failed to create debugfs directory\n"); 3580 3581 debugfs_create_file("supply_map", 0444, debugfs_root, NULL, 3582 &supply_map_fops); 3583 3584 regulator_dummy_init(); 3585 3586 return ret; 3587} 3588 3589/* init early to allow our consumers to complete system booting */ 3590core_initcall(regulator_init); 3591 3592static int __init regulator_init_complete(void) 3593{ 3594 struct regulator_dev *rdev; 3595 struct regulator_ops *ops; 3596 struct regulation_constraints *c; 3597 int enabled, ret; 3598 3599 /* 3600 * Since DT doesn't provide an idiomatic mechanism for 3601 * enabling full constraints and since it's much more natural 3602 * with DT to provide them just assume that a DT enabled 3603 * system has full constraints. 3604 */ 3605 if (of_have_populated_dt()) 3606 has_full_constraints = true; 3607 3608 mutex_lock(®ulator_list_mutex); 3609 3610 /* If we have a full configuration then disable any regulators 3611 * which are not in use or always_on. This will become the 3612 * default behaviour in the future. 3613 */ 3614 list_for_each_entry(rdev, ®ulator_list, list) { 3615 ops = rdev->desc->ops; 3616 c = rdev->constraints; 3617 3618 if (!ops->disable || (c && c->always_on)) 3619 continue; 3620 3621 mutex_lock(&rdev->mutex); 3622 3623 if (rdev->use_count) 3624 goto unlock; 3625 3626 /* If we can't read the status assume it's on. */ 3627 if (ops->is_enabled) 3628 enabled = ops->is_enabled(rdev); 3629 else 3630 enabled = 1; 3631 3632 if (!enabled) 3633 goto unlock; 3634 3635 if (has_full_constraints) { 3636 /* We log since this may kill the system if it 3637 * goes wrong. */ 3638 rdev_info(rdev, "disabling\n"); 3639 ret = ops->disable(rdev); 3640 if (ret != 0) { 3641 rdev_err(rdev, "couldn't disable: %d\n", ret); 3642 } 3643 } else { 3644 /* The intention is that in future we will 3645 * assume that full constraints are provided 3646 * so warn even if we aren't going to do 3647 * anything here. 3648 */ 3649 rdev_warn(rdev, "incomplete constraints, leaving on\n"); 3650 } 3651 3652unlock: 3653 mutex_unlock(&rdev->mutex); 3654 } 3655 3656 mutex_unlock(®ulator_list_mutex); 3657 3658 return 0; 3659} 3660late_initcall(regulator_init_complete); 3661