1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Procedures for creating, accessing and interpreting the device tree. 4 * 5 * Paul Mackerras August 1996. 6 * Copyright (C) 1996-2005 Paul Mackerras. 7 * 8 * Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner. 9 * {engebret|bergner}@us.ibm.com 10 * 11 * Adapted for sparc and sparc64 by David S. Miller davem@davemloft.net 12 * 13 * Reconsolidated from arch/x/kernel/prom.c by Stephen Rothwell and 14 * Grant Likely. 15 */ 16 17 #define pr_fmt(fmt) "OF: " fmt 18 19 #include <linux/cleanup.h> 20 #include <linux/console.h> 21 #include <linux/ctype.h> 22 #include <linux/cpu.h> 23 #include <linux/module.h> 24 #include <linux/of.h> 25 #include <linux/of_device.h> 26 #include <linux/of_graph.h> 27 #include <linux/spinlock.h> 28 #include <linux/slab.h> 29 #include <linux/string.h> 30 #include <linux/proc_fs.h> 31 32 #include "of_private.h" 33 34 LIST_HEAD(aliases_lookup); 35 36 struct device_node *of_root; 37 EXPORT_SYMBOL(of_root); 38 struct device_node *of_chosen; 39 EXPORT_SYMBOL(of_chosen); 40 struct device_node *of_aliases; 41 struct device_node *of_stdout; 42 static const char *of_stdout_options; 43 44 struct kset *of_kset; 45 46 /* 47 * Used to protect the of_aliases, to hold off addition of nodes to sysfs. 48 * This mutex must be held whenever modifications are being made to the 49 * device tree. The of_{attach,detach}_node() and 50 * of_{add,remove,update}_property() helpers make sure this happens. 51 */ 52 DEFINE_MUTEX(of_mutex); 53 54 /* use when traversing tree through the child, sibling, 55 * or parent members of struct device_node. 56 */ 57 DEFINE_RAW_SPINLOCK(devtree_lock); 58 59 bool of_node_name_eq(const struct device_node *np, const char *name) 60 { 61 const char *node_name; 62 size_t len; 63 64 if (!np) 65 return false; 66 67 node_name = kbasename(np->full_name); 68 len = strchrnul(node_name, '@') - node_name; 69 70 return (strlen(name) == len) && (strncmp(node_name, name, len) == 0); 71 } 72 EXPORT_SYMBOL(of_node_name_eq); 73 74 bool of_node_name_prefix(const struct device_node *np, const char *prefix) 75 { 76 if (!np) 77 return false; 78 79 return strncmp(kbasename(np->full_name), prefix, strlen(prefix)) == 0; 80 } 81 EXPORT_SYMBOL(of_node_name_prefix); 82 83 static bool __of_node_is_type(const struct device_node *np, const char *type) 84 { 85 const char *match = __of_get_property(np, "device_type", NULL); 86 87 return np && match && type && !strcmp(match, type); 88 } 89 90 #define EXCLUDED_DEFAULT_CELLS_PLATFORMS ( \ 91 IS_ENABLED(CONFIG_SPARC) || \ 92 of_find_compatible_node(NULL, NULL, "coreboot") \ 93 ) 94 95 int of_bus_n_addr_cells(struct device_node *np) 96 { 97 u32 cells; 98 99 for (; np; np = np->parent) { 100 if (!of_property_read_u32(np, "#address-cells", &cells)) 101 return cells; 102 /* 103 * Default root value and walking parent nodes for "#address-cells" 104 * is deprecated. Any platforms which hit this warning should 105 * be added to the excluded list. 106 */ 107 WARN_ONCE(!EXCLUDED_DEFAULT_CELLS_PLATFORMS, 108 "Missing '#address-cells' in %pOF\n", np); 109 } 110 return OF_ROOT_NODE_ADDR_CELLS_DEFAULT; 111 } 112 113 int of_n_addr_cells(struct device_node *np) 114 { 115 if (np->parent) 116 np = np->parent; 117 118 return of_bus_n_addr_cells(np); 119 } 120 EXPORT_SYMBOL(of_n_addr_cells); 121 122 int of_bus_n_size_cells(struct device_node *np) 123 { 124 u32 cells; 125 126 for (; np; np = np->parent) { 127 if (!of_property_read_u32(np, "#size-cells", &cells)) 128 return cells; 129 /* 130 * Default root value and walking parent nodes for "#size-cells" 131 * is deprecated. Any platforms which hit this warning should 132 * be added to the excluded list. 133 */ 134 WARN_ONCE(!EXCLUDED_DEFAULT_CELLS_PLATFORMS, 135 "Missing '#size-cells' in %pOF\n", np); 136 } 137 return OF_ROOT_NODE_SIZE_CELLS_DEFAULT; 138 } 139 140 int of_n_size_cells(struct device_node *np) 141 { 142 if (np->parent) 143 np = np->parent; 144 145 return of_bus_n_size_cells(np); 146 } 147 EXPORT_SYMBOL(of_n_size_cells); 148 149 #ifdef CONFIG_NUMA 150 int __weak of_node_to_nid(struct device_node *np) 151 { 152 return NUMA_NO_NODE; 153 } 154 #endif 155 156 #define OF_PHANDLE_CACHE_BITS 7 157 #define OF_PHANDLE_CACHE_SZ BIT(OF_PHANDLE_CACHE_BITS) 158 159 static struct device_node *phandle_cache[OF_PHANDLE_CACHE_SZ]; 160 161 static u32 of_phandle_cache_hash(phandle handle) 162 { 163 return hash_32(handle, OF_PHANDLE_CACHE_BITS); 164 } 165 166 /* 167 * Caller must hold devtree_lock. 168 */ 169 void __of_phandle_cache_inv_entry(phandle handle) 170 { 171 u32 handle_hash; 172 struct device_node *np; 173 174 if (!handle) 175 return; 176 177 handle_hash = of_phandle_cache_hash(handle); 178 179 np = phandle_cache[handle_hash]; 180 if (np && handle == np->phandle) 181 phandle_cache[handle_hash] = NULL; 182 } 183 184 void __init of_core_init(void) 185 { 186 struct device_node *np; 187 188 of_platform_register_reconfig_notifier(); 189 190 /* Create the kset, and register existing nodes */ 191 mutex_lock(&of_mutex); 192 of_kset = kset_create_and_add("devicetree", NULL, firmware_kobj); 193 if (!of_kset) { 194 mutex_unlock(&of_mutex); 195 pr_err("failed to register existing nodes\n"); 196 return; 197 } 198 for_each_of_allnodes(np) { 199 __of_attach_node_sysfs(np); 200 if (np->phandle && !phandle_cache[of_phandle_cache_hash(np->phandle)]) 201 phandle_cache[of_phandle_cache_hash(np->phandle)] = np; 202 } 203 mutex_unlock(&of_mutex); 204 205 /* Symlink in /proc as required by userspace ABI */ 206 if (of_root) 207 proc_symlink("device-tree", NULL, "/sys/firmware/devicetree/base"); 208 } 209 210 static struct property *__of_find_property(const struct device_node *np, 211 const char *name, int *lenp) 212 { 213 struct property *pp; 214 215 if (!np) 216 return NULL; 217 218 for (pp = np->properties; pp; pp = pp->next) { 219 if (of_prop_cmp(pp->name, name) == 0) { 220 if (lenp) 221 *lenp = pp->length; 222 break; 223 } 224 } 225 226 return pp; 227 } 228 229 struct property *of_find_property(const struct device_node *np, 230 const char *name, 231 int *lenp) 232 { 233 struct property *pp; 234 unsigned long flags; 235 236 raw_spin_lock_irqsave(&devtree_lock, flags); 237 pp = __of_find_property(np, name, lenp); 238 raw_spin_unlock_irqrestore(&devtree_lock, flags); 239 240 return pp; 241 } 242 EXPORT_SYMBOL(of_find_property); 243 244 struct device_node *__of_find_all_nodes(struct device_node *prev) 245 { 246 struct device_node *np; 247 if (!prev) { 248 np = of_root; 249 } else if (prev->child) { 250 np = prev->child; 251 } else { 252 /* Walk back up looking for a sibling, or the end of the structure */ 253 np = prev; 254 while (np->parent && !np->sibling) 255 np = np->parent; 256 np = np->sibling; /* Might be null at the end of the tree */ 257 } 258 return np; 259 } 260 261 /** 262 * of_find_all_nodes - Get next node in global list 263 * @prev: Previous node or NULL to start iteration 264 * of_node_put() will be called on it 265 * 266 * Return: A node pointer with refcount incremented, use 267 * of_node_put() on it when done. 268 */ 269 struct device_node *of_find_all_nodes(struct device_node *prev) 270 { 271 struct device_node *np; 272 unsigned long flags; 273 274 raw_spin_lock_irqsave(&devtree_lock, flags); 275 np = __of_find_all_nodes(prev); 276 of_node_get(np); 277 of_node_put(prev); 278 raw_spin_unlock_irqrestore(&devtree_lock, flags); 279 return np; 280 } 281 EXPORT_SYMBOL(of_find_all_nodes); 282 283 /* 284 * Find a property with a given name for a given node 285 * and return the value. 286 */ 287 const void *__of_get_property(const struct device_node *np, 288 const char *name, int *lenp) 289 { 290 const struct property *pp = __of_find_property(np, name, lenp); 291 292 return pp ? pp->value : NULL; 293 } 294 295 /* 296 * Find a property with a given name for a given node 297 * and return the value. 298 */ 299 const void *of_get_property(const struct device_node *np, const char *name, 300 int *lenp) 301 { 302 const struct property *pp = of_find_property(np, name, lenp); 303 304 return pp ? pp->value : NULL; 305 } 306 EXPORT_SYMBOL(of_get_property); 307 308 /** 309 * __of_device_is_compatible() - Check if the node matches given constraints 310 * @device: pointer to node 311 * @compat: required compatible string, NULL or "" for any match 312 * @type: required device_type value, NULL or "" for any match 313 * @name: required node name, NULL or "" for any match 314 * 315 * Checks if the given @compat, @type and @name strings match the 316 * properties of the given @device. A constraints can be skipped by 317 * passing NULL or an empty string as the constraint. 318 * 319 * Returns 0 for no match, and a positive integer on match. The return 320 * value is a relative score with larger values indicating better 321 * matches. The score is weighted for the most specific compatible value 322 * to get the highest score. Matching type is next, followed by matching 323 * name. Practically speaking, this results in the following priority 324 * order for matches: 325 * 326 * 1. specific compatible && type && name 327 * 2. specific compatible && type 328 * 3. specific compatible && name 329 * 4. specific compatible 330 * 5. general compatible && type && name 331 * 6. general compatible && type 332 * 7. general compatible && name 333 * 8. general compatible 334 * 9. type && name 335 * 10. type 336 * 11. name 337 */ 338 static int __of_device_is_compatible(const struct device_node *device, 339 const char *compat, const char *type, const char *name) 340 { 341 const struct property *prop; 342 const char *cp; 343 int index = 0, score = 0; 344 345 /* Compatible match has highest priority */ 346 if (compat && compat[0]) { 347 prop = __of_find_property(device, "compatible", NULL); 348 for (cp = of_prop_next_string(prop, NULL); cp; 349 cp = of_prop_next_string(prop, cp), index++) { 350 if (of_compat_cmp(cp, compat, strlen(compat)) == 0) { 351 score = INT_MAX/2 - (index << 2); 352 break; 353 } 354 } 355 if (!score) 356 return 0; 357 } 358 359 /* Matching type is better than matching name */ 360 if (type && type[0]) { 361 if (!__of_node_is_type(device, type)) 362 return 0; 363 score += 2; 364 } 365 366 /* Matching name is a bit better than not */ 367 if (name && name[0]) { 368 if (!of_node_name_eq(device, name)) 369 return 0; 370 score++; 371 } 372 373 return score; 374 } 375 376 /** Checks if the given "compat" string matches one of the strings in 377 * the device's "compatible" property 378 */ 379 int of_device_is_compatible(const struct device_node *device, 380 const char *compat) 381 { 382 unsigned long flags; 383 int res; 384 385 raw_spin_lock_irqsave(&devtree_lock, flags); 386 res = __of_device_is_compatible(device, compat, NULL, NULL); 387 raw_spin_unlock_irqrestore(&devtree_lock, flags); 388 return res; 389 } 390 EXPORT_SYMBOL(of_device_is_compatible); 391 392 /** Checks if the device is compatible with any of the entries in 393 * a NULL terminated array of strings. Returns the best match 394 * score or 0. 395 */ 396 int of_device_compatible_match(const struct device_node *device, 397 const char *const *compat) 398 { 399 unsigned int tmp, score = 0; 400 401 if (!compat) 402 return 0; 403 404 while (*compat) { 405 tmp = of_device_is_compatible(device, *compat); 406 if (tmp > score) 407 score = tmp; 408 compat++; 409 } 410 411 return score; 412 } 413 EXPORT_SYMBOL_GPL(of_device_compatible_match); 414 415 /** 416 * of_machine_compatible_match - Test root of device tree against a compatible array 417 * @compats: NULL terminated array of compatible strings to look for in root node's compatible property. 418 * 419 * Returns true if the root node has any of the given compatible values in its 420 * compatible property. 421 */ 422 bool of_machine_compatible_match(const char *const *compats) 423 { 424 struct device_node *root; 425 int rc = 0; 426 427 root = of_find_node_by_path("/"); 428 if (root) { 429 rc = of_device_compatible_match(root, compats); 430 of_node_put(root); 431 } 432 433 return rc != 0; 434 } 435 EXPORT_SYMBOL(of_machine_compatible_match); 436 437 /** 438 * of_machine_read_compatible - Get the compatible string of this machine 439 * @compatible: address at which the address of the compatible string will be 440 * stored 441 * @index: index of the compatible entry in the list 442 * 443 * Returns: 444 * 0 on success, negative error number on failure. 445 */ 446 int of_machine_read_compatible(const char **compatible, unsigned int index) 447 { 448 return of_property_read_string_index(of_root, "compatible", index, compatible); 449 } 450 EXPORT_SYMBOL_GPL(of_machine_read_compatible); 451 452 /** 453 * of_machine_read_model - Get the model string of this machine 454 * @model: address at which the address of the model string will be stored 455 * 456 * Returns: 457 * 0 on success, negative error number on failure. 458 */ 459 int of_machine_read_model(const char **model) 460 { 461 return of_property_read_string(of_root, "model", model); 462 } 463 EXPORT_SYMBOL_GPL(of_machine_read_model); 464 465 /** 466 * of_machine_device_match - Test root of device tree against a of_device_id array 467 * @matches: NULL terminated array of of_device_id match structures to search in 468 * 469 * Returns true if the root node has any of the given compatible values in its 470 * compatible property. 471 */ 472 bool of_machine_device_match(const struct of_device_id *matches) 473 { 474 struct device_node *root; 475 const struct of_device_id *match = NULL; 476 477 root = of_find_node_by_path("/"); 478 if (root) { 479 match = of_match_node(matches, root); 480 of_node_put(root); 481 } 482 483 return match != NULL; 484 } 485 EXPORT_SYMBOL(of_machine_device_match); 486 487 /** 488 * of_machine_get_match_data - Tell if root of device tree has a matching of_match structure 489 * @matches: NULL terminated array of of_device_id match structures to search in 490 * 491 * Returns data associated with matched entry or NULL 492 */ 493 const void *of_machine_get_match_data(const struct of_device_id *matches) 494 { 495 const struct of_device_id *match; 496 struct device_node *root; 497 498 root = of_find_node_by_path("/"); 499 if (!root) 500 return NULL; 501 502 match = of_match_node(matches, root); 503 of_node_put(root); 504 505 if (!match) 506 return NULL; 507 508 return match->data; 509 } 510 EXPORT_SYMBOL(of_machine_get_match_data); 511 512 static bool __of_device_is_status(const struct device_node *device, 513 const char * const*strings) 514 { 515 const char *status; 516 int statlen; 517 518 if (!device) 519 return false; 520 521 status = __of_get_property(device, "status", &statlen); 522 if (status == NULL) 523 return false; 524 525 if (statlen > 0) { 526 while (*strings) { 527 unsigned int len = strlen(*strings); 528 529 if ((*strings)[len - 1] == '-') { 530 if (!strncmp(status, *strings, len)) 531 return true; 532 } else { 533 if (!strcmp(status, *strings)) 534 return true; 535 } 536 strings++; 537 } 538 } 539 540 return false; 541 } 542 543 /** 544 * __of_device_is_available - check if a device is available for use 545 * 546 * @device: Node to check for availability, with locks already held 547 * 548 * Return: True if the status property is absent or set to "okay" or "ok", 549 * false otherwise 550 */ 551 static bool __of_device_is_available(const struct device_node *device) 552 { 553 static const char * const ok[] = {"okay", "ok", NULL}; 554 555 if (!device) 556 return false; 557 558 return !__of_get_property(device, "status", NULL) || 559 __of_device_is_status(device, ok); 560 } 561 562 /** 563 * __of_device_is_reserved - check if a device is reserved 564 * 565 * @device: Node to check for availability, with locks already held 566 * 567 * Return: True if the status property is set to "reserved", false otherwise 568 */ 569 static bool __of_device_is_reserved(const struct device_node *device) 570 { 571 static const char * const reserved[] = {"reserved", NULL}; 572 573 return __of_device_is_status(device, reserved); 574 } 575 576 /** 577 * of_device_is_available - check if a device is available for use 578 * 579 * @device: Node to check for availability 580 * 581 * Return: True if the status property is absent or set to "okay" or "ok", 582 * false otherwise 583 */ 584 bool of_device_is_available(const struct device_node *device) 585 { 586 unsigned long flags; 587 bool res; 588 589 raw_spin_lock_irqsave(&devtree_lock, flags); 590 res = __of_device_is_available(device); 591 raw_spin_unlock_irqrestore(&devtree_lock, flags); 592 return res; 593 594 } 595 EXPORT_SYMBOL(of_device_is_available); 596 597 /** 598 * __of_device_is_fail - check if a device has status "fail" or "fail-..." 599 * 600 * @device: Node to check status for, with locks already held 601 * 602 * Return: True if the status property is set to "fail" or "fail-..." (for any 603 * error code suffix), false otherwise 604 */ 605 static bool __of_device_is_fail(const struct device_node *device) 606 { 607 static const char * const fail[] = {"fail", "fail-", NULL}; 608 609 return __of_device_is_status(device, fail); 610 } 611 612 /** 613 * of_device_is_big_endian - check if a device has BE registers 614 * 615 * @device: Node to check for endianness 616 * 617 * Return: True if the device has a "big-endian" property, or if the kernel 618 * was compiled for BE *and* the device has a "native-endian" property. 619 * Returns false otherwise. 620 * 621 * Callers would nominally use ioread32be/iowrite32be if 622 * of_device_is_big_endian() == true, or readl/writel otherwise. 623 */ 624 bool of_device_is_big_endian(const struct device_node *device) 625 { 626 if (of_property_read_bool(device, "big-endian")) 627 return true; 628 if (IS_ENABLED(CONFIG_CPU_BIG_ENDIAN) && 629 of_property_read_bool(device, "native-endian")) 630 return true; 631 return false; 632 } 633 EXPORT_SYMBOL(of_device_is_big_endian); 634 635 /** 636 * of_get_parent - Get a node's parent if any 637 * @node: Node to get parent 638 * 639 * Return: A node pointer with refcount incremented, use 640 * of_node_put() on it when done. 641 */ 642 struct device_node *of_get_parent(const struct device_node *node) 643 { 644 struct device_node *np; 645 unsigned long flags; 646 647 if (!node) 648 return NULL; 649 650 raw_spin_lock_irqsave(&devtree_lock, flags); 651 np = of_node_get(node->parent); 652 raw_spin_unlock_irqrestore(&devtree_lock, flags); 653 return np; 654 } 655 EXPORT_SYMBOL(of_get_parent); 656 657 /** 658 * of_get_next_parent - Iterate to a node's parent 659 * @node: Node to get parent of 660 * 661 * This is like of_get_parent() except that it drops the 662 * refcount on the passed node, making it suitable for iterating 663 * through a node's parents. 664 * 665 * Return: A node pointer with refcount incremented, use 666 * of_node_put() on it when done. 667 */ 668 struct device_node *of_get_next_parent(struct device_node *node) 669 { 670 struct device_node *parent; 671 unsigned long flags; 672 673 if (!node) 674 return NULL; 675 676 raw_spin_lock_irqsave(&devtree_lock, flags); 677 parent = of_node_get(node->parent); 678 of_node_put(node); 679 raw_spin_unlock_irqrestore(&devtree_lock, flags); 680 return parent; 681 } 682 EXPORT_SYMBOL(of_get_next_parent); 683 684 static struct device_node *__of_get_next_child(const struct device_node *node, 685 struct device_node *prev) 686 { 687 struct device_node *next; 688 689 if (!node) 690 return NULL; 691 692 next = prev ? prev->sibling : node->child; 693 of_node_get(next); 694 of_node_put(prev); 695 return next; 696 } 697 #define __for_each_child_of_node(parent, child) \ 698 for (child = __of_get_next_child(parent, NULL); child != NULL; \ 699 child = __of_get_next_child(parent, child)) 700 701 /** 702 * of_get_next_child - Iterate a node childs 703 * @node: parent node 704 * @prev: previous child of the parent node, or NULL to get first 705 * 706 * Return: A node pointer with refcount incremented, use of_node_put() on 707 * it when done. Returns NULL when prev is the last child. Decrements the 708 * refcount of prev. 709 */ 710 struct device_node *of_get_next_child(const struct device_node *node, 711 struct device_node *prev) 712 { 713 struct device_node *next; 714 unsigned long flags; 715 716 raw_spin_lock_irqsave(&devtree_lock, flags); 717 next = __of_get_next_child(node, prev); 718 raw_spin_unlock_irqrestore(&devtree_lock, flags); 719 return next; 720 } 721 EXPORT_SYMBOL(of_get_next_child); 722 723 /** 724 * of_get_next_child_with_prefix - Find the next child node with prefix 725 * @node: parent node 726 * @prev: previous child of the parent node, or NULL to get first 727 * @prefix: prefix that the node name should have 728 * 729 * This function is like of_get_next_child(), except that it automatically 730 * skips any nodes whose name doesn't have the given prefix. 731 * 732 * Return: A node pointer with refcount incremented, use 733 * of_node_put() on it when done. 734 */ 735 struct device_node *of_get_next_child_with_prefix(const struct device_node *node, 736 struct device_node *prev, 737 const char *prefix) 738 { 739 struct device_node *next; 740 unsigned long flags; 741 742 if (!node) 743 return NULL; 744 745 raw_spin_lock_irqsave(&devtree_lock, flags); 746 next = prev ? prev->sibling : node->child; 747 for (; next; next = next->sibling) { 748 if (!of_node_name_prefix(next, prefix)) 749 continue; 750 if (of_node_get(next)) 751 break; 752 } 753 of_node_put(prev); 754 raw_spin_unlock_irqrestore(&devtree_lock, flags); 755 return next; 756 } 757 EXPORT_SYMBOL(of_get_next_child_with_prefix); 758 759 static struct device_node *of_get_next_status_child(const struct device_node *node, 760 struct device_node *prev, 761 bool (*checker)(const struct device_node *)) 762 { 763 struct device_node *next; 764 unsigned long flags; 765 766 if (!node) 767 return NULL; 768 769 raw_spin_lock_irqsave(&devtree_lock, flags); 770 next = prev ? prev->sibling : node->child; 771 for (; next; next = next->sibling) { 772 if (!checker(next)) 773 continue; 774 if (of_node_get(next)) 775 break; 776 } 777 of_node_put(prev); 778 raw_spin_unlock_irqrestore(&devtree_lock, flags); 779 return next; 780 } 781 782 /** 783 * of_get_next_available_child - Find the next available child node 784 * @node: parent node 785 * @prev: previous child of the parent node, or NULL to get first 786 * 787 * This function is like of_get_next_child(), except that it 788 * automatically skips any disabled nodes (i.e. status = "disabled"). 789 */ 790 struct device_node *of_get_next_available_child(const struct device_node *node, 791 struct device_node *prev) 792 { 793 return of_get_next_status_child(node, prev, __of_device_is_available); 794 } 795 EXPORT_SYMBOL(of_get_next_available_child); 796 797 /** 798 * of_get_next_reserved_child - Find the next reserved child node 799 * @node: parent node 800 * @prev: previous child of the parent node, or NULL to get first 801 * 802 * This function is like of_get_next_child(), except that it 803 * automatically skips any disabled nodes (i.e. status = "disabled"). 804 */ 805 struct device_node *of_get_next_reserved_child(const struct device_node *node, 806 struct device_node *prev) 807 { 808 return of_get_next_status_child(node, prev, __of_device_is_reserved); 809 } 810 EXPORT_SYMBOL(of_get_next_reserved_child); 811 812 /** 813 * of_get_next_cpu_node - Iterate on cpu nodes 814 * @prev: previous child of the /cpus node, or NULL to get first 815 * 816 * Unusable CPUs (those with the status property set to "fail" or "fail-...") 817 * will be skipped. 818 * 819 * Return: A cpu node pointer with refcount incremented, use of_node_put() 820 * on it when done. Returns NULL when prev is the last child. Decrements 821 * the refcount of prev. 822 */ 823 struct device_node *of_get_next_cpu_node(struct device_node *prev) 824 { 825 struct device_node *next = NULL; 826 unsigned long flags; 827 struct device_node *node; 828 829 if (!prev) 830 node = of_find_node_by_path("/cpus"); 831 832 raw_spin_lock_irqsave(&devtree_lock, flags); 833 if (prev) 834 next = prev->sibling; 835 else if (node) { 836 next = node->child; 837 of_node_put(node); 838 } 839 for (; next; next = next->sibling) { 840 if (__of_device_is_fail(next)) 841 continue; 842 if (!(of_node_name_eq(next, "cpu") || 843 __of_node_is_type(next, "cpu"))) 844 continue; 845 if (of_node_get(next)) 846 break; 847 } 848 of_node_put(prev); 849 raw_spin_unlock_irqrestore(&devtree_lock, flags); 850 return next; 851 } 852 EXPORT_SYMBOL(of_get_next_cpu_node); 853 854 /** 855 * of_get_compatible_child - Find compatible child node 856 * @parent: parent node 857 * @compatible: compatible string 858 * 859 * Lookup child node whose compatible property contains the given compatible 860 * string. 861 * 862 * Return: a node pointer with refcount incremented, use of_node_put() on it 863 * when done; or NULL if not found. 864 */ 865 struct device_node *of_get_compatible_child(const struct device_node *parent, 866 const char *compatible) 867 { 868 struct device_node *child; 869 870 for_each_child_of_node(parent, child) { 871 if (of_device_is_compatible(child, compatible)) 872 break; 873 } 874 875 return child; 876 } 877 EXPORT_SYMBOL(of_get_compatible_child); 878 879 /** 880 * of_get_child_by_name - Find the child node by name for a given parent 881 * @node: parent node 882 * @name: child name to look for. 883 * 884 * This function looks for child node for given matching name 885 * 886 * Return: A node pointer if found, with refcount incremented, use 887 * of_node_put() on it when done. 888 * Returns NULL if node is not found. 889 */ 890 struct device_node *of_get_child_by_name(const struct device_node *node, 891 const char *name) 892 { 893 struct device_node *child; 894 895 for_each_child_of_node(node, child) 896 if (of_node_name_eq(child, name)) 897 break; 898 return child; 899 } 900 EXPORT_SYMBOL(of_get_child_by_name); 901 902 /** 903 * of_get_available_child_by_name - Find the available child node by name for a given parent 904 * @node: parent node 905 * @name: child name to look for. 906 * 907 * This function looks for child node for given matching name and checks the 908 * device's availability for use. 909 * 910 * Return: A node pointer if found, with refcount incremented, use 911 * of_node_put() on it when done. 912 * Returns NULL if node is not found. 913 */ 914 struct device_node *of_get_available_child_by_name(const struct device_node *node, 915 const char *name) 916 { 917 struct device_node *child; 918 919 child = of_get_child_by_name(node, name); 920 if (child && !of_device_is_available(child)) { 921 of_node_put(child); 922 return NULL; 923 } 924 925 return child; 926 } 927 EXPORT_SYMBOL(of_get_available_child_by_name); 928 929 struct device_node *__of_find_node_by_path(const struct device_node *parent, 930 const char *path) 931 { 932 struct device_node *child; 933 int len; 934 935 len = strcspn(path, "/:"); 936 if (!len) 937 return NULL; 938 939 __for_each_child_of_node(parent, child) { 940 const char *name = kbasename(child->full_name); 941 if (strncmp(path, name, len) == 0 && (strlen(name) == len)) 942 return child; 943 } 944 return NULL; 945 } 946 947 struct device_node *__of_find_node_by_full_path(struct device_node *node, 948 const char *path) 949 { 950 const char *separator = strchr(path, ':'); 951 952 while (node && *path == '/') { 953 struct device_node *tmp = node; 954 955 path++; /* Increment past '/' delimiter */ 956 node = __of_find_node_by_path(node, path); 957 of_node_put(tmp); 958 path = strchrnul(path, '/'); 959 if (separator && separator < path) 960 break; 961 } 962 return node; 963 } 964 965 /** 966 * of_find_node_opts_by_path - Find a node matching a full OF path 967 * @path: Either the full path to match, or if the path does not 968 * start with '/', the name of a property of the /aliases 969 * node (an alias). In the case of an alias, the node 970 * matching the alias' value will be returned. 971 * @opts: Address of a pointer into which to store the start of 972 * an options string appended to the end of the path with 973 * a ':' separator. 974 * 975 * Valid paths: 976 * * /foo/bar Full path 977 * * foo Valid alias 978 * * foo/bar Valid alias + relative path 979 * 980 * Return: A node pointer with refcount incremented, use 981 * of_node_put() on it when done. 982 */ 983 struct device_node *of_find_node_opts_by_path(const char *path, const char **opts) 984 { 985 struct device_node *np = NULL; 986 const struct property *pp; 987 unsigned long flags; 988 const char *separator = strchr(path, ':'); 989 990 if (opts) 991 *opts = separator ? separator + 1 : NULL; 992 993 if (strcmp(path, "/") == 0) 994 return of_node_get(of_root); 995 996 /* The path could begin with an alias */ 997 if (*path != '/') { 998 int len; 999 const char *p = strchrnul(path, '/'); 1000 1001 if (separator && separator < p) 1002 p = separator; 1003 len = p - path; 1004 1005 /* of_aliases must not be NULL */ 1006 if (!of_aliases) 1007 return NULL; 1008 1009 for_each_property_of_node(of_aliases, pp) { 1010 if (strlen(pp->name) == len && !strncmp(pp->name, path, len)) { 1011 np = of_find_node_by_path(pp->value); 1012 break; 1013 } 1014 } 1015 if (!np) 1016 return NULL; 1017 path = p; 1018 } 1019 1020 /* Step down the tree matching path components */ 1021 raw_spin_lock_irqsave(&devtree_lock, flags); 1022 if (!np) 1023 np = of_node_get(of_root); 1024 np = __of_find_node_by_full_path(np, path); 1025 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1026 return np; 1027 } 1028 EXPORT_SYMBOL(of_find_node_opts_by_path); 1029 1030 /** 1031 * of_find_node_by_name - Find a node by its "name" property 1032 * @from: The node to start searching from or NULL; the node 1033 * you pass will not be searched, only the next one 1034 * will. Typically, you pass what the previous call 1035 * returned. of_node_put() will be called on @from. 1036 * @name: The name string to match against 1037 * 1038 * Return: A node pointer with refcount incremented, use 1039 * of_node_put() on it when done. 1040 */ 1041 struct device_node *of_find_node_by_name(struct device_node *from, 1042 const char *name) 1043 { 1044 struct device_node *np; 1045 unsigned long flags; 1046 1047 raw_spin_lock_irqsave(&devtree_lock, flags); 1048 for_each_of_allnodes_from(from, np) 1049 if (of_node_name_eq(np, name) && of_node_get(np)) 1050 break; 1051 of_node_put(from); 1052 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1053 return np; 1054 } 1055 EXPORT_SYMBOL(of_find_node_by_name); 1056 1057 /** 1058 * of_find_node_by_type - Find a node by its "device_type" property 1059 * @from: The node to start searching from, or NULL to start searching 1060 * the entire device tree. The node you pass will not be 1061 * searched, only the next one will; typically, you pass 1062 * what the previous call returned. of_node_put() will be 1063 * called on from for you. 1064 * @type: The type string to match against 1065 * 1066 * Return: A node pointer with refcount incremented, use 1067 * of_node_put() on it when done. 1068 */ 1069 struct device_node *of_find_node_by_type(struct device_node *from, 1070 const char *type) 1071 { 1072 struct device_node *np; 1073 unsigned long flags; 1074 1075 raw_spin_lock_irqsave(&devtree_lock, flags); 1076 for_each_of_allnodes_from(from, np) 1077 if (__of_node_is_type(np, type) && of_node_get(np)) 1078 break; 1079 of_node_put(from); 1080 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1081 return np; 1082 } 1083 EXPORT_SYMBOL(of_find_node_by_type); 1084 1085 /** 1086 * of_find_compatible_node - Find a node based on type and one of the 1087 * tokens in its "compatible" property 1088 * @from: The node to start searching from or NULL, the node 1089 * you pass will not be searched, only the next one 1090 * will; typically, you pass what the previous call 1091 * returned. of_node_put() will be called on it 1092 * @type: The type string to match "device_type" or NULL to ignore 1093 * @compatible: The string to match to one of the tokens in the device 1094 * "compatible" list. 1095 * 1096 * Return: A node pointer with refcount incremented, use 1097 * of_node_put() on it when done. 1098 */ 1099 struct device_node *of_find_compatible_node(struct device_node *from, 1100 const char *type, const char *compatible) 1101 { 1102 struct device_node *np; 1103 unsigned long flags; 1104 1105 raw_spin_lock_irqsave(&devtree_lock, flags); 1106 for_each_of_allnodes_from(from, np) 1107 if (__of_device_is_compatible(np, compatible, type, NULL) && 1108 of_node_get(np)) 1109 break; 1110 of_node_put(from); 1111 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1112 return np; 1113 } 1114 EXPORT_SYMBOL(of_find_compatible_node); 1115 1116 /** 1117 * of_find_node_with_property - Find a node which has a property with 1118 * the given name. 1119 * @from: The node to start searching from or NULL, the node 1120 * you pass will not be searched, only the next one 1121 * will; typically, you pass what the previous call 1122 * returned. of_node_put() will be called on it 1123 * @prop_name: The name of the property to look for. 1124 * 1125 * Return: A node pointer with refcount incremented, use 1126 * of_node_put() on it when done. 1127 */ 1128 struct device_node *of_find_node_with_property(struct device_node *from, 1129 const char *prop_name) 1130 { 1131 struct device_node *np; 1132 unsigned long flags; 1133 1134 raw_spin_lock_irqsave(&devtree_lock, flags); 1135 for_each_of_allnodes_from(from, np) { 1136 if (__of_find_property(np, prop_name, NULL)) { 1137 of_node_get(np); 1138 break; 1139 } 1140 } 1141 of_node_put(from); 1142 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1143 return np; 1144 } 1145 EXPORT_SYMBOL(of_find_node_with_property); 1146 1147 static 1148 const struct of_device_id *__of_match_node(const struct of_device_id *matches, 1149 const struct device_node *node) 1150 { 1151 const struct of_device_id *best_match = NULL; 1152 int score, best_score = 0; 1153 1154 if (!matches) 1155 return NULL; 1156 1157 for (; matches->name[0] || matches->type[0] || matches->compatible[0]; matches++) { 1158 score = __of_device_is_compatible(node, matches->compatible, 1159 matches->type, matches->name); 1160 if (score > best_score) { 1161 best_match = matches; 1162 best_score = score; 1163 } 1164 } 1165 1166 return best_match; 1167 } 1168 1169 /** 1170 * of_match_node - Tell if a device_node has a matching of_match structure 1171 * @matches: array of of device match structures to search in 1172 * @node: the of device structure to match against 1173 * 1174 * Low level utility function used by device matching. 1175 */ 1176 const struct of_device_id *of_match_node(const struct of_device_id *matches, 1177 const struct device_node *node) 1178 { 1179 const struct of_device_id *match; 1180 unsigned long flags; 1181 1182 raw_spin_lock_irqsave(&devtree_lock, flags); 1183 match = __of_match_node(matches, node); 1184 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1185 return match; 1186 } 1187 EXPORT_SYMBOL(of_match_node); 1188 1189 /** 1190 * of_find_matching_node_and_match - Find a node based on an of_device_id 1191 * match table. 1192 * @from: The node to start searching from or NULL, the node 1193 * you pass will not be searched, only the next one 1194 * will; typically, you pass what the previous call 1195 * returned. of_node_put() will be called on it 1196 * @matches: array of of device match structures to search in 1197 * @match: Updated to point at the matches entry which matched 1198 * 1199 * Return: A node pointer with refcount incremented, use 1200 * of_node_put() on it when done. 1201 */ 1202 struct device_node *of_find_matching_node_and_match(struct device_node *from, 1203 const struct of_device_id *matches, 1204 const struct of_device_id **match) 1205 { 1206 struct device_node *np; 1207 const struct of_device_id *m; 1208 unsigned long flags; 1209 1210 if (match) 1211 *match = NULL; 1212 1213 raw_spin_lock_irqsave(&devtree_lock, flags); 1214 for_each_of_allnodes_from(from, np) { 1215 m = __of_match_node(matches, np); 1216 if (m && of_node_get(np)) { 1217 if (match) 1218 *match = m; 1219 break; 1220 } 1221 } 1222 of_node_put(from); 1223 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1224 return np; 1225 } 1226 EXPORT_SYMBOL(of_find_matching_node_and_match); 1227 1228 /** 1229 * of_alias_from_compatible - Lookup appropriate alias for a device node 1230 * depending on compatible 1231 * @node: pointer to a device tree node 1232 * @alias: Pointer to buffer that alias value will be copied into 1233 * @len: Length of alias value 1234 * 1235 * Based on the value of the compatible property, this routine will attempt 1236 * to choose an appropriate alias value for a particular device tree node. 1237 * It does this by stripping the manufacturer prefix (as delimited by a ',') 1238 * from the first entry in the compatible list property. 1239 * 1240 * Note: The matching on just the "product" side of the compatible is a relic 1241 * from I2C and SPI. Please do not add any new user. 1242 * 1243 * Return: This routine returns 0 on success, <0 on failure. 1244 */ 1245 int of_alias_from_compatible(const struct device_node *node, char *alias, int len) 1246 { 1247 const char *compatible, *p; 1248 int cplen; 1249 1250 compatible = of_get_property(node, "compatible", &cplen); 1251 if (!compatible || strlen(compatible) > cplen) 1252 return -ENODEV; 1253 p = strchr(compatible, ','); 1254 strscpy(alias, p ? p + 1 : compatible, len); 1255 return 0; 1256 } 1257 EXPORT_SYMBOL_GPL(of_alias_from_compatible); 1258 1259 /** 1260 * of_find_node_by_phandle - Find a node given a phandle 1261 * @handle: phandle of the node to find 1262 * 1263 * Return: A node pointer with refcount incremented, use 1264 * of_node_put() on it when done. 1265 */ 1266 struct device_node *of_find_node_by_phandle(phandle handle) 1267 { 1268 struct device_node *np = NULL; 1269 unsigned long flags; 1270 u32 handle_hash; 1271 1272 if (!handle) 1273 return NULL; 1274 1275 handle_hash = of_phandle_cache_hash(handle); 1276 1277 raw_spin_lock_irqsave(&devtree_lock, flags); 1278 1279 if (phandle_cache[handle_hash] && 1280 handle == phandle_cache[handle_hash]->phandle) 1281 np = phandle_cache[handle_hash]; 1282 1283 if (!np) { 1284 for_each_of_allnodes(np) 1285 if (np->phandle == handle && 1286 !of_node_check_flag(np, OF_DETACHED)) { 1287 phandle_cache[handle_hash] = np; 1288 break; 1289 } 1290 } 1291 1292 of_node_get(np); 1293 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1294 return np; 1295 } 1296 EXPORT_SYMBOL(of_find_node_by_phandle); 1297 1298 void of_print_phandle_args(const char *msg, const struct of_phandle_args *args) 1299 { 1300 int i; 1301 printk("%s %pOF", msg, args->np); 1302 for (i = 0; i < args->args_count; i++) { 1303 const char delim = i ? ',' : ':'; 1304 1305 pr_cont("%c%08x", delim, args->args[i]); 1306 } 1307 pr_cont("\n"); 1308 } 1309 1310 int of_phandle_iterator_init(struct of_phandle_iterator *it, 1311 const struct device_node *np, 1312 const char *list_name, 1313 const char *cells_name, 1314 int cell_count) 1315 { 1316 const __be32 *list; 1317 int size; 1318 1319 memset(it, 0, sizeof(*it)); 1320 1321 /* 1322 * one of cell_count or cells_name must be provided to determine the 1323 * argument length. 1324 */ 1325 if (cell_count < 0 && !cells_name) 1326 return -EINVAL; 1327 1328 list = of_get_property(np, list_name, &size); 1329 if (!list) 1330 return -ENOENT; 1331 1332 it->cells_name = cells_name; 1333 it->cell_count = cell_count; 1334 it->parent = np; 1335 it->list_end = list + size / sizeof(*list); 1336 it->phandle_end = list; 1337 it->cur = list; 1338 1339 return 0; 1340 } 1341 EXPORT_SYMBOL_GPL(of_phandle_iterator_init); 1342 1343 int of_phandle_iterator_next(struct of_phandle_iterator *it) 1344 { 1345 uint32_t count = 0; 1346 1347 if (it->node) { 1348 of_node_put(it->node); 1349 it->node = NULL; 1350 } 1351 1352 if (!it->cur || it->phandle_end >= it->list_end) 1353 return -ENOENT; 1354 1355 it->cur = it->phandle_end; 1356 1357 /* If phandle is 0, then it is an empty entry with no arguments. */ 1358 it->phandle = be32_to_cpup(it->cur++); 1359 1360 if (it->phandle) { 1361 1362 /* 1363 * Find the provider node and parse the #*-cells property to 1364 * determine the argument length. 1365 */ 1366 it->node = of_find_node_by_phandle(it->phandle); 1367 1368 if (it->cells_name) { 1369 if (!it->node) { 1370 pr_err("%pOF: could not find phandle %d\n", 1371 it->parent, it->phandle); 1372 goto err; 1373 } 1374 1375 if (of_property_read_u32(it->node, it->cells_name, 1376 &count)) { 1377 /* 1378 * If both cell_count and cells_name is given, 1379 * fall back to cell_count in absence 1380 * of the cells_name property 1381 */ 1382 if (it->cell_count >= 0) { 1383 count = it->cell_count; 1384 } else { 1385 pr_err("%pOF: could not get %s for %pOF\n", 1386 it->parent, 1387 it->cells_name, 1388 it->node); 1389 goto err; 1390 } 1391 } 1392 } else { 1393 count = it->cell_count; 1394 } 1395 1396 /* 1397 * Make sure that the arguments actually fit in the remaining 1398 * property data length 1399 */ 1400 if (it->cur + count > it->list_end) { 1401 if (it->cells_name) 1402 pr_err("%pOF: %s = %d found %td\n", 1403 it->parent, it->cells_name, 1404 count, it->list_end - it->cur); 1405 else 1406 pr_err("%pOF: phandle %s needs %d, found %td\n", 1407 it->parent, of_node_full_name(it->node), 1408 count, it->list_end - it->cur); 1409 goto err; 1410 } 1411 } 1412 1413 it->phandle_end = it->cur + count; 1414 it->cur_count = count; 1415 1416 return 0; 1417 1418 err: 1419 if (it->node) { 1420 of_node_put(it->node); 1421 it->node = NULL; 1422 } 1423 1424 return -EINVAL; 1425 } 1426 EXPORT_SYMBOL_GPL(of_phandle_iterator_next); 1427 1428 int of_phandle_iterator_args(struct of_phandle_iterator *it, 1429 uint32_t *args, 1430 int size) 1431 { 1432 int i, count; 1433 1434 count = it->cur_count; 1435 1436 if (WARN_ON(size < count)) 1437 count = size; 1438 1439 for (i = 0; i < count; i++) 1440 args[i] = be32_to_cpup(it->cur++); 1441 1442 return count; 1443 } 1444 1445 int __of_parse_phandle_with_args(const struct device_node *np, 1446 const char *list_name, 1447 const char *cells_name, 1448 int cell_count, int index, 1449 struct of_phandle_args *out_args) 1450 { 1451 struct of_phandle_iterator it; 1452 int rc, cur_index = 0; 1453 1454 if (index < 0) 1455 return -EINVAL; 1456 1457 /* Loop over the phandles until all the requested entry is found */ 1458 of_for_each_phandle(&it, rc, np, list_name, cells_name, cell_count) { 1459 /* 1460 * All of the error cases bail out of the loop, so at 1461 * this point, the parsing is successful. If the requested 1462 * index matches, then fill the out_args structure and return, 1463 * or return -ENOENT for an empty entry. 1464 */ 1465 rc = -ENOENT; 1466 if (cur_index == index) { 1467 if (!it.phandle) 1468 goto err; 1469 1470 if (out_args) { 1471 int c; 1472 1473 c = of_phandle_iterator_args(&it, 1474 out_args->args, 1475 MAX_PHANDLE_ARGS); 1476 out_args->np = it.node; 1477 out_args->args_count = c; 1478 } else { 1479 of_node_put(it.node); 1480 } 1481 1482 /* Found it! return success */ 1483 return 0; 1484 } 1485 1486 cur_index++; 1487 } 1488 1489 /* 1490 * Unlock node before returning result; will be one of: 1491 * -ENOENT : index is for empty phandle 1492 * -EINVAL : parsing error on data 1493 */ 1494 1495 err: 1496 of_node_put(it.node); 1497 return rc; 1498 } 1499 EXPORT_SYMBOL(__of_parse_phandle_with_args); 1500 1501 /** 1502 * of_parse_phandle_with_args_map() - Find a node pointed by phandle in a list and remap it 1503 * @np: pointer to a device tree node containing a list 1504 * @list_name: property name that contains a list 1505 * @stem_name: stem of property names that specify phandles' arguments count 1506 * @index: index of a phandle to parse out 1507 * @out_args: optional pointer to output arguments structure (will be filled) 1508 * 1509 * This function is useful to parse lists of phandles and their arguments. 1510 * Returns 0 on success and fills out_args, on error returns appropriate errno 1511 * value. The difference between this function and of_parse_phandle_with_args() 1512 * is that this API remaps a phandle if the node the phandle points to has 1513 * a <@stem_name>-map property. 1514 * 1515 * Caller is responsible to call of_node_put() on the returned out_args->np 1516 * pointer. 1517 * 1518 * Example:: 1519 * 1520 * phandle1: node1 { 1521 * #list-cells = <2>; 1522 * }; 1523 * 1524 * phandle2: node2 { 1525 * #list-cells = <1>; 1526 * }; 1527 * 1528 * phandle3: node3 { 1529 * #list-cells = <1>; 1530 * list-map = <0 &phandle2 3>, 1531 * <1 &phandle2 2>, 1532 * <2 &phandle1 5 1>; 1533 * list-map-mask = <0x3>; 1534 * }; 1535 * 1536 * node4 { 1537 * list = <&phandle1 1 2 &phandle3 0>; 1538 * }; 1539 * 1540 * To get a device_node of the ``node2`` node you may call this: 1541 * of_parse_phandle_with_args(node4, "list", "list", 1, &args); 1542 */ 1543 int of_parse_phandle_with_args_map(const struct device_node *np, 1544 const char *list_name, 1545 const char *stem_name, 1546 int index, struct of_phandle_args *out_args) 1547 { 1548 char *cells_name __free(kfree) = kasprintf(GFP_KERNEL, "#%s-cells", stem_name); 1549 char *map_name __free(kfree) = kasprintf(GFP_KERNEL, "%s-map", stem_name); 1550 char *mask_name __free(kfree) = kasprintf(GFP_KERNEL, "%s-map-mask", stem_name); 1551 char *pass_name __free(kfree) = kasprintf(GFP_KERNEL, "%s-map-pass-thru", stem_name); 1552 struct device_node *cur, *new = NULL; 1553 const __be32 *map, *mask, *pass; 1554 static const __be32 dummy_mask[] = { [0 ... (MAX_PHANDLE_ARGS - 1)] = cpu_to_be32(~0) }; 1555 static const __be32 dummy_pass[] = { [0 ... (MAX_PHANDLE_ARGS - 1)] = cpu_to_be32(0) }; 1556 __be32 initial_match_array[MAX_PHANDLE_ARGS]; 1557 const __be32 *match_array = initial_match_array; 1558 int i, ret, map_len, match; 1559 u32 list_size, new_size; 1560 1561 if (index < 0) 1562 return -EINVAL; 1563 1564 if (!cells_name || !map_name || !mask_name || !pass_name) 1565 return -ENOMEM; 1566 1567 ret = __of_parse_phandle_with_args(np, list_name, cells_name, -1, index, 1568 out_args); 1569 if (ret) 1570 return ret; 1571 1572 /* Get the #<list>-cells property */ 1573 cur = out_args->np; 1574 ret = of_property_read_u32(cur, cells_name, &list_size); 1575 if (ret < 0) 1576 goto put; 1577 1578 /* Precalculate the match array - this simplifies match loop */ 1579 for (i = 0; i < list_size; i++) 1580 initial_match_array[i] = cpu_to_be32(out_args->args[i]); 1581 1582 ret = -EINVAL; 1583 while (cur) { 1584 /* Get the <list>-map property */ 1585 map = of_get_property(cur, map_name, &map_len); 1586 if (!map) { 1587 return 0; 1588 } 1589 map_len /= sizeof(u32); 1590 1591 /* Get the <list>-map-mask property (optional) */ 1592 mask = of_get_property(cur, mask_name, NULL); 1593 if (!mask) 1594 mask = dummy_mask; 1595 /* Iterate through <list>-map property */ 1596 match = 0; 1597 while (map_len > (list_size + 1) && !match) { 1598 /* Compare specifiers */ 1599 match = 1; 1600 for (i = 0; i < list_size; i++, map_len--) 1601 match &= !((match_array[i] ^ *map++) & mask[i]); 1602 1603 of_node_put(new); 1604 new = of_find_node_by_phandle(be32_to_cpup(map)); 1605 map++; 1606 map_len--; 1607 1608 /* Check if not found */ 1609 if (!new) { 1610 ret = -EINVAL; 1611 goto put; 1612 } 1613 1614 if (!of_device_is_available(new)) 1615 match = 0; 1616 1617 ret = of_property_read_u32(new, cells_name, &new_size); 1618 if (ret) 1619 goto put; 1620 1621 /* Check for malformed properties */ 1622 if (WARN_ON(new_size > MAX_PHANDLE_ARGS) || 1623 map_len < new_size) { 1624 ret = -EINVAL; 1625 goto put; 1626 } 1627 1628 /* Move forward by new node's #<list>-cells amount */ 1629 map += new_size; 1630 map_len -= new_size; 1631 } 1632 if (!match) { 1633 ret = -ENOENT; 1634 goto put; 1635 } 1636 1637 /* Get the <list>-map-pass-thru property (optional) */ 1638 pass = of_get_property(cur, pass_name, NULL); 1639 if (!pass) 1640 pass = dummy_pass; 1641 1642 /* 1643 * Successfully parsed a <list>-map translation; copy new 1644 * specifier into the out_args structure, keeping the 1645 * bits specified in <list>-map-pass-thru. 1646 */ 1647 for (i = 0; i < new_size; i++) { 1648 __be32 val = *(map - new_size + i); 1649 1650 if (i < list_size) { 1651 val &= ~pass[i]; 1652 val |= cpu_to_be32(out_args->args[i]) & pass[i]; 1653 } 1654 1655 initial_match_array[i] = val; 1656 out_args->args[i] = be32_to_cpu(val); 1657 } 1658 out_args->args_count = list_size = new_size; 1659 /* Iterate again with new provider */ 1660 out_args->np = new; 1661 of_node_put(cur); 1662 cur = new; 1663 new = NULL; 1664 } 1665 put: 1666 of_node_put(cur); 1667 of_node_put(new); 1668 return ret; 1669 } 1670 EXPORT_SYMBOL(of_parse_phandle_with_args_map); 1671 1672 /** 1673 * of_count_phandle_with_args() - Find the number of phandles references in a property 1674 * @np: pointer to a device tree node containing a list 1675 * @list_name: property name that contains a list 1676 * @cells_name: property name that specifies phandles' arguments count 1677 * 1678 * Return: The number of phandle + argument tuples within a property. It 1679 * is a typical pattern to encode a list of phandle and variable 1680 * arguments into a single property. The number of arguments is encoded 1681 * by a property in the phandle-target node. For example, a gpios 1682 * property would contain a list of GPIO specifies consisting of a 1683 * phandle and 1 or more arguments. The number of arguments are 1684 * determined by the #gpio-cells property in the node pointed to by the 1685 * phandle. 1686 */ 1687 int of_count_phandle_with_args(const struct device_node *np, const char *list_name, 1688 const char *cells_name) 1689 { 1690 struct of_phandle_iterator it; 1691 int rc, cur_index = 0; 1692 1693 /* 1694 * If cells_name is NULL we assume a cell count of 0. This makes 1695 * counting the phandles trivial as each 32bit word in the list is a 1696 * phandle and no arguments are to consider. So we don't iterate through 1697 * the list but just use the length to determine the phandle count. 1698 */ 1699 if (!cells_name) { 1700 const __be32 *list; 1701 int size; 1702 1703 list = of_get_property(np, list_name, &size); 1704 if (!list) 1705 return -ENOENT; 1706 1707 return size / sizeof(*list); 1708 } 1709 1710 rc = of_phandle_iterator_init(&it, np, list_name, cells_name, -1); 1711 if (rc) 1712 return rc; 1713 1714 while ((rc = of_phandle_iterator_next(&it)) == 0) 1715 cur_index += 1; 1716 1717 if (rc != -ENOENT) 1718 return rc; 1719 1720 return cur_index; 1721 } 1722 EXPORT_SYMBOL(of_count_phandle_with_args); 1723 1724 static struct property *__of_remove_property_from_list(struct property **list, struct property *prop) 1725 { 1726 struct property **next; 1727 1728 for (next = list; *next; next = &(*next)->next) { 1729 if (*next == prop) { 1730 *next = prop->next; 1731 prop->next = NULL; 1732 return prop; 1733 } 1734 } 1735 return NULL; 1736 } 1737 1738 /** 1739 * __of_add_property - Add a property to a node without lock operations 1740 * @np: Caller's Device Node 1741 * @prop: Property to add 1742 */ 1743 int __of_add_property(struct device_node *np, struct property *prop) 1744 { 1745 int rc = 0; 1746 unsigned long flags; 1747 struct property **next; 1748 1749 raw_spin_lock_irqsave(&devtree_lock, flags); 1750 1751 __of_remove_property_from_list(&np->deadprops, prop); 1752 1753 prop->next = NULL; 1754 next = &np->properties; 1755 while (*next) { 1756 if (of_prop_cmp(prop->name, (*next)->name) == 0) { 1757 /* duplicate ! don't insert it */ 1758 rc = -EEXIST; 1759 goto out_unlock; 1760 } 1761 next = &(*next)->next; 1762 } 1763 *next = prop; 1764 1765 out_unlock: 1766 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1767 if (rc) 1768 return rc; 1769 1770 __of_add_property_sysfs(np, prop); 1771 return 0; 1772 } 1773 1774 /** 1775 * of_add_property - Add a property to a node 1776 * @np: Caller's Device Node 1777 * @prop: Property to add 1778 */ 1779 int of_add_property(struct device_node *np, struct property *prop) 1780 { 1781 int rc; 1782 1783 mutex_lock(&of_mutex); 1784 rc = __of_add_property(np, prop); 1785 mutex_unlock(&of_mutex); 1786 1787 if (!rc) 1788 of_property_notify(OF_RECONFIG_ADD_PROPERTY, np, prop, NULL); 1789 1790 return rc; 1791 } 1792 EXPORT_SYMBOL_GPL(of_add_property); 1793 1794 int __of_remove_property(struct device_node *np, struct property *prop) 1795 { 1796 unsigned long flags; 1797 int rc = -ENODEV; 1798 1799 raw_spin_lock_irqsave(&devtree_lock, flags); 1800 1801 if (__of_remove_property_from_list(&np->properties, prop)) { 1802 /* Found the property, add it to deadprops list */ 1803 prop->next = np->deadprops; 1804 np->deadprops = prop; 1805 rc = 0; 1806 } 1807 1808 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1809 if (rc) 1810 return rc; 1811 1812 __of_remove_property_sysfs(np, prop); 1813 return 0; 1814 } 1815 1816 /** 1817 * of_remove_property - Remove a property from a node. 1818 * @np: Caller's Device Node 1819 * @prop: Property to remove 1820 * 1821 * Note that we don't actually remove it, since we have given out 1822 * who-knows-how-many pointers to the data using get-property. 1823 * Instead we just move the property to the "dead properties" 1824 * list, so it won't be found any more. 1825 */ 1826 int of_remove_property(struct device_node *np, struct property *prop) 1827 { 1828 int rc; 1829 1830 if (!prop) 1831 return -ENODEV; 1832 1833 mutex_lock(&of_mutex); 1834 rc = __of_remove_property(np, prop); 1835 mutex_unlock(&of_mutex); 1836 1837 if (!rc) 1838 of_property_notify(OF_RECONFIG_REMOVE_PROPERTY, np, prop, NULL); 1839 1840 return rc; 1841 } 1842 EXPORT_SYMBOL_GPL(of_remove_property); 1843 1844 int __of_update_property(struct device_node *np, struct property *newprop, 1845 struct property **oldpropp) 1846 { 1847 struct property **next, *oldprop; 1848 unsigned long flags; 1849 1850 raw_spin_lock_irqsave(&devtree_lock, flags); 1851 1852 __of_remove_property_from_list(&np->deadprops, newprop); 1853 1854 for (next = &np->properties; *next; next = &(*next)->next) { 1855 if (of_prop_cmp((*next)->name, newprop->name) == 0) 1856 break; 1857 } 1858 *oldpropp = oldprop = *next; 1859 1860 if (oldprop) { 1861 /* replace the node */ 1862 newprop->next = oldprop->next; 1863 *next = newprop; 1864 oldprop->next = np->deadprops; 1865 np->deadprops = oldprop; 1866 } else { 1867 /* new node */ 1868 newprop->next = NULL; 1869 *next = newprop; 1870 } 1871 1872 raw_spin_unlock_irqrestore(&devtree_lock, flags); 1873 1874 __of_update_property_sysfs(np, newprop, oldprop); 1875 1876 return 0; 1877 } 1878 1879 /* 1880 * of_update_property - Update a property in a node, if the property does 1881 * not exist, add it. 1882 * 1883 * Note that we don't actually remove it, since we have given out 1884 * who-knows-how-many pointers to the data using get-property. 1885 * Instead we just move the property to the "dead properties" list, 1886 * and add the new property to the property list 1887 */ 1888 int of_update_property(struct device_node *np, struct property *newprop) 1889 { 1890 struct property *oldprop; 1891 int rc; 1892 1893 if (!newprop->name) 1894 return -EINVAL; 1895 1896 mutex_lock(&of_mutex); 1897 rc = __of_update_property(np, newprop, &oldprop); 1898 mutex_unlock(&of_mutex); 1899 1900 if (!rc) 1901 of_property_notify(OF_RECONFIG_UPDATE_PROPERTY, np, newprop, oldprop); 1902 1903 return rc; 1904 } 1905 1906 static void of_alias_add(struct alias_prop *ap, struct device_node *np, 1907 int id, const char *stem, int stem_len) 1908 { 1909 ap->np = np; 1910 ap->id = id; 1911 strscpy(ap->stem, stem, stem_len + 1); 1912 list_add_tail(&ap->link, &aliases_lookup); 1913 pr_debug("adding DT alias:%s: stem=%s id=%i node=%pOF\n", 1914 ap->alias, ap->stem, ap->id, np); 1915 } 1916 1917 /** 1918 * of_alias_scan - Scan all properties of the 'aliases' node 1919 * @dt_alloc: An allocator that provides a virtual address to memory 1920 * for storing the resulting tree 1921 * 1922 * The function scans all the properties of the 'aliases' node and populates 1923 * the global lookup table with the properties. 1924 */ 1925 void of_alias_scan(void * (*dt_alloc)(u64 size, u64 align)) 1926 { 1927 const struct property *pp; 1928 1929 of_aliases = of_find_node_by_path("/aliases"); 1930 of_chosen = of_find_node_by_path("/chosen"); 1931 if (of_chosen == NULL) 1932 of_chosen = of_find_node_by_path("/chosen@0"); 1933 1934 if (of_chosen) { 1935 /* linux,stdout-path and /aliases/stdout are for legacy compatibility */ 1936 const char *name = NULL; 1937 1938 if (of_property_read_string(of_chosen, "stdout-path", &name)) 1939 of_property_read_string(of_chosen, "linux,stdout-path", 1940 &name); 1941 if (IS_ENABLED(CONFIG_PPC) && !name) 1942 of_property_read_string(of_aliases, "stdout", &name); 1943 if (name) 1944 of_stdout = of_find_node_opts_by_path(name, &of_stdout_options); 1945 if (of_stdout) 1946 fwnode_set_flag(&of_stdout->fwnode, FWNODE_FLAG_BEST_EFFORT); 1947 } 1948 1949 if (!of_aliases) 1950 return; 1951 1952 for_each_property_of_node(of_aliases, pp) { 1953 const char *start = pp->name; 1954 const char *end = start + strlen(start); 1955 struct device_node *np; 1956 struct alias_prop *ap; 1957 int id, len; 1958 1959 /* Skip those we do not want to proceed */ 1960 if (is_pseudo_property(pp->name)) 1961 continue; 1962 1963 np = of_find_node_by_path(pp->value); 1964 if (!np) 1965 continue; 1966 1967 /* walk the alias backwards to extract the id and work out 1968 * the 'stem' string */ 1969 while (isdigit(*(end-1)) && end > start) 1970 end--; 1971 len = end - start; 1972 1973 if (kstrtoint(end, 10, &id) < 0) { 1974 of_node_put(np); 1975 continue; 1976 } 1977 1978 /* Allocate an alias_prop with enough space for the stem */ 1979 ap = dt_alloc(sizeof(*ap) + len + 1, __alignof__(*ap)); 1980 if (!ap) { 1981 of_node_put(np); 1982 continue; 1983 } 1984 memset(ap, 0, sizeof(*ap) + len + 1); 1985 ap->alias = start; 1986 of_alias_add(ap, np, id, start, len); 1987 } 1988 } 1989 1990 /** 1991 * of_alias_get_id - Get alias id for the given device_node 1992 * @np: Pointer to the given device_node 1993 * @stem: Alias stem of the given device_node 1994 * 1995 * The function travels the lookup table to get the alias id for the given 1996 * device_node and alias stem. 1997 * 1998 * Return: The alias id if found. 1999 */ 2000 int of_alias_get_id(const struct device_node *np, const char *stem) 2001 { 2002 struct alias_prop *app; 2003 int id = -ENODEV; 2004 2005 mutex_lock(&of_mutex); 2006 list_for_each_entry(app, &aliases_lookup, link) { 2007 if (strcmp(app->stem, stem) != 0) 2008 continue; 2009 2010 if (np == app->np) { 2011 id = app->id; 2012 break; 2013 } 2014 } 2015 mutex_unlock(&of_mutex); 2016 2017 return id; 2018 } 2019 EXPORT_SYMBOL_GPL(of_alias_get_id); 2020 2021 /** 2022 * of_alias_get_highest_id - Get highest alias id for the given stem 2023 * @stem: Alias stem to be examined 2024 * 2025 * The function travels the lookup table to get the highest alias id for the 2026 * given alias stem. It returns the alias id if found. 2027 */ 2028 int of_alias_get_highest_id(const char *stem) 2029 { 2030 struct alias_prop *app; 2031 int id = -ENODEV; 2032 2033 mutex_lock(&of_mutex); 2034 list_for_each_entry(app, &aliases_lookup, link) { 2035 if (strcmp(app->stem, stem) != 0) 2036 continue; 2037 2038 if (app->id > id) 2039 id = app->id; 2040 } 2041 mutex_unlock(&of_mutex); 2042 2043 return id; 2044 } 2045 EXPORT_SYMBOL_GPL(of_alias_get_highest_id); 2046 2047 /** 2048 * of_console_check() - Test and setup console for DT setup 2049 * @dn: Pointer to device node 2050 * @name: Name to use for preferred console without index. ex. "ttyS" 2051 * @index: Index to use for preferred console. 2052 * 2053 * Check if the given device node matches the stdout-path property in the 2054 * /chosen node. If it does then register it as the preferred console. 2055 * 2056 * Return: TRUE if console successfully setup. Otherwise return FALSE. 2057 */ 2058 bool of_console_check(const struct device_node *dn, char *name, int index) 2059 { 2060 if (!dn || dn != of_stdout || console_set_on_cmdline) 2061 return false; 2062 2063 /* 2064 * XXX: cast `options' to char pointer to suppress complication 2065 * warnings: printk, UART and console drivers expect char pointer. 2066 */ 2067 return !add_preferred_console(name, index, (char *)of_stdout_options); 2068 } 2069 EXPORT_SYMBOL_GPL(of_console_check); 2070 2071 /** 2072 * of_find_next_cache_node - Find a node's subsidiary cache 2073 * @np: node of type "cpu" or "cache" 2074 * 2075 * Return: A node pointer with refcount incremented, use 2076 * of_node_put() on it when done. Caller should hold a reference 2077 * to np. 2078 */ 2079 struct device_node *of_find_next_cache_node(const struct device_node *np) 2080 { 2081 struct device_node *child, *cache_node; 2082 2083 cache_node = of_parse_phandle(np, "l2-cache", 0); 2084 if (!cache_node) 2085 cache_node = of_parse_phandle(np, "next-level-cache", 0); 2086 2087 if (cache_node) 2088 return cache_node; 2089 2090 /* OF on pmac has nodes instead of properties named "l2-cache" 2091 * beneath CPU nodes. 2092 */ 2093 if (IS_ENABLED(CONFIG_PPC_PMAC) && of_node_is_type(np, "cpu")) 2094 for_each_child_of_node(np, child) 2095 if (of_node_is_type(child, "cache")) 2096 return child; 2097 2098 return NULL; 2099 } 2100 2101 /** 2102 * of_find_last_cache_level - Find the level at which the last cache is 2103 * present for the given logical cpu 2104 * 2105 * @cpu: cpu number(logical index) for which the last cache level is needed 2106 * 2107 * Return: The level at which the last cache is present. It is exactly 2108 * same as the total number of cache levels for the given logical cpu. 2109 */ 2110 int of_find_last_cache_level(unsigned int cpu) 2111 { 2112 u32 cache_level = 0; 2113 struct device_node *prev = NULL, *np = of_cpu_device_node_get(cpu); 2114 2115 while (np) { 2116 of_node_put(prev); 2117 prev = np; 2118 np = of_find_next_cache_node(np); 2119 } 2120 2121 of_property_read_u32(prev, "cache-level", &cache_level); 2122 of_node_put(prev); 2123 2124 return cache_level; 2125 } 2126 2127 /** 2128 * of_map_id - Translate an ID through a downstream mapping. 2129 * @np: root complex device node. 2130 * @id: device ID to map. 2131 * @map_name: property name of the map to use. 2132 * @map_mask_name: optional property name of the mask to use. 2133 * @target: optional pointer to a target device node. 2134 * @id_out: optional pointer to receive the translated ID. 2135 * 2136 * Given a device ID, look up the appropriate implementation-defined 2137 * platform ID and/or the target device which receives transactions on that 2138 * ID, as per the "iommu-map" and "msi-map" bindings. Either of @target or 2139 * @id_out may be NULL if only the other is required. If @target points to 2140 * a non-NULL device node pointer, only entries targeting that node will be 2141 * matched; if it points to a NULL value, it will receive the device node of 2142 * the first matching target phandle, with a reference held. 2143 * 2144 * Return: 0 on success or a standard error code on failure. 2145 */ 2146 int of_map_id(const struct device_node *np, u32 id, 2147 const char *map_name, const char *map_mask_name, 2148 struct device_node **target, u32 *id_out) 2149 { 2150 u32 map_mask, masked_id; 2151 int map_len; 2152 const __be32 *map = NULL; 2153 2154 if (!np || !map_name || (!target && !id_out)) 2155 return -EINVAL; 2156 2157 map = of_get_property(np, map_name, &map_len); 2158 if (!map) { 2159 if (target) 2160 return -ENODEV; 2161 /* Otherwise, no map implies no translation */ 2162 *id_out = id; 2163 return 0; 2164 } 2165 2166 if (!map_len || map_len % (4 * sizeof(*map))) { 2167 pr_err("%pOF: Error: Bad %s length: %d\n", np, 2168 map_name, map_len); 2169 return -EINVAL; 2170 } 2171 2172 /* The default is to select all bits. */ 2173 map_mask = 0xffffffff; 2174 2175 /* 2176 * Can be overridden by "{iommu,msi}-map-mask" property. 2177 * If of_property_read_u32() fails, the default is used. 2178 */ 2179 if (map_mask_name) 2180 of_property_read_u32(np, map_mask_name, &map_mask); 2181 2182 masked_id = map_mask & id; 2183 for ( ; map_len > 0; map_len -= 4 * sizeof(*map), map += 4) { 2184 struct device_node *phandle_node; 2185 u32 id_base = be32_to_cpup(map + 0); 2186 u32 phandle = be32_to_cpup(map + 1); 2187 u32 out_base = be32_to_cpup(map + 2); 2188 u32 id_len = be32_to_cpup(map + 3); 2189 2190 if (id_base & ~map_mask) { 2191 pr_err("%pOF: Invalid %s translation - %s-mask (0x%x) ignores id-base (0x%x)\n", 2192 np, map_name, map_name, 2193 map_mask, id_base); 2194 return -EFAULT; 2195 } 2196 2197 if (masked_id < id_base || masked_id >= id_base + id_len) 2198 continue; 2199 2200 phandle_node = of_find_node_by_phandle(phandle); 2201 if (!phandle_node) 2202 return -ENODEV; 2203 2204 if (target) { 2205 if (*target) 2206 of_node_put(phandle_node); 2207 else 2208 *target = phandle_node; 2209 2210 if (*target != phandle_node) 2211 continue; 2212 } 2213 2214 if (id_out) 2215 *id_out = masked_id - id_base + out_base; 2216 2217 pr_debug("%pOF: %s, using mask %08x, id-base: %08x, out-base: %08x, length: %08x, id: %08x -> %08x\n", 2218 np, map_name, map_mask, id_base, out_base, 2219 id_len, id, masked_id - id_base + out_base); 2220 return 0; 2221 } 2222 2223 pr_info("%pOF: no %s translation for id 0x%x on %pOF\n", np, map_name, 2224 id, target && *target ? *target : NULL); 2225 2226 /* Bypasses translation */ 2227 if (id_out) 2228 *id_out = id; 2229 return 0; 2230 } 2231 EXPORT_SYMBOL_GPL(of_map_id); 2232