1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Reset Controller framework 4 * 5 * Copyright 2013 Philipp Zabel, Pengutronix 6 */ 7 #include <linux/atomic.h> 8 #include <linux/device.h> 9 #include <linux/err.h> 10 #include <linux/export.h> 11 #include <linux/kernel.h> 12 #include <linux/kref.h> 13 #include <linux/module.h> 14 #include <linux/of.h> 15 #include <linux/acpi.h> 16 #include <linux/reset.h> 17 #include <linux/reset-controller.h> 18 #include <linux/slab.h> 19 20 static DEFINE_MUTEX(reset_list_mutex); 21 static LIST_HEAD(reset_controller_list); 22 23 static DEFINE_MUTEX(reset_lookup_mutex); 24 static LIST_HEAD(reset_lookup_list); 25 26 /** 27 * struct reset_control - a reset control 28 * @rcdev: a pointer to the reset controller device 29 * this reset control belongs to 30 * @list: list entry for the rcdev's reset controller list 31 * @id: ID of the reset controller in the reset 32 * controller device 33 * @refcnt: Number of gets of this reset_control 34 * @acquired: Only one reset_control may be acquired for a given rcdev and id. 35 * @shared: Is this a shared (1), or an exclusive (0) reset_control? 36 * @array: Is this an array of reset controls (1)? 37 * @deassert_count: Number of times this reset line has been deasserted 38 * @triggered_count: Number of times this reset line has been reset. Currently 39 * only used for shared resets, which means that the value 40 * will be either 0 or 1. 41 */ 42 struct reset_control { 43 struct reset_controller_dev *rcdev; 44 struct list_head list; 45 unsigned int id; 46 struct kref refcnt; 47 bool acquired; 48 bool shared; 49 bool array; 50 atomic_t deassert_count; 51 atomic_t triggered_count; 52 }; 53 54 /** 55 * struct reset_control_array - an array of reset controls 56 * @base: reset control for compatibility with reset control API functions 57 * @num_rstcs: number of reset controls 58 * @rstc: array of reset controls 59 */ 60 struct reset_control_array { 61 struct reset_control base; 62 unsigned int num_rstcs; 63 struct reset_control *rstc[]; 64 }; 65 66 static const char *rcdev_name(struct reset_controller_dev *rcdev) 67 { 68 if (rcdev->dev) 69 return dev_name(rcdev->dev); 70 71 if (rcdev->of_node) 72 return rcdev->of_node->full_name; 73 74 return NULL; 75 } 76 77 /** 78 * of_reset_simple_xlate - translate reset_spec to the reset line number 79 * @rcdev: a pointer to the reset controller device 80 * @reset_spec: reset line specifier as found in the device tree 81 * 82 * This static translation function is used by default if of_xlate in 83 * :c:type:`reset_controller_dev` is not set. It is useful for all reset 84 * controllers with 1:1 mapping, where reset lines can be indexed by number 85 * without gaps. 86 */ 87 static int of_reset_simple_xlate(struct reset_controller_dev *rcdev, 88 const struct of_phandle_args *reset_spec) 89 { 90 if (reset_spec->args[0] >= rcdev->nr_resets) 91 return -EINVAL; 92 93 return reset_spec->args[0]; 94 } 95 96 /** 97 * reset_controller_register - register a reset controller device 98 * @rcdev: a pointer to the initialized reset controller device 99 */ 100 int reset_controller_register(struct reset_controller_dev *rcdev) 101 { 102 if (!rcdev->of_xlate) { 103 rcdev->of_reset_n_cells = 1; 104 rcdev->of_xlate = of_reset_simple_xlate; 105 } 106 107 INIT_LIST_HEAD(&rcdev->reset_control_head); 108 109 mutex_lock(&reset_list_mutex); 110 list_add(&rcdev->list, &reset_controller_list); 111 mutex_unlock(&reset_list_mutex); 112 113 return 0; 114 } 115 EXPORT_SYMBOL_GPL(reset_controller_register); 116 117 /** 118 * reset_controller_unregister - unregister a reset controller device 119 * @rcdev: a pointer to the reset controller device 120 */ 121 void reset_controller_unregister(struct reset_controller_dev *rcdev) 122 { 123 mutex_lock(&reset_list_mutex); 124 list_del(&rcdev->list); 125 mutex_unlock(&reset_list_mutex); 126 } 127 EXPORT_SYMBOL_GPL(reset_controller_unregister); 128 129 static void devm_reset_controller_release(struct device *dev, void *res) 130 { 131 reset_controller_unregister(*(struct reset_controller_dev **)res); 132 } 133 134 /** 135 * devm_reset_controller_register - resource managed reset_controller_register() 136 * @dev: device that is registering this reset controller 137 * @rcdev: a pointer to the initialized reset controller device 138 * 139 * Managed reset_controller_register(). For reset controllers registered by 140 * this function, reset_controller_unregister() is automatically called on 141 * driver detach. See reset_controller_register() for more information. 142 */ 143 int devm_reset_controller_register(struct device *dev, 144 struct reset_controller_dev *rcdev) 145 { 146 struct reset_controller_dev **rcdevp; 147 int ret; 148 149 rcdevp = devres_alloc(devm_reset_controller_release, sizeof(*rcdevp), 150 GFP_KERNEL); 151 if (!rcdevp) 152 return -ENOMEM; 153 154 ret = reset_controller_register(rcdev); 155 if (ret) { 156 devres_free(rcdevp); 157 return ret; 158 } 159 160 *rcdevp = rcdev; 161 devres_add(dev, rcdevp); 162 163 return ret; 164 } 165 EXPORT_SYMBOL_GPL(devm_reset_controller_register); 166 167 /** 168 * reset_controller_add_lookup - register a set of lookup entries 169 * @lookup: array of reset lookup entries 170 * @num_entries: number of entries in the lookup array 171 */ 172 void reset_controller_add_lookup(struct reset_control_lookup *lookup, 173 unsigned int num_entries) 174 { 175 struct reset_control_lookup *entry; 176 unsigned int i; 177 178 mutex_lock(&reset_lookup_mutex); 179 for (i = 0; i < num_entries; i++) { 180 entry = &lookup[i]; 181 182 if (!entry->dev_id || !entry->provider) { 183 pr_warn("%s(): reset lookup entry badly specified, skipping\n", 184 __func__); 185 continue; 186 } 187 188 list_add_tail(&entry->list, &reset_lookup_list); 189 } 190 mutex_unlock(&reset_lookup_mutex); 191 } 192 EXPORT_SYMBOL_GPL(reset_controller_add_lookup); 193 194 static inline struct reset_control_array * 195 rstc_to_array(struct reset_control *rstc) { 196 return container_of(rstc, struct reset_control_array, base); 197 } 198 199 static int reset_control_array_reset(struct reset_control_array *resets) 200 { 201 int ret, i; 202 203 for (i = 0; i < resets->num_rstcs; i++) { 204 ret = reset_control_reset(resets->rstc[i]); 205 if (ret) 206 return ret; 207 } 208 209 return 0; 210 } 211 212 static int reset_control_array_rearm(struct reset_control_array *resets) 213 { 214 struct reset_control *rstc; 215 int i; 216 217 for (i = 0; i < resets->num_rstcs; i++) { 218 rstc = resets->rstc[i]; 219 220 if (!rstc) 221 continue; 222 223 if (WARN_ON(IS_ERR(rstc))) 224 return -EINVAL; 225 226 if (rstc->shared) { 227 if (WARN_ON(atomic_read(&rstc->deassert_count) != 0)) 228 return -EINVAL; 229 } else { 230 if (!rstc->acquired) 231 return -EPERM; 232 } 233 } 234 235 for (i = 0; i < resets->num_rstcs; i++) { 236 rstc = resets->rstc[i]; 237 238 if (rstc && rstc->shared) 239 WARN_ON(atomic_dec_return(&rstc->triggered_count) < 0); 240 } 241 242 return 0; 243 } 244 245 static int reset_control_array_assert(struct reset_control_array *resets) 246 { 247 int ret, i; 248 249 for (i = 0; i < resets->num_rstcs; i++) { 250 ret = reset_control_assert(resets->rstc[i]); 251 if (ret) 252 goto err; 253 } 254 255 return 0; 256 257 err: 258 while (i--) 259 reset_control_deassert(resets->rstc[i]); 260 return ret; 261 } 262 263 static int reset_control_array_deassert(struct reset_control_array *resets) 264 { 265 int ret, i; 266 267 for (i = 0; i < resets->num_rstcs; i++) { 268 ret = reset_control_deassert(resets->rstc[i]); 269 if (ret) 270 goto err; 271 } 272 273 return 0; 274 275 err: 276 while (i--) 277 reset_control_assert(resets->rstc[i]); 278 return ret; 279 } 280 281 static int reset_control_array_acquire(struct reset_control_array *resets) 282 { 283 unsigned int i; 284 int err; 285 286 for (i = 0; i < resets->num_rstcs; i++) { 287 err = reset_control_acquire(resets->rstc[i]); 288 if (err < 0) 289 goto release; 290 } 291 292 return 0; 293 294 release: 295 while (i--) 296 reset_control_release(resets->rstc[i]); 297 298 return err; 299 } 300 301 static void reset_control_array_release(struct reset_control_array *resets) 302 { 303 unsigned int i; 304 305 for (i = 0; i < resets->num_rstcs; i++) 306 reset_control_release(resets->rstc[i]); 307 } 308 309 static inline bool reset_control_is_array(struct reset_control *rstc) 310 { 311 return rstc->array; 312 } 313 314 /** 315 * reset_control_reset - reset the controlled device 316 * @rstc: reset controller 317 * 318 * On a shared reset line the actual reset pulse is only triggered once for the 319 * lifetime of the reset_control instance: for all but the first caller this is 320 * a no-op. 321 * Consumers must not use reset_control_(de)assert on shared reset lines when 322 * reset_control_reset has been used. 323 * 324 * If rstc is NULL it is an optional reset and the function will just 325 * return 0. 326 */ 327 int reset_control_reset(struct reset_control *rstc) 328 { 329 int ret; 330 331 if (!rstc) 332 return 0; 333 334 if (WARN_ON(IS_ERR(rstc))) 335 return -EINVAL; 336 337 if (reset_control_is_array(rstc)) 338 return reset_control_array_reset(rstc_to_array(rstc)); 339 340 if (!rstc->rcdev->ops->reset) 341 return -ENOTSUPP; 342 343 if (rstc->shared) { 344 if (WARN_ON(atomic_read(&rstc->deassert_count) != 0)) 345 return -EINVAL; 346 347 if (atomic_inc_return(&rstc->triggered_count) != 1) 348 return 0; 349 } else { 350 if (!rstc->acquired) 351 return -EPERM; 352 } 353 354 ret = rstc->rcdev->ops->reset(rstc->rcdev, rstc->id); 355 if (rstc->shared && ret) 356 atomic_dec(&rstc->triggered_count); 357 358 return ret; 359 } 360 EXPORT_SYMBOL_GPL(reset_control_reset); 361 362 /** 363 * reset_control_bulk_reset - reset the controlled devices in order 364 * @num_rstcs: number of entries in rstcs array 365 * @rstcs: array of struct reset_control_bulk_data with reset controls set 366 * 367 * Issue a reset on all provided reset controls, in order. 368 * 369 * See also: reset_control_reset() 370 */ 371 int reset_control_bulk_reset(int num_rstcs, 372 struct reset_control_bulk_data *rstcs) 373 { 374 int ret, i; 375 376 for (i = 0; i < num_rstcs; i++) { 377 ret = reset_control_reset(rstcs[i].rstc); 378 if (ret) 379 return ret; 380 } 381 382 return 0; 383 } 384 EXPORT_SYMBOL_GPL(reset_control_bulk_reset); 385 386 /** 387 * reset_control_rearm - allow shared reset line to be re-triggered" 388 * @rstc: reset controller 389 * 390 * On a shared reset line the actual reset pulse is only triggered once for the 391 * lifetime of the reset_control instance, except if this call is used. 392 * 393 * Calls to this function must be balanced with calls to reset_control_reset, 394 * a warning is thrown in case triggered_count ever dips below 0. 395 * 396 * Consumers must not use reset_control_(de)assert on shared reset lines when 397 * reset_control_reset or reset_control_rearm have been used. 398 * 399 * If rstc is NULL the function will just return 0. 400 */ 401 int reset_control_rearm(struct reset_control *rstc) 402 { 403 if (!rstc) 404 return 0; 405 406 if (WARN_ON(IS_ERR(rstc))) 407 return -EINVAL; 408 409 if (reset_control_is_array(rstc)) 410 return reset_control_array_rearm(rstc_to_array(rstc)); 411 412 if (rstc->shared) { 413 if (WARN_ON(atomic_read(&rstc->deassert_count) != 0)) 414 return -EINVAL; 415 416 WARN_ON(atomic_dec_return(&rstc->triggered_count) < 0); 417 } else { 418 if (!rstc->acquired) 419 return -EPERM; 420 } 421 422 return 0; 423 } 424 EXPORT_SYMBOL_GPL(reset_control_rearm); 425 426 /** 427 * reset_control_assert - asserts the reset line 428 * @rstc: reset controller 429 * 430 * Calling this on an exclusive reset controller guarantees that the reset 431 * will be asserted. When called on a shared reset controller the line may 432 * still be deasserted, as long as other users keep it so. 433 * 434 * For shared reset controls a driver cannot expect the hw's registers and 435 * internal state to be reset, but must be prepared for this to happen. 436 * Consumers must not use reset_control_reset on shared reset lines when 437 * reset_control_(de)assert has been used. 438 * 439 * If rstc is NULL it is an optional reset and the function will just 440 * return 0. 441 */ 442 int reset_control_assert(struct reset_control *rstc) 443 { 444 if (!rstc) 445 return 0; 446 447 if (WARN_ON(IS_ERR(rstc))) 448 return -EINVAL; 449 450 if (reset_control_is_array(rstc)) 451 return reset_control_array_assert(rstc_to_array(rstc)); 452 453 if (rstc->shared) { 454 if (WARN_ON(atomic_read(&rstc->triggered_count) != 0)) 455 return -EINVAL; 456 457 if (WARN_ON(atomic_read(&rstc->deassert_count) == 0)) 458 return -EINVAL; 459 460 if (atomic_dec_return(&rstc->deassert_count) != 0) 461 return 0; 462 463 /* 464 * Shared reset controls allow the reset line to be in any state 465 * after this call, so doing nothing is a valid option. 466 */ 467 if (!rstc->rcdev->ops->assert) 468 return 0; 469 } else { 470 /* 471 * If the reset controller does not implement .assert(), there 472 * is no way to guarantee that the reset line is asserted after 473 * this call. 474 */ 475 if (!rstc->rcdev->ops->assert) 476 return -ENOTSUPP; 477 478 if (!rstc->acquired) { 479 WARN(1, "reset %s (ID: %u) is not acquired\n", 480 rcdev_name(rstc->rcdev), rstc->id); 481 return -EPERM; 482 } 483 } 484 485 return rstc->rcdev->ops->assert(rstc->rcdev, rstc->id); 486 } 487 EXPORT_SYMBOL_GPL(reset_control_assert); 488 489 /** 490 * reset_control_bulk_assert - asserts the reset lines in order 491 * @num_rstcs: number of entries in rstcs array 492 * @rstcs: array of struct reset_control_bulk_data with reset controls set 493 * 494 * Assert the reset lines for all provided reset controls, in order. 495 * If an assertion fails, already asserted resets are deasserted again. 496 * 497 * See also: reset_control_assert() 498 */ 499 int reset_control_bulk_assert(int num_rstcs, 500 struct reset_control_bulk_data *rstcs) 501 { 502 int ret, i; 503 504 for (i = 0; i < num_rstcs; i++) { 505 ret = reset_control_assert(rstcs[i].rstc); 506 if (ret) 507 goto err; 508 } 509 510 return 0; 511 512 err: 513 while (i--) 514 reset_control_deassert(rstcs[i].rstc); 515 return ret; 516 } 517 EXPORT_SYMBOL_GPL(reset_control_bulk_assert); 518 519 /** 520 * reset_control_deassert - deasserts the reset line 521 * @rstc: reset controller 522 * 523 * After calling this function, the reset is guaranteed to be deasserted. 524 * Consumers must not use reset_control_reset on shared reset lines when 525 * reset_control_(de)assert has been used. 526 * 527 * If rstc is NULL it is an optional reset and the function will just 528 * return 0. 529 */ 530 int reset_control_deassert(struct reset_control *rstc) 531 { 532 if (!rstc) 533 return 0; 534 535 if (WARN_ON(IS_ERR(rstc))) 536 return -EINVAL; 537 538 if (reset_control_is_array(rstc)) 539 return reset_control_array_deassert(rstc_to_array(rstc)); 540 541 if (rstc->shared) { 542 if (WARN_ON(atomic_read(&rstc->triggered_count) != 0)) 543 return -EINVAL; 544 545 if (atomic_inc_return(&rstc->deassert_count) != 1) 546 return 0; 547 } else { 548 if (!rstc->acquired) { 549 WARN(1, "reset %s (ID: %u) is not acquired\n", 550 rcdev_name(rstc->rcdev), rstc->id); 551 return -EPERM; 552 } 553 } 554 555 /* 556 * If the reset controller does not implement .deassert(), we assume 557 * that it handles self-deasserting reset lines via .reset(). In that 558 * case, the reset lines are deasserted by default. If that is not the 559 * case, the reset controller driver should implement .deassert() and 560 * return -ENOTSUPP. 561 */ 562 if (!rstc->rcdev->ops->deassert) 563 return 0; 564 565 return rstc->rcdev->ops->deassert(rstc->rcdev, rstc->id); 566 } 567 EXPORT_SYMBOL_GPL(reset_control_deassert); 568 569 /** 570 * reset_control_bulk_deassert - deasserts the reset lines in reverse order 571 * @num_rstcs: number of entries in rstcs array 572 * @rstcs: array of struct reset_control_bulk_data with reset controls set 573 * 574 * Deassert the reset lines for all provided reset controls, in reverse order. 575 * If a deassertion fails, already deasserted resets are asserted again. 576 * 577 * See also: reset_control_deassert() 578 */ 579 int reset_control_bulk_deassert(int num_rstcs, 580 struct reset_control_bulk_data *rstcs) 581 { 582 int ret, i; 583 584 for (i = num_rstcs - 1; i >= 0; i--) { 585 ret = reset_control_deassert(rstcs[i].rstc); 586 if (ret) 587 goto err; 588 } 589 590 return 0; 591 592 err: 593 while (i < num_rstcs) 594 reset_control_assert(rstcs[i++].rstc); 595 return ret; 596 } 597 EXPORT_SYMBOL_GPL(reset_control_bulk_deassert); 598 599 /** 600 * reset_control_status - returns a negative errno if not supported, a 601 * positive value if the reset line is asserted, or zero if the reset 602 * line is not asserted or if the desc is NULL (optional reset). 603 * @rstc: reset controller 604 */ 605 int reset_control_status(struct reset_control *rstc) 606 { 607 if (!rstc) 608 return 0; 609 610 if (WARN_ON(IS_ERR(rstc)) || reset_control_is_array(rstc)) 611 return -EINVAL; 612 613 if (rstc->rcdev->ops->status) 614 return rstc->rcdev->ops->status(rstc->rcdev, rstc->id); 615 616 return -ENOTSUPP; 617 } 618 EXPORT_SYMBOL_GPL(reset_control_status); 619 620 /** 621 * reset_control_acquire() - acquires a reset control for exclusive use 622 * @rstc: reset control 623 * 624 * This is used to explicitly acquire a reset control for exclusive use. Note 625 * that exclusive resets are requested as acquired by default. In order for a 626 * second consumer to be able to control the reset, the first consumer has to 627 * release it first. Typically the easiest way to achieve this is to call the 628 * reset_control_get_exclusive_released() to obtain an instance of the reset 629 * control. Such reset controls are not acquired by default. 630 * 631 * Consumers implementing shared access to an exclusive reset need to follow 632 * a specific protocol in order to work together. Before consumers can change 633 * a reset they must acquire exclusive access using reset_control_acquire(). 634 * After they are done operating the reset, they must release exclusive access 635 * with a call to reset_control_release(). Consumers are not granted exclusive 636 * access to the reset as long as another consumer hasn't released a reset. 637 * 638 * See also: reset_control_release() 639 */ 640 int reset_control_acquire(struct reset_control *rstc) 641 { 642 struct reset_control *rc; 643 644 if (!rstc) 645 return 0; 646 647 if (WARN_ON(IS_ERR(rstc))) 648 return -EINVAL; 649 650 if (reset_control_is_array(rstc)) 651 return reset_control_array_acquire(rstc_to_array(rstc)); 652 653 mutex_lock(&reset_list_mutex); 654 655 if (rstc->acquired) { 656 mutex_unlock(&reset_list_mutex); 657 return 0; 658 } 659 660 list_for_each_entry(rc, &rstc->rcdev->reset_control_head, list) { 661 if (rstc != rc && rstc->id == rc->id) { 662 if (rc->acquired) { 663 mutex_unlock(&reset_list_mutex); 664 return -EBUSY; 665 } 666 } 667 } 668 669 rstc->acquired = true; 670 671 mutex_unlock(&reset_list_mutex); 672 return 0; 673 } 674 EXPORT_SYMBOL_GPL(reset_control_acquire); 675 676 /** 677 * reset_control_bulk_acquire - acquires reset controls for exclusive use 678 * @num_rstcs: number of entries in rstcs array 679 * @rstcs: array of struct reset_control_bulk_data with reset controls set 680 * 681 * This is used to explicitly acquire reset controls requested with 682 * reset_control_bulk_get_exclusive_release() for temporary exclusive use. 683 * 684 * See also: reset_control_acquire(), reset_control_bulk_release() 685 */ 686 int reset_control_bulk_acquire(int num_rstcs, 687 struct reset_control_bulk_data *rstcs) 688 { 689 int ret, i; 690 691 for (i = 0; i < num_rstcs; i++) { 692 ret = reset_control_acquire(rstcs[i].rstc); 693 if (ret) 694 goto err; 695 } 696 697 return 0; 698 699 err: 700 while (i--) 701 reset_control_release(rstcs[i].rstc); 702 return ret; 703 } 704 EXPORT_SYMBOL_GPL(reset_control_bulk_acquire); 705 706 /** 707 * reset_control_release() - releases exclusive access to a reset control 708 * @rstc: reset control 709 * 710 * Releases exclusive access right to a reset control previously obtained by a 711 * call to reset_control_acquire(). Until a consumer calls this function, no 712 * other consumers will be granted exclusive access. 713 * 714 * See also: reset_control_acquire() 715 */ 716 void reset_control_release(struct reset_control *rstc) 717 { 718 if (!rstc || WARN_ON(IS_ERR(rstc))) 719 return; 720 721 if (reset_control_is_array(rstc)) 722 reset_control_array_release(rstc_to_array(rstc)); 723 else 724 rstc->acquired = false; 725 } 726 EXPORT_SYMBOL_GPL(reset_control_release); 727 728 /** 729 * reset_control_bulk_release() - releases exclusive access to reset controls 730 * @num_rstcs: number of entries in rstcs array 731 * @rstcs: array of struct reset_control_bulk_data with reset controls set 732 * 733 * Releases exclusive access right to reset controls previously obtained by a 734 * call to reset_control_bulk_acquire(). 735 * 736 * See also: reset_control_release(), reset_control_bulk_acquire() 737 */ 738 void reset_control_bulk_release(int num_rstcs, 739 struct reset_control_bulk_data *rstcs) 740 { 741 int i; 742 743 for (i = 0; i < num_rstcs; i++) 744 reset_control_release(rstcs[i].rstc); 745 } 746 EXPORT_SYMBOL_GPL(reset_control_bulk_release); 747 748 static struct reset_control * 749 __reset_control_get_internal(struct reset_controller_dev *rcdev, 750 unsigned int index, bool shared, bool acquired) 751 { 752 struct reset_control *rstc; 753 754 lockdep_assert_held(&reset_list_mutex); 755 756 list_for_each_entry(rstc, &rcdev->reset_control_head, list) { 757 if (rstc->id == index) { 758 /* 759 * Allow creating a secondary exclusive reset_control 760 * that is initially not acquired for an already 761 * controlled reset line. 762 */ 763 if (!rstc->shared && !shared && !acquired) 764 break; 765 766 if (WARN_ON(!rstc->shared || !shared)) 767 return ERR_PTR(-EBUSY); 768 769 kref_get(&rstc->refcnt); 770 return rstc; 771 } 772 } 773 774 rstc = kzalloc(sizeof(*rstc), GFP_KERNEL); 775 if (!rstc) 776 return ERR_PTR(-ENOMEM); 777 778 if (!try_module_get(rcdev->owner)) { 779 kfree(rstc); 780 return ERR_PTR(-ENODEV); 781 } 782 783 rstc->rcdev = rcdev; 784 list_add(&rstc->list, &rcdev->reset_control_head); 785 rstc->id = index; 786 kref_init(&rstc->refcnt); 787 rstc->acquired = acquired; 788 rstc->shared = shared; 789 790 return rstc; 791 } 792 793 static void __reset_control_release(struct kref *kref) 794 { 795 struct reset_control *rstc = container_of(kref, struct reset_control, 796 refcnt); 797 798 lockdep_assert_held(&reset_list_mutex); 799 800 module_put(rstc->rcdev->owner); 801 802 list_del(&rstc->list); 803 kfree(rstc); 804 } 805 806 static void __reset_control_put_internal(struct reset_control *rstc) 807 { 808 lockdep_assert_held(&reset_list_mutex); 809 810 kref_put(&rstc->refcnt, __reset_control_release); 811 } 812 813 struct reset_control * 814 __of_reset_control_get(struct device_node *node, const char *id, int index, 815 bool shared, bool optional, bool acquired) 816 { 817 struct reset_control *rstc; 818 struct reset_controller_dev *r, *rcdev; 819 struct of_phandle_args args; 820 int rstc_id; 821 int ret; 822 823 if (!node) 824 return ERR_PTR(-EINVAL); 825 826 if (id) { 827 index = of_property_match_string(node, 828 "reset-names", id); 829 if (index == -EILSEQ) 830 return ERR_PTR(index); 831 if (index < 0) 832 return optional ? NULL : ERR_PTR(-ENOENT); 833 } 834 835 ret = of_parse_phandle_with_args(node, "resets", "#reset-cells", 836 index, &args); 837 if (ret == -EINVAL) 838 return ERR_PTR(ret); 839 if (ret) 840 return optional ? NULL : ERR_PTR(ret); 841 842 mutex_lock(&reset_list_mutex); 843 rcdev = NULL; 844 list_for_each_entry(r, &reset_controller_list, list) { 845 if (args.np == r->of_node) { 846 rcdev = r; 847 break; 848 } 849 } 850 851 if (!rcdev) { 852 rstc = ERR_PTR(-EPROBE_DEFER); 853 goto out; 854 } 855 856 if (WARN_ON(args.args_count != rcdev->of_reset_n_cells)) { 857 rstc = ERR_PTR(-EINVAL); 858 goto out; 859 } 860 861 rstc_id = rcdev->of_xlate(rcdev, &args); 862 if (rstc_id < 0) { 863 rstc = ERR_PTR(rstc_id); 864 goto out; 865 } 866 867 /* reset_list_mutex also protects the rcdev's reset_control list */ 868 rstc = __reset_control_get_internal(rcdev, rstc_id, shared, acquired); 869 870 out: 871 mutex_unlock(&reset_list_mutex); 872 of_node_put(args.np); 873 874 return rstc; 875 } 876 EXPORT_SYMBOL_GPL(__of_reset_control_get); 877 878 static struct reset_controller_dev * 879 __reset_controller_by_name(const char *name) 880 { 881 struct reset_controller_dev *rcdev; 882 883 lockdep_assert_held(&reset_list_mutex); 884 885 list_for_each_entry(rcdev, &reset_controller_list, list) { 886 if (!rcdev->dev) 887 continue; 888 889 if (!strcmp(name, dev_name(rcdev->dev))) 890 return rcdev; 891 } 892 893 return NULL; 894 } 895 896 static struct reset_control * 897 __reset_control_get_from_lookup(struct device *dev, const char *con_id, 898 bool shared, bool optional, bool acquired) 899 { 900 const struct reset_control_lookup *lookup; 901 struct reset_controller_dev *rcdev; 902 const char *dev_id = dev_name(dev); 903 struct reset_control *rstc = NULL; 904 905 mutex_lock(&reset_lookup_mutex); 906 907 list_for_each_entry(lookup, &reset_lookup_list, list) { 908 if (strcmp(lookup->dev_id, dev_id)) 909 continue; 910 911 if ((!con_id && !lookup->con_id) || 912 ((con_id && lookup->con_id) && 913 !strcmp(con_id, lookup->con_id))) { 914 mutex_lock(&reset_list_mutex); 915 rcdev = __reset_controller_by_name(lookup->provider); 916 if (!rcdev) { 917 mutex_unlock(&reset_list_mutex); 918 mutex_unlock(&reset_lookup_mutex); 919 /* Reset provider may not be ready yet. */ 920 return ERR_PTR(-EPROBE_DEFER); 921 } 922 923 rstc = __reset_control_get_internal(rcdev, 924 lookup->index, 925 shared, acquired); 926 mutex_unlock(&reset_list_mutex); 927 break; 928 } 929 } 930 931 mutex_unlock(&reset_lookup_mutex); 932 933 if (!rstc) 934 return optional ? NULL : ERR_PTR(-ENOENT); 935 936 return rstc; 937 } 938 939 struct reset_control *__reset_control_get(struct device *dev, const char *id, 940 int index, bool shared, bool optional, 941 bool acquired) 942 { 943 if (WARN_ON(shared && acquired)) 944 return ERR_PTR(-EINVAL); 945 946 if (dev->of_node) 947 return __of_reset_control_get(dev->of_node, id, index, shared, 948 optional, acquired); 949 950 return __reset_control_get_from_lookup(dev, id, shared, optional, 951 acquired); 952 } 953 EXPORT_SYMBOL_GPL(__reset_control_get); 954 955 int __reset_control_bulk_get(struct device *dev, int num_rstcs, 956 struct reset_control_bulk_data *rstcs, 957 bool shared, bool optional, bool acquired) 958 { 959 int ret, i; 960 961 for (i = 0; i < num_rstcs; i++) { 962 rstcs[i].rstc = __reset_control_get(dev, rstcs[i].id, 0, 963 shared, optional, acquired); 964 if (IS_ERR(rstcs[i].rstc)) { 965 ret = PTR_ERR(rstcs[i].rstc); 966 goto err; 967 } 968 } 969 970 return 0; 971 972 err: 973 mutex_lock(&reset_list_mutex); 974 while (i--) 975 __reset_control_put_internal(rstcs[i].rstc); 976 mutex_unlock(&reset_list_mutex); 977 return ret; 978 } 979 EXPORT_SYMBOL_GPL(__reset_control_bulk_get); 980 981 static void reset_control_array_put(struct reset_control_array *resets) 982 { 983 int i; 984 985 mutex_lock(&reset_list_mutex); 986 for (i = 0; i < resets->num_rstcs; i++) 987 __reset_control_put_internal(resets->rstc[i]); 988 mutex_unlock(&reset_list_mutex); 989 kfree(resets); 990 } 991 992 /** 993 * reset_control_put - free the reset controller 994 * @rstc: reset controller 995 */ 996 void reset_control_put(struct reset_control *rstc) 997 { 998 if (IS_ERR_OR_NULL(rstc)) 999 return; 1000 1001 if (reset_control_is_array(rstc)) { 1002 reset_control_array_put(rstc_to_array(rstc)); 1003 return; 1004 } 1005 1006 mutex_lock(&reset_list_mutex); 1007 __reset_control_put_internal(rstc); 1008 mutex_unlock(&reset_list_mutex); 1009 } 1010 EXPORT_SYMBOL_GPL(reset_control_put); 1011 1012 /** 1013 * reset_control_bulk_put - free the reset controllers 1014 * @num_rstcs: number of entries in rstcs array 1015 * @rstcs: array of struct reset_control_bulk_data with reset controls set 1016 */ 1017 void reset_control_bulk_put(int num_rstcs, struct reset_control_bulk_data *rstcs) 1018 { 1019 mutex_lock(&reset_list_mutex); 1020 while (num_rstcs--) { 1021 if (IS_ERR_OR_NULL(rstcs[num_rstcs].rstc)) 1022 continue; 1023 __reset_control_put_internal(rstcs[num_rstcs].rstc); 1024 } 1025 mutex_unlock(&reset_list_mutex); 1026 } 1027 EXPORT_SYMBOL_GPL(reset_control_bulk_put); 1028 1029 static void devm_reset_control_release(struct device *dev, void *res) 1030 { 1031 reset_control_put(*(struct reset_control **)res); 1032 } 1033 1034 struct reset_control * 1035 __devm_reset_control_get(struct device *dev, const char *id, int index, 1036 bool shared, bool optional, bool acquired) 1037 { 1038 struct reset_control **ptr, *rstc; 1039 1040 ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr), 1041 GFP_KERNEL); 1042 if (!ptr) 1043 return ERR_PTR(-ENOMEM); 1044 1045 rstc = __reset_control_get(dev, id, index, shared, optional, acquired); 1046 if (IS_ERR_OR_NULL(rstc)) { 1047 devres_free(ptr); 1048 return rstc; 1049 } 1050 1051 *ptr = rstc; 1052 devres_add(dev, ptr); 1053 1054 return rstc; 1055 } 1056 EXPORT_SYMBOL_GPL(__devm_reset_control_get); 1057 1058 struct reset_control_bulk_devres { 1059 int num_rstcs; 1060 struct reset_control_bulk_data *rstcs; 1061 }; 1062 1063 static void devm_reset_control_bulk_release(struct device *dev, void *res) 1064 { 1065 struct reset_control_bulk_devres *devres = res; 1066 1067 reset_control_bulk_put(devres->num_rstcs, devres->rstcs); 1068 } 1069 1070 int __devm_reset_control_bulk_get(struct device *dev, int num_rstcs, 1071 struct reset_control_bulk_data *rstcs, 1072 bool shared, bool optional, bool acquired) 1073 { 1074 struct reset_control_bulk_devres *ptr; 1075 int ret; 1076 1077 ptr = devres_alloc(devm_reset_control_bulk_release, sizeof(*ptr), 1078 GFP_KERNEL); 1079 if (!ptr) 1080 return -ENOMEM; 1081 1082 ret = __reset_control_bulk_get(dev, num_rstcs, rstcs, shared, optional, acquired); 1083 if (ret < 0) { 1084 devres_free(ptr); 1085 return ret; 1086 } 1087 1088 ptr->num_rstcs = num_rstcs; 1089 ptr->rstcs = rstcs; 1090 devres_add(dev, ptr); 1091 1092 return 0; 1093 } 1094 EXPORT_SYMBOL_GPL(__devm_reset_control_bulk_get); 1095 1096 /** 1097 * __device_reset - find reset controller associated with the device 1098 * and perform reset 1099 * @dev: device to be reset by the controller 1100 * @optional: whether it is optional to reset the device 1101 * 1102 * Convenience wrapper for __reset_control_get() and reset_control_reset(). 1103 * This is useful for the common case of devices with single, dedicated reset 1104 * lines. _RST firmware method will be called for devices with ACPI. 1105 */ 1106 int __device_reset(struct device *dev, bool optional) 1107 { 1108 struct reset_control *rstc; 1109 int ret; 1110 1111 #ifdef CONFIG_ACPI 1112 acpi_handle handle = ACPI_HANDLE(dev); 1113 1114 if (handle) { 1115 if (!acpi_has_method(handle, "_RST")) 1116 return optional ? 0 : -ENOENT; 1117 if (ACPI_FAILURE(acpi_evaluate_object(handle, "_RST", NULL, 1118 NULL))) 1119 return -EIO; 1120 } 1121 #endif 1122 1123 rstc = __reset_control_get(dev, NULL, 0, 0, optional, true); 1124 if (IS_ERR(rstc)) 1125 return PTR_ERR(rstc); 1126 1127 ret = reset_control_reset(rstc); 1128 1129 reset_control_put(rstc); 1130 1131 return ret; 1132 } 1133 EXPORT_SYMBOL_GPL(__device_reset); 1134 1135 /* 1136 * APIs to manage an array of reset controls. 1137 */ 1138 1139 /** 1140 * of_reset_control_get_count - Count number of resets available with a device 1141 * 1142 * @node: device node that contains 'resets'. 1143 * 1144 * Returns positive reset count on success, or error number on failure and 1145 * on count being zero. 1146 */ 1147 static int of_reset_control_get_count(struct device_node *node) 1148 { 1149 int count; 1150 1151 if (!node) 1152 return -EINVAL; 1153 1154 count = of_count_phandle_with_args(node, "resets", "#reset-cells"); 1155 if (count == 0) 1156 count = -ENOENT; 1157 1158 return count; 1159 } 1160 1161 /** 1162 * of_reset_control_array_get - Get a list of reset controls using 1163 * device node. 1164 * 1165 * @np: device node for the device that requests the reset controls array 1166 * @shared: whether reset controls are shared or not 1167 * @optional: whether it is optional to get the reset controls 1168 * @acquired: only one reset control may be acquired for a given controller 1169 * and ID 1170 * 1171 * Returns pointer to allocated reset_control on success or error on failure 1172 */ 1173 struct reset_control * 1174 of_reset_control_array_get(struct device_node *np, bool shared, bool optional, 1175 bool acquired) 1176 { 1177 struct reset_control_array *resets; 1178 struct reset_control *rstc; 1179 int num, i; 1180 1181 num = of_reset_control_get_count(np); 1182 if (num < 0) 1183 return optional ? NULL : ERR_PTR(num); 1184 1185 resets = kzalloc(struct_size(resets, rstc, num), GFP_KERNEL); 1186 if (!resets) 1187 return ERR_PTR(-ENOMEM); 1188 1189 for (i = 0; i < num; i++) { 1190 rstc = __of_reset_control_get(np, NULL, i, shared, optional, 1191 acquired); 1192 if (IS_ERR(rstc)) 1193 goto err_rst; 1194 resets->rstc[i] = rstc; 1195 } 1196 resets->num_rstcs = num; 1197 resets->base.array = true; 1198 1199 return &resets->base; 1200 1201 err_rst: 1202 mutex_lock(&reset_list_mutex); 1203 while (--i >= 0) 1204 __reset_control_put_internal(resets->rstc[i]); 1205 mutex_unlock(&reset_list_mutex); 1206 1207 kfree(resets); 1208 1209 return rstc; 1210 } 1211 EXPORT_SYMBOL_GPL(of_reset_control_array_get); 1212 1213 /** 1214 * devm_reset_control_array_get - Resource managed reset control array get 1215 * 1216 * @dev: device that requests the list of reset controls 1217 * @shared: whether reset controls are shared or not 1218 * @optional: whether it is optional to get the reset controls 1219 * 1220 * The reset control array APIs are intended for a list of resets 1221 * that just have to be asserted or deasserted, without any 1222 * requirements on the order. 1223 * 1224 * Returns pointer to allocated reset_control on success or error on failure 1225 */ 1226 struct reset_control * 1227 devm_reset_control_array_get(struct device *dev, bool shared, bool optional) 1228 { 1229 struct reset_control **ptr, *rstc; 1230 1231 ptr = devres_alloc(devm_reset_control_release, sizeof(*ptr), 1232 GFP_KERNEL); 1233 if (!ptr) 1234 return ERR_PTR(-ENOMEM); 1235 1236 rstc = of_reset_control_array_get(dev->of_node, shared, optional, true); 1237 if (IS_ERR_OR_NULL(rstc)) { 1238 devres_free(ptr); 1239 return rstc; 1240 } 1241 1242 *ptr = rstc; 1243 devres_add(dev, ptr); 1244 1245 return rstc; 1246 } 1247 EXPORT_SYMBOL_GPL(devm_reset_control_array_get); 1248 1249 static int reset_control_get_count_from_lookup(struct device *dev) 1250 { 1251 const struct reset_control_lookup *lookup; 1252 const char *dev_id; 1253 int count = 0; 1254 1255 if (!dev) 1256 return -EINVAL; 1257 1258 dev_id = dev_name(dev); 1259 mutex_lock(&reset_lookup_mutex); 1260 1261 list_for_each_entry(lookup, &reset_lookup_list, list) { 1262 if (!strcmp(lookup->dev_id, dev_id)) 1263 count++; 1264 } 1265 1266 mutex_unlock(&reset_lookup_mutex); 1267 1268 if (count == 0) 1269 count = -ENOENT; 1270 1271 return count; 1272 } 1273 1274 /** 1275 * reset_control_get_count - Count number of resets available with a device 1276 * 1277 * @dev: device for which to return the number of resets 1278 * 1279 * Returns positive reset count on success, or error number on failure and 1280 * on count being zero. 1281 */ 1282 int reset_control_get_count(struct device *dev) 1283 { 1284 if (dev->of_node) 1285 return of_reset_control_get_count(dev->of_node); 1286 1287 return reset_control_get_count_from_lookup(dev); 1288 } 1289 EXPORT_SYMBOL_GPL(reset_control_get_count); 1290