19b6b563cSPaul Mackerras /* 29b6b563cSPaul Mackerras * Procedures for creating, accessing and interpreting the device tree. 39b6b563cSPaul Mackerras * 49b6b563cSPaul Mackerras * Paul Mackerras August 1996. 59b6b563cSPaul Mackerras * Copyright (C) 1996-2005 Paul Mackerras. 69b6b563cSPaul Mackerras * 79b6b563cSPaul Mackerras * Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner. 89b6b563cSPaul Mackerras * {engebret|bergner}@us.ibm.com 99b6b563cSPaul Mackerras * 109b6b563cSPaul Mackerras * This program is free software; you can redistribute it and/or 119b6b563cSPaul Mackerras * modify it under the terms of the GNU General Public License 129b6b563cSPaul Mackerras * as published by the Free Software Foundation; either version 139b6b563cSPaul Mackerras * 2 of the License, or (at your option) any later version. 149b6b563cSPaul Mackerras */ 159b6b563cSPaul Mackerras 169b6b563cSPaul Mackerras #undef DEBUG 179b6b563cSPaul Mackerras 189b6b563cSPaul Mackerras #include <stdarg.h> 199b6b563cSPaul Mackerras #include <linux/config.h> 209b6b563cSPaul Mackerras #include <linux/kernel.h> 219b6b563cSPaul Mackerras #include <linux/string.h> 229b6b563cSPaul Mackerras #include <linux/init.h> 239b6b563cSPaul Mackerras #include <linux/threads.h> 249b6b563cSPaul Mackerras #include <linux/spinlock.h> 259b6b563cSPaul Mackerras #include <linux/types.h> 269b6b563cSPaul Mackerras #include <linux/pci.h> 279b6b563cSPaul Mackerras #include <linux/stringify.h> 289b6b563cSPaul Mackerras #include <linux/delay.h> 299b6b563cSPaul Mackerras #include <linux/initrd.h> 309b6b563cSPaul Mackerras #include <linux/bitops.h> 319b6b563cSPaul Mackerras #include <linux/module.h> 32dcee3036SMichael Ellerman #include <linux/kexec.h> 339b6b563cSPaul Mackerras 349b6b563cSPaul Mackerras #include <asm/prom.h> 359b6b563cSPaul Mackerras #include <asm/rtas.h> 369b6b563cSPaul Mackerras #include <asm/lmb.h> 379b6b563cSPaul Mackerras #include <asm/page.h> 389b6b563cSPaul Mackerras #include <asm/processor.h> 399b6b563cSPaul Mackerras #include <asm/irq.h> 409b6b563cSPaul Mackerras #include <asm/io.h> 410cc4746cSMichael Ellerman #include <asm/kdump.h> 429b6b563cSPaul Mackerras #include <asm/smp.h> 439b6b563cSPaul Mackerras #include <asm/system.h> 449b6b563cSPaul Mackerras #include <asm/mmu.h> 459b6b563cSPaul Mackerras #include <asm/pgtable.h> 469b6b563cSPaul Mackerras #include <asm/pci.h> 479b6b563cSPaul Mackerras #include <asm/iommu.h> 489b6b563cSPaul Mackerras #include <asm/btext.h> 499b6b563cSPaul Mackerras #include <asm/sections.h> 509b6b563cSPaul Mackerras #include <asm/machdep.h> 519b6b563cSPaul Mackerras #include <asm/pSeries_reconfig.h> 5240ef8cbcSPaul Mackerras #include <asm/pci-bridge.h> 539b6b563cSPaul Mackerras 549b6b563cSPaul Mackerras #ifdef DEBUG 559b6b563cSPaul Mackerras #define DBG(fmt...) printk(KERN_ERR fmt) 569b6b563cSPaul Mackerras #else 579b6b563cSPaul Mackerras #define DBG(fmt...) 589b6b563cSPaul Mackerras #endif 599b6b563cSPaul Mackerras 609b6b563cSPaul Mackerras 619b6b563cSPaul Mackerras static int __initdata dt_root_addr_cells; 629b6b563cSPaul Mackerras static int __initdata dt_root_size_cells; 639b6b563cSPaul Mackerras 649b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 6528897731SOlof Johansson int __initdata iommu_is_off; 669b6b563cSPaul Mackerras int __initdata iommu_force_on; 67cf00a8d1SPaul Mackerras unsigned long tce_alloc_start, tce_alloc_end; 689b6b563cSPaul Mackerras #endif 699b6b563cSPaul Mackerras 709b6b563cSPaul Mackerras typedef u32 cell_t; 719b6b563cSPaul Mackerras 729b6b563cSPaul Mackerras #if 0 739b6b563cSPaul Mackerras static struct boot_param_header *initial_boot_params __initdata; 749b6b563cSPaul Mackerras #else 759b6b563cSPaul Mackerras struct boot_param_header *initial_boot_params; 769b6b563cSPaul Mackerras #endif 779b6b563cSPaul Mackerras 789b6b563cSPaul Mackerras static struct device_node *allnodes = NULL; 799b6b563cSPaul Mackerras 809b6b563cSPaul Mackerras /* use when traversing tree through the allnext, child, sibling, 819b6b563cSPaul Mackerras * or parent members of struct device_node. 829b6b563cSPaul Mackerras */ 839b6b563cSPaul Mackerras static DEFINE_RWLOCK(devtree_lock); 849b6b563cSPaul Mackerras 859b6b563cSPaul Mackerras /* export that to outside world */ 869b6b563cSPaul Mackerras struct device_node *of_chosen; 879b6b563cSPaul Mackerras 889b6b563cSPaul Mackerras struct device_node *dflt_interrupt_controller; 899b6b563cSPaul Mackerras int num_interrupt_controllers; 909b6b563cSPaul Mackerras 919b6b563cSPaul Mackerras /* 929b6b563cSPaul Mackerras * Wrapper for allocating memory for various data that needs to be 939b6b563cSPaul Mackerras * attached to device nodes as they are processed at boot or when 949b6b563cSPaul Mackerras * added to the device tree later (e.g. DLPAR). At boot there is 959b6b563cSPaul Mackerras * already a region reserved so we just increment *mem_start by size; 969b6b563cSPaul Mackerras * otherwise we call kmalloc. 979b6b563cSPaul Mackerras */ 989b6b563cSPaul Mackerras static void * prom_alloc(unsigned long size, unsigned long *mem_start) 999b6b563cSPaul Mackerras { 1009b6b563cSPaul Mackerras unsigned long tmp; 1019b6b563cSPaul Mackerras 1029b6b563cSPaul Mackerras if (!mem_start) 1039b6b563cSPaul Mackerras return kmalloc(size, GFP_KERNEL); 1049b6b563cSPaul Mackerras 1059b6b563cSPaul Mackerras tmp = *mem_start; 1069b6b563cSPaul Mackerras *mem_start += size; 1079b6b563cSPaul Mackerras return (void *)tmp; 1089b6b563cSPaul Mackerras } 1099b6b563cSPaul Mackerras 1109b6b563cSPaul Mackerras /* 1119b6b563cSPaul Mackerras * Find the device_node with a given phandle. 1129b6b563cSPaul Mackerras */ 1139b6b563cSPaul Mackerras static struct device_node * find_phandle(phandle ph) 1149b6b563cSPaul Mackerras { 1159b6b563cSPaul Mackerras struct device_node *np; 1169b6b563cSPaul Mackerras 1179b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) 1189b6b563cSPaul Mackerras if (np->linux_phandle == ph) 1199b6b563cSPaul Mackerras return np; 1209b6b563cSPaul Mackerras return NULL; 1219b6b563cSPaul Mackerras } 1229b6b563cSPaul Mackerras 1239b6b563cSPaul Mackerras /* 1249b6b563cSPaul Mackerras * Find the interrupt parent of a node. 1259b6b563cSPaul Mackerras */ 1269b6b563cSPaul Mackerras static struct device_node * __devinit intr_parent(struct device_node *p) 1279b6b563cSPaul Mackerras { 1289b6b563cSPaul Mackerras phandle *parp; 1299b6b563cSPaul Mackerras 1309b6b563cSPaul Mackerras parp = (phandle *) get_property(p, "interrupt-parent", NULL); 1319b6b563cSPaul Mackerras if (parp == NULL) 1329b6b563cSPaul Mackerras return p->parent; 1339b6b563cSPaul Mackerras p = find_phandle(*parp); 1349b6b563cSPaul Mackerras if (p != NULL) 1359b6b563cSPaul Mackerras return p; 1369b6b563cSPaul Mackerras /* 1379b6b563cSPaul Mackerras * On a powermac booted with BootX, we don't get to know the 1389b6b563cSPaul Mackerras * phandles for any nodes, so find_phandle will return NULL. 1399b6b563cSPaul Mackerras * Fortunately these machines only have one interrupt controller 1409b6b563cSPaul Mackerras * so there isn't in fact any ambiguity. -- paulus 1419b6b563cSPaul Mackerras */ 1429b6b563cSPaul Mackerras if (num_interrupt_controllers == 1) 1439b6b563cSPaul Mackerras p = dflt_interrupt_controller; 1449b6b563cSPaul Mackerras return p; 1459b6b563cSPaul Mackerras } 1469b6b563cSPaul Mackerras 1479b6b563cSPaul Mackerras /* 1489b6b563cSPaul Mackerras * Find out the size of each entry of the interrupts property 1499b6b563cSPaul Mackerras * for a node. 1509b6b563cSPaul Mackerras */ 1519b6b563cSPaul Mackerras int __devinit prom_n_intr_cells(struct device_node *np) 1529b6b563cSPaul Mackerras { 1539b6b563cSPaul Mackerras struct device_node *p; 1549b6b563cSPaul Mackerras unsigned int *icp; 1559b6b563cSPaul Mackerras 1569b6b563cSPaul Mackerras for (p = np; (p = intr_parent(p)) != NULL; ) { 1579b6b563cSPaul Mackerras icp = (unsigned int *) 1589b6b563cSPaul Mackerras get_property(p, "#interrupt-cells", NULL); 1599b6b563cSPaul Mackerras if (icp != NULL) 1609b6b563cSPaul Mackerras return *icp; 1619b6b563cSPaul Mackerras if (get_property(p, "interrupt-controller", NULL) != NULL 1629b6b563cSPaul Mackerras || get_property(p, "interrupt-map", NULL) != NULL) { 1639b6b563cSPaul Mackerras printk("oops, node %s doesn't have #interrupt-cells\n", 1649b6b563cSPaul Mackerras p->full_name); 1659b6b563cSPaul Mackerras return 1; 1669b6b563cSPaul Mackerras } 1679b6b563cSPaul Mackerras } 1689b6b563cSPaul Mackerras #ifdef DEBUG_IRQ 1699b6b563cSPaul Mackerras printk("prom_n_intr_cells failed for %s\n", np->full_name); 1709b6b563cSPaul Mackerras #endif 1719b6b563cSPaul Mackerras return 1; 1729b6b563cSPaul Mackerras } 1739b6b563cSPaul Mackerras 1749b6b563cSPaul Mackerras /* 1759b6b563cSPaul Mackerras * Map an interrupt from a device up to the platform interrupt 1769b6b563cSPaul Mackerras * descriptor. 1779b6b563cSPaul Mackerras */ 1789b6b563cSPaul Mackerras static int __devinit map_interrupt(unsigned int **irq, struct device_node **ictrler, 1799b6b563cSPaul Mackerras struct device_node *np, unsigned int *ints, 1809b6b563cSPaul Mackerras int nintrc) 1819b6b563cSPaul Mackerras { 1829b6b563cSPaul Mackerras struct device_node *p, *ipar; 1839b6b563cSPaul Mackerras unsigned int *imap, *imask, *ip; 1849b6b563cSPaul Mackerras int i, imaplen, match; 1859b6b563cSPaul Mackerras int newintrc = 0, newaddrc = 0; 1869b6b563cSPaul Mackerras unsigned int *reg; 1879b6b563cSPaul Mackerras int naddrc; 1889b6b563cSPaul Mackerras 1899b6b563cSPaul Mackerras reg = (unsigned int *) get_property(np, "reg", NULL); 1909b6b563cSPaul Mackerras naddrc = prom_n_addr_cells(np); 1919b6b563cSPaul Mackerras p = intr_parent(np); 1929b6b563cSPaul Mackerras while (p != NULL) { 1939b6b563cSPaul Mackerras if (get_property(p, "interrupt-controller", NULL) != NULL) 1949b6b563cSPaul Mackerras /* this node is an interrupt controller, stop here */ 1959b6b563cSPaul Mackerras break; 1969b6b563cSPaul Mackerras imap = (unsigned int *) 1979b6b563cSPaul Mackerras get_property(p, "interrupt-map", &imaplen); 1989b6b563cSPaul Mackerras if (imap == NULL) { 1999b6b563cSPaul Mackerras p = intr_parent(p); 2009b6b563cSPaul Mackerras continue; 2019b6b563cSPaul Mackerras } 2029b6b563cSPaul Mackerras imask = (unsigned int *) 2039b6b563cSPaul Mackerras get_property(p, "interrupt-map-mask", NULL); 2049b6b563cSPaul Mackerras if (imask == NULL) { 2059b6b563cSPaul Mackerras printk("oops, %s has interrupt-map but no mask\n", 2069b6b563cSPaul Mackerras p->full_name); 2079b6b563cSPaul Mackerras return 0; 2089b6b563cSPaul Mackerras } 2099b6b563cSPaul Mackerras imaplen /= sizeof(unsigned int); 2109b6b563cSPaul Mackerras match = 0; 2119b6b563cSPaul Mackerras ipar = NULL; 2129b6b563cSPaul Mackerras while (imaplen > 0 && !match) { 2139b6b563cSPaul Mackerras /* check the child-interrupt field */ 2149b6b563cSPaul Mackerras match = 1; 2159b6b563cSPaul Mackerras for (i = 0; i < naddrc && match; ++i) 2169b6b563cSPaul Mackerras match = ((reg[i] ^ imap[i]) & imask[i]) == 0; 2179b6b563cSPaul Mackerras for (; i < naddrc + nintrc && match; ++i) 2189b6b563cSPaul Mackerras match = ((ints[i-naddrc] ^ imap[i]) & imask[i]) == 0; 2199b6b563cSPaul Mackerras imap += naddrc + nintrc; 2209b6b563cSPaul Mackerras imaplen -= naddrc + nintrc; 2219b6b563cSPaul Mackerras /* grab the interrupt parent */ 2229b6b563cSPaul Mackerras ipar = find_phandle((phandle) *imap++); 2239b6b563cSPaul Mackerras --imaplen; 2249b6b563cSPaul Mackerras if (ipar == NULL && num_interrupt_controllers == 1) 2259b6b563cSPaul Mackerras /* cope with BootX not giving us phandles */ 2269b6b563cSPaul Mackerras ipar = dflt_interrupt_controller; 2279b6b563cSPaul Mackerras if (ipar == NULL) { 2289b6b563cSPaul Mackerras printk("oops, no int parent %x in map of %s\n", 2299b6b563cSPaul Mackerras imap[-1], p->full_name); 2309b6b563cSPaul Mackerras return 0; 2319b6b563cSPaul Mackerras } 2329b6b563cSPaul Mackerras /* find the parent's # addr and intr cells */ 2339b6b563cSPaul Mackerras ip = (unsigned int *) 2349b6b563cSPaul Mackerras get_property(ipar, "#interrupt-cells", NULL); 2359b6b563cSPaul Mackerras if (ip == NULL) { 2369b6b563cSPaul Mackerras printk("oops, no #interrupt-cells on %s\n", 2379b6b563cSPaul Mackerras ipar->full_name); 2389b6b563cSPaul Mackerras return 0; 2399b6b563cSPaul Mackerras } 2409b6b563cSPaul Mackerras newintrc = *ip; 2419b6b563cSPaul Mackerras ip = (unsigned int *) 2429b6b563cSPaul Mackerras get_property(ipar, "#address-cells", NULL); 2439b6b563cSPaul Mackerras newaddrc = (ip == NULL)? 0: *ip; 2449b6b563cSPaul Mackerras imap += newaddrc + newintrc; 2459b6b563cSPaul Mackerras imaplen -= newaddrc + newintrc; 2469b6b563cSPaul Mackerras } 2479b6b563cSPaul Mackerras if (imaplen < 0) { 2489b6b563cSPaul Mackerras printk("oops, error decoding int-map on %s, len=%d\n", 2499b6b563cSPaul Mackerras p->full_name, imaplen); 2509b6b563cSPaul Mackerras return 0; 2519b6b563cSPaul Mackerras } 2529b6b563cSPaul Mackerras if (!match) { 2539b6b563cSPaul Mackerras #ifdef DEBUG_IRQ 2549b6b563cSPaul Mackerras printk("oops, no match in %s int-map for %s\n", 2559b6b563cSPaul Mackerras p->full_name, np->full_name); 2569b6b563cSPaul Mackerras #endif 2579b6b563cSPaul Mackerras return 0; 2589b6b563cSPaul Mackerras } 2599b6b563cSPaul Mackerras p = ipar; 2609b6b563cSPaul Mackerras naddrc = newaddrc; 2619b6b563cSPaul Mackerras nintrc = newintrc; 2629b6b563cSPaul Mackerras ints = imap - nintrc; 2639b6b563cSPaul Mackerras reg = ints - naddrc; 2649b6b563cSPaul Mackerras } 2659b6b563cSPaul Mackerras if (p == NULL) { 2669b6b563cSPaul Mackerras #ifdef DEBUG_IRQ 2679b6b563cSPaul Mackerras printk("hmmm, int tree for %s doesn't have ctrler\n", 2689b6b563cSPaul Mackerras np->full_name); 2699b6b563cSPaul Mackerras #endif 2709b6b563cSPaul Mackerras return 0; 2719b6b563cSPaul Mackerras } 2729b6b563cSPaul Mackerras *irq = ints; 2739b6b563cSPaul Mackerras *ictrler = p; 2749b6b563cSPaul Mackerras return nintrc; 2759b6b563cSPaul Mackerras } 2769b6b563cSPaul Mackerras 2776d0124fcSPaul Mackerras static unsigned char map_isa_senses[4] = { 2786d0124fcSPaul Mackerras IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE, 2796d0124fcSPaul Mackerras IRQ_SENSE_LEVEL | IRQ_POLARITY_POSITIVE, 2806d0124fcSPaul Mackerras IRQ_SENSE_EDGE | IRQ_POLARITY_NEGATIVE, 2816d0124fcSPaul Mackerras IRQ_SENSE_EDGE | IRQ_POLARITY_POSITIVE 2826d0124fcSPaul Mackerras }; 2836d0124fcSPaul Mackerras 2846d0124fcSPaul Mackerras static unsigned char map_mpic_senses[4] = { 2856d0124fcSPaul Mackerras IRQ_SENSE_EDGE | IRQ_POLARITY_POSITIVE, 2866d0124fcSPaul Mackerras IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE, 2876d0124fcSPaul Mackerras /* 2 seems to be used for the 8259 cascade... */ 2886d0124fcSPaul Mackerras IRQ_SENSE_LEVEL | IRQ_POLARITY_POSITIVE, 2896d0124fcSPaul Mackerras IRQ_SENSE_EDGE | IRQ_POLARITY_NEGATIVE, 2906d0124fcSPaul Mackerras }; 2916d0124fcSPaul Mackerras 2929b6b563cSPaul Mackerras static int __devinit finish_node_interrupts(struct device_node *np, 2939b6b563cSPaul Mackerras unsigned long *mem_start, 2949b6b563cSPaul Mackerras int measure_only) 2959b6b563cSPaul Mackerras { 2969b6b563cSPaul Mackerras unsigned int *ints; 2979b6b563cSPaul Mackerras int intlen, intrcells, intrcount; 2986d0124fcSPaul Mackerras int i, j, n, sense; 2999b6b563cSPaul Mackerras unsigned int *irq, virq; 3009b6b563cSPaul Mackerras struct device_node *ic; 3011beb6a7dSBenjamin Herrenschmidt int trace = 0; 3021beb6a7dSBenjamin Herrenschmidt 3031beb6a7dSBenjamin Herrenschmidt //#define TRACE(fmt...) do { if (trace) { printk(fmt); mdelay(1000); } } while(0) 3041beb6a7dSBenjamin Herrenschmidt #define TRACE(fmt...) 3051beb6a7dSBenjamin Herrenschmidt 3061beb6a7dSBenjamin Herrenschmidt if (!strcmp(np->name, "smu-doorbell")) 3071beb6a7dSBenjamin Herrenschmidt trace = 1; 3081beb6a7dSBenjamin Herrenschmidt 3091beb6a7dSBenjamin Herrenschmidt TRACE("Finishing SMU doorbell ! num_interrupt_controllers = %d\n", 3101beb6a7dSBenjamin Herrenschmidt num_interrupt_controllers); 3119b6b563cSPaul Mackerras 312a575b807SPaul Mackerras if (num_interrupt_controllers == 0) { 313a575b807SPaul Mackerras /* 314a575b807SPaul Mackerras * Old machines just have a list of interrupt numbers 315a575b807SPaul Mackerras * and no interrupt-controller nodes. 316a575b807SPaul Mackerras */ 317a575b807SPaul Mackerras ints = (unsigned int *) get_property(np, "AAPL,interrupts", 318a575b807SPaul Mackerras &intlen); 319a575b807SPaul Mackerras /* XXX old interpret_pci_props looked in parent too */ 320a575b807SPaul Mackerras /* XXX old interpret_macio_props looked for interrupts 321a575b807SPaul Mackerras before AAPL,interrupts */ 322a575b807SPaul Mackerras if (ints == NULL) 323a575b807SPaul Mackerras ints = (unsigned int *) get_property(np, "interrupts", 324a575b807SPaul Mackerras &intlen); 325a575b807SPaul Mackerras if (ints == NULL) 326a575b807SPaul Mackerras return 0; 327a575b807SPaul Mackerras 328a575b807SPaul Mackerras np->n_intrs = intlen / sizeof(unsigned int); 329a575b807SPaul Mackerras np->intrs = prom_alloc(np->n_intrs * sizeof(np->intrs[0]), 330a575b807SPaul Mackerras mem_start); 331a575b807SPaul Mackerras if (!np->intrs) 332a575b807SPaul Mackerras return -ENOMEM; 333a575b807SPaul Mackerras if (measure_only) 334a575b807SPaul Mackerras return 0; 335a575b807SPaul Mackerras 336a575b807SPaul Mackerras for (i = 0; i < np->n_intrs; ++i) { 337a575b807SPaul Mackerras np->intrs[i].line = *ints++; 3386d0124fcSPaul Mackerras np->intrs[i].sense = IRQ_SENSE_LEVEL 3396d0124fcSPaul Mackerras | IRQ_POLARITY_NEGATIVE; 340a575b807SPaul Mackerras } 341a575b807SPaul Mackerras return 0; 342a575b807SPaul Mackerras } 343a575b807SPaul Mackerras 3449b6b563cSPaul Mackerras ints = (unsigned int *) get_property(np, "interrupts", &intlen); 3451beb6a7dSBenjamin Herrenschmidt TRACE("ints=%p, intlen=%d\n", ints, intlen); 3469b6b563cSPaul Mackerras if (ints == NULL) 3479b6b563cSPaul Mackerras return 0; 3489b6b563cSPaul Mackerras intrcells = prom_n_intr_cells(np); 3499b6b563cSPaul Mackerras intlen /= intrcells * sizeof(unsigned int); 3501beb6a7dSBenjamin Herrenschmidt TRACE("intrcells=%d, new intlen=%d\n", intrcells, intlen); 3519b6b563cSPaul Mackerras np->intrs = prom_alloc(intlen * sizeof(*(np->intrs)), mem_start); 3529b6b563cSPaul Mackerras if (!np->intrs) 3539b6b563cSPaul Mackerras return -ENOMEM; 3549b6b563cSPaul Mackerras 3559b6b563cSPaul Mackerras if (measure_only) 3569b6b563cSPaul Mackerras return 0; 3579b6b563cSPaul Mackerras 3589b6b563cSPaul Mackerras intrcount = 0; 3599b6b563cSPaul Mackerras for (i = 0; i < intlen; ++i, ints += intrcells) { 3609b6b563cSPaul Mackerras n = map_interrupt(&irq, &ic, np, ints, intrcells); 3611beb6a7dSBenjamin Herrenschmidt TRACE("map, irq=%d, ic=%p, n=%d\n", irq, ic, n); 3629b6b563cSPaul Mackerras if (n <= 0) 3639b6b563cSPaul Mackerras continue; 3649b6b563cSPaul Mackerras 3659b6b563cSPaul Mackerras /* don't map IRQ numbers under a cascaded 8259 controller */ 3669b6b563cSPaul Mackerras if (ic && device_is_compatible(ic, "chrp,iic")) { 3679b6b563cSPaul Mackerras np->intrs[intrcount].line = irq[0]; 3686d0124fcSPaul Mackerras sense = (n > 1)? (irq[1] & 3): 3; 3696d0124fcSPaul Mackerras np->intrs[intrcount].sense = map_isa_senses[sense]; 3709b6b563cSPaul Mackerras } else { 3719b6b563cSPaul Mackerras virq = virt_irq_create_mapping(irq[0]); 3721beb6a7dSBenjamin Herrenschmidt TRACE("virq=%d\n", virq); 3736d0124fcSPaul Mackerras #ifdef CONFIG_PPC64 3749b6b563cSPaul Mackerras if (virq == NO_IRQ) { 3759b6b563cSPaul Mackerras printk(KERN_CRIT "Could not allocate interrupt" 3769b6b563cSPaul Mackerras " number for %s\n", np->full_name); 3779b6b563cSPaul Mackerras continue; 3789b6b563cSPaul Mackerras } 3799b6b563cSPaul Mackerras #endif 3806d0124fcSPaul Mackerras np->intrs[intrcount].line = irq_offset_up(virq); 3816d0124fcSPaul Mackerras sense = (n > 1)? (irq[1] & 3): 1; 3821beb6a7dSBenjamin Herrenschmidt 3831beb6a7dSBenjamin Herrenschmidt /* Apple uses bits in there in a different way, let's 3841beb6a7dSBenjamin Herrenschmidt * only keep the real sense bit on macs 3851beb6a7dSBenjamin Herrenschmidt */ 386e8222502SBenjamin Herrenschmidt if (machine_is(powermac)) 3871beb6a7dSBenjamin Herrenschmidt sense &= 0x1; 3886d0124fcSPaul Mackerras np->intrs[intrcount].sense = map_mpic_senses[sense]; 3899b6b563cSPaul Mackerras } 3909b6b563cSPaul Mackerras 3919b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 3929b6b563cSPaul Mackerras /* We offset irq numbers for the u3 MPIC by 128 in PowerMac */ 393e8222502SBenjamin Herrenschmidt if (machine_is(powermac) && ic && ic->parent) { 3949b6b563cSPaul Mackerras char *name = get_property(ic->parent, "name", NULL); 3959b6b563cSPaul Mackerras if (name && !strcmp(name, "u3")) 3969b6b563cSPaul Mackerras np->intrs[intrcount].line += 128; 3971beb6a7dSBenjamin Herrenschmidt else if (!(name && (!strcmp(name, "mac-io") || 3981beb6a7dSBenjamin Herrenschmidt !strcmp(name, "u4")))) 3999b6b563cSPaul Mackerras /* ignore other cascaded controllers, such as 4009b6b563cSPaul Mackerras the k2-sata-root */ 4019b6b563cSPaul Mackerras break; 4029b6b563cSPaul Mackerras } 4031beb6a7dSBenjamin Herrenschmidt #endif /* CONFIG_PPC64 */ 4049b6b563cSPaul Mackerras if (n > 2) { 4059b6b563cSPaul Mackerras printk("hmmm, got %d intr cells for %s:", n, 4069b6b563cSPaul Mackerras np->full_name); 4079b6b563cSPaul Mackerras for (j = 0; j < n; ++j) 4089b6b563cSPaul Mackerras printk(" %d", irq[j]); 4099b6b563cSPaul Mackerras printk("\n"); 4109b6b563cSPaul Mackerras } 4119b6b563cSPaul Mackerras ++intrcount; 4129b6b563cSPaul Mackerras } 4139b6b563cSPaul Mackerras np->n_intrs = intrcount; 4149b6b563cSPaul Mackerras 4159b6b563cSPaul Mackerras return 0; 4169b6b563cSPaul Mackerras } 4179b6b563cSPaul Mackerras 4189b6b563cSPaul Mackerras static int __devinit finish_node(struct device_node *np, 4199b6b563cSPaul Mackerras unsigned long *mem_start, 4209b6b563cSPaul Mackerras int measure_only) 4219b6b563cSPaul Mackerras { 4229b6b563cSPaul Mackerras struct device_node *child; 423cc5d0189SBenjamin Herrenschmidt int rc = 0; 4249b6b563cSPaul Mackerras 4259b6b563cSPaul Mackerras rc = finish_node_interrupts(np, mem_start, measure_only); 4269b6b563cSPaul Mackerras if (rc) 4279b6b563cSPaul Mackerras goto out; 4289b6b563cSPaul Mackerras 4299b6b563cSPaul Mackerras for (child = np->child; child != NULL; child = child->sibling) { 430cc5d0189SBenjamin Herrenschmidt rc = finish_node(child, mem_start, measure_only); 4319b6b563cSPaul Mackerras if (rc) 4329b6b563cSPaul Mackerras goto out; 4339b6b563cSPaul Mackerras } 4349b6b563cSPaul Mackerras out: 4359b6b563cSPaul Mackerras return rc; 4369b6b563cSPaul Mackerras } 4379b6b563cSPaul Mackerras 4389b6b563cSPaul Mackerras static void __init scan_interrupt_controllers(void) 4399b6b563cSPaul Mackerras { 4409b6b563cSPaul Mackerras struct device_node *np; 4419b6b563cSPaul Mackerras int n = 0; 4429b6b563cSPaul Mackerras char *name, *ic; 4439b6b563cSPaul Mackerras int iclen; 4449b6b563cSPaul Mackerras 4459b6b563cSPaul Mackerras for (np = allnodes; np != NULL; np = np->allnext) { 4469b6b563cSPaul Mackerras ic = get_property(np, "interrupt-controller", &iclen); 4479b6b563cSPaul Mackerras name = get_property(np, "name", NULL); 4489b6b563cSPaul Mackerras /* checking iclen makes sure we don't get a false 4499b6b563cSPaul Mackerras match on /chosen.interrupt_controller */ 4509b6b563cSPaul Mackerras if ((name != NULL 4519b6b563cSPaul Mackerras && strcmp(name, "interrupt-controller") == 0) 4529b6b563cSPaul Mackerras || (ic != NULL && iclen == 0 4539b6b563cSPaul Mackerras && strcmp(name, "AppleKiwi"))) { 4549b6b563cSPaul Mackerras if (n == 0) 4559b6b563cSPaul Mackerras dflt_interrupt_controller = np; 4569b6b563cSPaul Mackerras ++n; 4579b6b563cSPaul Mackerras } 4589b6b563cSPaul Mackerras } 4599b6b563cSPaul Mackerras num_interrupt_controllers = n; 4609b6b563cSPaul Mackerras } 4619b6b563cSPaul Mackerras 4629b6b563cSPaul Mackerras /** 4639b6b563cSPaul Mackerras * finish_device_tree is called once things are running normally 4649b6b563cSPaul Mackerras * (i.e. with text and data mapped to the address they were linked at). 4659b6b563cSPaul Mackerras * It traverses the device tree and fills in some of the additional, 4669b6b563cSPaul Mackerras * fields in each node like {n_}addrs and {n_}intrs, the virt interrupt 4679b6b563cSPaul Mackerras * mapping is also initialized at this point. 4689b6b563cSPaul Mackerras */ 4699b6b563cSPaul Mackerras void __init finish_device_tree(void) 4709b6b563cSPaul Mackerras { 4719b6b563cSPaul Mackerras unsigned long start, end, size = 0; 4729b6b563cSPaul Mackerras 4739b6b563cSPaul Mackerras DBG(" -> finish_device_tree\n"); 4749b6b563cSPaul Mackerras 4759b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 4769b6b563cSPaul Mackerras /* Initialize virtual IRQ map */ 4779b6b563cSPaul Mackerras virt_irq_init(); 4789b6b563cSPaul Mackerras #endif 4799b6b563cSPaul Mackerras scan_interrupt_controllers(); 4809b6b563cSPaul Mackerras 4819b6b563cSPaul Mackerras /* 4829b6b563cSPaul Mackerras * Finish device-tree (pre-parsing some properties etc...) 4839b6b563cSPaul Mackerras * We do this in 2 passes. One with "measure_only" set, which 4849b6b563cSPaul Mackerras * will only measure the amount of memory needed, then we can 4859b6b563cSPaul Mackerras * allocate that memory, and call finish_node again. However, 4869b6b563cSPaul Mackerras * we must be careful as most routines will fail nowadays when 4879b6b563cSPaul Mackerras * prom_alloc() returns 0, so we must make sure our first pass 4889b6b563cSPaul Mackerras * doesn't start at 0. We pre-initialize size to 16 for that 4899b6b563cSPaul Mackerras * reason and then remove those additional 16 bytes 4909b6b563cSPaul Mackerras */ 4919b6b563cSPaul Mackerras size = 16; 492cc5d0189SBenjamin Herrenschmidt finish_node(allnodes, &size, 1); 4939b6b563cSPaul Mackerras size -= 16; 494fa938953SMichael Ellerman 495fa938953SMichael Ellerman if (0 == size) 496fa938953SMichael Ellerman end = start = 0; 497fa938953SMichael Ellerman else 4989b6b563cSPaul Mackerras end = start = (unsigned long)__va(lmb_alloc(size, 128)); 499fa938953SMichael Ellerman 500cc5d0189SBenjamin Herrenschmidt finish_node(allnodes, &end, 0); 5019b6b563cSPaul Mackerras BUG_ON(end != start + size); 5029b6b563cSPaul Mackerras 5039b6b563cSPaul Mackerras DBG(" <- finish_device_tree\n"); 5049b6b563cSPaul Mackerras } 5059b6b563cSPaul Mackerras 5069b6b563cSPaul Mackerras static inline char *find_flat_dt_string(u32 offset) 5079b6b563cSPaul Mackerras { 5089b6b563cSPaul Mackerras return ((char *)initial_boot_params) + 5099b6b563cSPaul Mackerras initial_boot_params->off_dt_strings + offset; 5109b6b563cSPaul Mackerras } 5119b6b563cSPaul Mackerras 5129b6b563cSPaul Mackerras /** 5139b6b563cSPaul Mackerras * This function is used to scan the flattened device-tree, it is 5149b6b563cSPaul Mackerras * used to extract the memory informations at boot before we can 5159b6b563cSPaul Mackerras * unflatten the tree 5169b6b563cSPaul Mackerras */ 5173c726f8dSBenjamin Herrenschmidt int __init of_scan_flat_dt(int (*it)(unsigned long node, 5189b6b563cSPaul Mackerras const char *uname, int depth, 5199b6b563cSPaul Mackerras void *data), 5209b6b563cSPaul Mackerras void *data) 5219b6b563cSPaul Mackerras { 5229b6b563cSPaul Mackerras unsigned long p = ((unsigned long)initial_boot_params) + 5239b6b563cSPaul Mackerras initial_boot_params->off_dt_struct; 5249b6b563cSPaul Mackerras int rc = 0; 5259b6b563cSPaul Mackerras int depth = -1; 5269b6b563cSPaul Mackerras 5279b6b563cSPaul Mackerras do { 5289b6b563cSPaul Mackerras u32 tag = *((u32 *)p); 5299b6b563cSPaul Mackerras char *pathp; 5309b6b563cSPaul Mackerras 5319b6b563cSPaul Mackerras p += 4; 5329b6b563cSPaul Mackerras if (tag == OF_DT_END_NODE) { 5339b6b563cSPaul Mackerras depth --; 5349b6b563cSPaul Mackerras continue; 5359b6b563cSPaul Mackerras } 5369b6b563cSPaul Mackerras if (tag == OF_DT_NOP) 5379b6b563cSPaul Mackerras continue; 5389b6b563cSPaul Mackerras if (tag == OF_DT_END) 5399b6b563cSPaul Mackerras break; 5409b6b563cSPaul Mackerras if (tag == OF_DT_PROP) { 5419b6b563cSPaul Mackerras u32 sz = *((u32 *)p); 5429b6b563cSPaul Mackerras p += 8; 5439b6b563cSPaul Mackerras if (initial_boot_params->version < 0x10) 5449b6b563cSPaul Mackerras p = _ALIGN(p, sz >= 8 ? 8 : 4); 5459b6b563cSPaul Mackerras p += sz; 5469b6b563cSPaul Mackerras p = _ALIGN(p, 4); 5479b6b563cSPaul Mackerras continue; 5489b6b563cSPaul Mackerras } 5499b6b563cSPaul Mackerras if (tag != OF_DT_BEGIN_NODE) { 5509b6b563cSPaul Mackerras printk(KERN_WARNING "Invalid tag %x scanning flattened" 5519b6b563cSPaul Mackerras " device tree !\n", tag); 5529b6b563cSPaul Mackerras return -EINVAL; 5539b6b563cSPaul Mackerras } 5549b6b563cSPaul Mackerras depth++; 5559b6b563cSPaul Mackerras pathp = (char *)p; 5569b6b563cSPaul Mackerras p = _ALIGN(p + strlen(pathp) + 1, 4); 5579b6b563cSPaul Mackerras if ((*pathp) == '/') { 5589b6b563cSPaul Mackerras char *lp, *np; 5599b6b563cSPaul Mackerras for (lp = NULL, np = pathp; *np; np++) 5609b6b563cSPaul Mackerras if ((*np) == '/') 5619b6b563cSPaul Mackerras lp = np+1; 5629b6b563cSPaul Mackerras if (lp != NULL) 5639b6b563cSPaul Mackerras pathp = lp; 5649b6b563cSPaul Mackerras } 5659b6b563cSPaul Mackerras rc = it(p, pathp, depth, data); 5669b6b563cSPaul Mackerras if (rc != 0) 5679b6b563cSPaul Mackerras break; 5689b6b563cSPaul Mackerras } while(1); 5699b6b563cSPaul Mackerras 5709b6b563cSPaul Mackerras return rc; 5719b6b563cSPaul Mackerras } 5729b6b563cSPaul Mackerras 573e8222502SBenjamin Herrenschmidt unsigned long __init of_get_flat_dt_root(void) 574e8222502SBenjamin Herrenschmidt { 575e8222502SBenjamin Herrenschmidt unsigned long p = ((unsigned long)initial_boot_params) + 576e8222502SBenjamin Herrenschmidt initial_boot_params->off_dt_struct; 577e8222502SBenjamin Herrenschmidt 578e8222502SBenjamin Herrenschmidt while(*((u32 *)p) == OF_DT_NOP) 579e8222502SBenjamin Herrenschmidt p += 4; 580e8222502SBenjamin Herrenschmidt BUG_ON (*((u32 *)p) != OF_DT_BEGIN_NODE); 581e8222502SBenjamin Herrenschmidt p += 4; 582e8222502SBenjamin Herrenschmidt return _ALIGN(p + strlen((char *)p) + 1, 4); 583e8222502SBenjamin Herrenschmidt } 584e8222502SBenjamin Herrenschmidt 5859b6b563cSPaul Mackerras /** 5869b6b563cSPaul Mackerras * This function can be used within scan_flattened_dt callback to get 5879b6b563cSPaul Mackerras * access to properties 5889b6b563cSPaul Mackerras */ 5893c726f8dSBenjamin Herrenschmidt void* __init of_get_flat_dt_prop(unsigned long node, const char *name, 5909b6b563cSPaul Mackerras unsigned long *size) 5919b6b563cSPaul Mackerras { 5929b6b563cSPaul Mackerras unsigned long p = node; 5939b6b563cSPaul Mackerras 5949b6b563cSPaul Mackerras do { 5959b6b563cSPaul Mackerras u32 tag = *((u32 *)p); 5969b6b563cSPaul Mackerras u32 sz, noff; 5979b6b563cSPaul Mackerras const char *nstr; 5989b6b563cSPaul Mackerras 5999b6b563cSPaul Mackerras p += 4; 6009b6b563cSPaul Mackerras if (tag == OF_DT_NOP) 6019b6b563cSPaul Mackerras continue; 6029b6b563cSPaul Mackerras if (tag != OF_DT_PROP) 6039b6b563cSPaul Mackerras return NULL; 6049b6b563cSPaul Mackerras 6059b6b563cSPaul Mackerras sz = *((u32 *)p); 6069b6b563cSPaul Mackerras noff = *((u32 *)(p + 4)); 6079b6b563cSPaul Mackerras p += 8; 6089b6b563cSPaul Mackerras if (initial_boot_params->version < 0x10) 6099b6b563cSPaul Mackerras p = _ALIGN(p, sz >= 8 ? 8 : 4); 6109b6b563cSPaul Mackerras 6119b6b563cSPaul Mackerras nstr = find_flat_dt_string(noff); 6129b6b563cSPaul Mackerras if (nstr == NULL) { 6139b6b563cSPaul Mackerras printk(KERN_WARNING "Can't find property index" 6149b6b563cSPaul Mackerras " name !\n"); 6159b6b563cSPaul Mackerras return NULL; 6169b6b563cSPaul Mackerras } 6179b6b563cSPaul Mackerras if (strcmp(name, nstr) == 0) { 6189b6b563cSPaul Mackerras if (size) 6199b6b563cSPaul Mackerras *size = sz; 6209b6b563cSPaul Mackerras return (void *)p; 6219b6b563cSPaul Mackerras } 6229b6b563cSPaul Mackerras p += sz; 6239b6b563cSPaul Mackerras p = _ALIGN(p, 4); 6249b6b563cSPaul Mackerras } while(1); 6259b6b563cSPaul Mackerras } 6269b6b563cSPaul Mackerras 627e8222502SBenjamin Herrenschmidt int __init of_flat_dt_is_compatible(unsigned long node, const char *compat) 628e8222502SBenjamin Herrenschmidt { 629e8222502SBenjamin Herrenschmidt const char* cp; 630e8222502SBenjamin Herrenschmidt unsigned long cplen, l; 631e8222502SBenjamin Herrenschmidt 632e8222502SBenjamin Herrenschmidt cp = of_get_flat_dt_prop(node, "compatible", &cplen); 633e8222502SBenjamin Herrenschmidt if (cp == NULL) 634e8222502SBenjamin Herrenschmidt return 0; 635e8222502SBenjamin Herrenschmidt while (cplen > 0) { 636e8222502SBenjamin Herrenschmidt if (strncasecmp(cp, compat, strlen(compat)) == 0) 637e8222502SBenjamin Herrenschmidt return 1; 638e8222502SBenjamin Herrenschmidt l = strlen(cp) + 1; 639e8222502SBenjamin Herrenschmidt cp += l; 640e8222502SBenjamin Herrenschmidt cplen -= l; 641e8222502SBenjamin Herrenschmidt } 642e8222502SBenjamin Herrenschmidt 643e8222502SBenjamin Herrenschmidt return 0; 644e8222502SBenjamin Herrenschmidt } 645e8222502SBenjamin Herrenschmidt 6469b6b563cSPaul Mackerras static void *__init unflatten_dt_alloc(unsigned long *mem, unsigned long size, 6479b6b563cSPaul Mackerras unsigned long align) 6489b6b563cSPaul Mackerras { 6499b6b563cSPaul Mackerras void *res; 6509b6b563cSPaul Mackerras 6519b6b563cSPaul Mackerras *mem = _ALIGN(*mem, align); 6529b6b563cSPaul Mackerras res = (void *)*mem; 6539b6b563cSPaul Mackerras *mem += size; 6549b6b563cSPaul Mackerras 6559b6b563cSPaul Mackerras return res; 6569b6b563cSPaul Mackerras } 6579b6b563cSPaul Mackerras 6589b6b563cSPaul Mackerras static unsigned long __init unflatten_dt_node(unsigned long mem, 6599b6b563cSPaul Mackerras unsigned long *p, 6609b6b563cSPaul Mackerras struct device_node *dad, 6619b6b563cSPaul Mackerras struct device_node ***allnextpp, 6629b6b563cSPaul Mackerras unsigned long fpsize) 6639b6b563cSPaul Mackerras { 6649b6b563cSPaul Mackerras struct device_node *np; 6659b6b563cSPaul Mackerras struct property *pp, **prev_pp = NULL; 6669b6b563cSPaul Mackerras char *pathp; 6679b6b563cSPaul Mackerras u32 tag; 6689b6b563cSPaul Mackerras unsigned int l, allocl; 6699b6b563cSPaul Mackerras int has_name = 0; 6709b6b563cSPaul Mackerras int new_format = 0; 6719b6b563cSPaul Mackerras 6729b6b563cSPaul Mackerras tag = *((u32 *)(*p)); 6739b6b563cSPaul Mackerras if (tag != OF_DT_BEGIN_NODE) { 6749b6b563cSPaul Mackerras printk("Weird tag at start of node: %x\n", tag); 6759b6b563cSPaul Mackerras return mem; 6769b6b563cSPaul Mackerras } 6779b6b563cSPaul Mackerras *p += 4; 6789b6b563cSPaul Mackerras pathp = (char *)*p; 6799b6b563cSPaul Mackerras l = allocl = strlen(pathp) + 1; 6809b6b563cSPaul Mackerras *p = _ALIGN(*p + l, 4); 6819b6b563cSPaul Mackerras 6829b6b563cSPaul Mackerras /* version 0x10 has a more compact unit name here instead of the full 6839b6b563cSPaul Mackerras * path. we accumulate the full path size using "fpsize", we'll rebuild 6849b6b563cSPaul Mackerras * it later. We detect this because the first character of the name is 6859b6b563cSPaul Mackerras * not '/'. 6869b6b563cSPaul Mackerras */ 6879b6b563cSPaul Mackerras if ((*pathp) != '/') { 6889b6b563cSPaul Mackerras new_format = 1; 6899b6b563cSPaul Mackerras if (fpsize == 0) { 6909b6b563cSPaul Mackerras /* root node: special case. fpsize accounts for path 6919b6b563cSPaul Mackerras * plus terminating zero. root node only has '/', so 6929b6b563cSPaul Mackerras * fpsize should be 2, but we want to avoid the first 6939b6b563cSPaul Mackerras * level nodes to have two '/' so we use fpsize 1 here 6949b6b563cSPaul Mackerras */ 6959b6b563cSPaul Mackerras fpsize = 1; 6969b6b563cSPaul Mackerras allocl = 2; 6979b6b563cSPaul Mackerras } else { 6989b6b563cSPaul Mackerras /* account for '/' and path size minus terminal 0 6999b6b563cSPaul Mackerras * already in 'l' 7009b6b563cSPaul Mackerras */ 7019b6b563cSPaul Mackerras fpsize += l; 7029b6b563cSPaul Mackerras allocl = fpsize; 7039b6b563cSPaul Mackerras } 7049b6b563cSPaul Mackerras } 7059b6b563cSPaul Mackerras 7069b6b563cSPaul Mackerras 7079b6b563cSPaul Mackerras np = unflatten_dt_alloc(&mem, sizeof(struct device_node) + allocl, 7089b6b563cSPaul Mackerras __alignof__(struct device_node)); 7099b6b563cSPaul Mackerras if (allnextpp) { 7109b6b563cSPaul Mackerras memset(np, 0, sizeof(*np)); 7119b6b563cSPaul Mackerras np->full_name = ((char*)np) + sizeof(struct device_node); 7129b6b563cSPaul Mackerras if (new_format) { 7139b6b563cSPaul Mackerras char *p = np->full_name; 7149b6b563cSPaul Mackerras /* rebuild full path for new format */ 7159b6b563cSPaul Mackerras if (dad && dad->parent) { 7169b6b563cSPaul Mackerras strcpy(p, dad->full_name); 7179b6b563cSPaul Mackerras #ifdef DEBUG 7189b6b563cSPaul Mackerras if ((strlen(p) + l + 1) != allocl) { 7199b6b563cSPaul Mackerras DBG("%s: p: %d, l: %d, a: %d\n", 720e8222502SBenjamin Herrenschmidt pathp, (int)strlen(p), l, allocl); 7219b6b563cSPaul Mackerras } 7229b6b563cSPaul Mackerras #endif 7239b6b563cSPaul Mackerras p += strlen(p); 7249b6b563cSPaul Mackerras } 7259b6b563cSPaul Mackerras *(p++) = '/'; 7269b6b563cSPaul Mackerras memcpy(p, pathp, l); 7279b6b563cSPaul Mackerras } else 7289b6b563cSPaul Mackerras memcpy(np->full_name, pathp, l); 7299b6b563cSPaul Mackerras prev_pp = &np->properties; 7309b6b563cSPaul Mackerras **allnextpp = np; 7319b6b563cSPaul Mackerras *allnextpp = &np->allnext; 7329b6b563cSPaul Mackerras if (dad != NULL) { 7339b6b563cSPaul Mackerras np->parent = dad; 7349b6b563cSPaul Mackerras /* we temporarily use the next field as `last_child'*/ 7359b6b563cSPaul Mackerras if (dad->next == 0) 7369b6b563cSPaul Mackerras dad->child = np; 7379b6b563cSPaul Mackerras else 7389b6b563cSPaul Mackerras dad->next->sibling = np; 7399b6b563cSPaul Mackerras dad->next = np; 7409b6b563cSPaul Mackerras } 7419b6b563cSPaul Mackerras kref_init(&np->kref); 7429b6b563cSPaul Mackerras } 7439b6b563cSPaul Mackerras while(1) { 7449b6b563cSPaul Mackerras u32 sz, noff; 7459b6b563cSPaul Mackerras char *pname; 7469b6b563cSPaul Mackerras 7479b6b563cSPaul Mackerras tag = *((u32 *)(*p)); 7489b6b563cSPaul Mackerras if (tag == OF_DT_NOP) { 7499b6b563cSPaul Mackerras *p += 4; 7509b6b563cSPaul Mackerras continue; 7519b6b563cSPaul Mackerras } 7529b6b563cSPaul Mackerras if (tag != OF_DT_PROP) 7539b6b563cSPaul Mackerras break; 7549b6b563cSPaul Mackerras *p += 4; 7559b6b563cSPaul Mackerras sz = *((u32 *)(*p)); 7569b6b563cSPaul Mackerras noff = *((u32 *)((*p) + 4)); 7579b6b563cSPaul Mackerras *p += 8; 7589b6b563cSPaul Mackerras if (initial_boot_params->version < 0x10) 7599b6b563cSPaul Mackerras *p = _ALIGN(*p, sz >= 8 ? 8 : 4); 7609b6b563cSPaul Mackerras 7619b6b563cSPaul Mackerras pname = find_flat_dt_string(noff); 7629b6b563cSPaul Mackerras if (pname == NULL) { 7639b6b563cSPaul Mackerras printk("Can't find property name in list !\n"); 7649b6b563cSPaul Mackerras break; 7659b6b563cSPaul Mackerras } 7669b6b563cSPaul Mackerras if (strcmp(pname, "name") == 0) 7679b6b563cSPaul Mackerras has_name = 1; 7689b6b563cSPaul Mackerras l = strlen(pname) + 1; 7699b6b563cSPaul Mackerras pp = unflatten_dt_alloc(&mem, sizeof(struct property), 7709b6b563cSPaul Mackerras __alignof__(struct property)); 7719b6b563cSPaul Mackerras if (allnextpp) { 7729b6b563cSPaul Mackerras if (strcmp(pname, "linux,phandle") == 0) { 7739b6b563cSPaul Mackerras np->node = *((u32 *)*p); 7749b6b563cSPaul Mackerras if (np->linux_phandle == 0) 7759b6b563cSPaul Mackerras np->linux_phandle = np->node; 7769b6b563cSPaul Mackerras } 7779b6b563cSPaul Mackerras if (strcmp(pname, "ibm,phandle") == 0) 7789b6b563cSPaul Mackerras np->linux_phandle = *((u32 *)*p); 7799b6b563cSPaul Mackerras pp->name = pname; 7809b6b563cSPaul Mackerras pp->length = sz; 7819b6b563cSPaul Mackerras pp->value = (void *)*p; 7829b6b563cSPaul Mackerras *prev_pp = pp; 7839b6b563cSPaul Mackerras prev_pp = &pp->next; 7849b6b563cSPaul Mackerras } 7859b6b563cSPaul Mackerras *p = _ALIGN((*p) + sz, 4); 7869b6b563cSPaul Mackerras } 7879b6b563cSPaul Mackerras /* with version 0x10 we may not have the name property, recreate 7889b6b563cSPaul Mackerras * it here from the unit name if absent 7899b6b563cSPaul Mackerras */ 7909b6b563cSPaul Mackerras if (!has_name) { 7919b6b563cSPaul Mackerras char *p = pathp, *ps = pathp, *pa = NULL; 7929b6b563cSPaul Mackerras int sz; 7939b6b563cSPaul Mackerras 7949b6b563cSPaul Mackerras while (*p) { 7959b6b563cSPaul Mackerras if ((*p) == '@') 7969b6b563cSPaul Mackerras pa = p; 7979b6b563cSPaul Mackerras if ((*p) == '/') 7989b6b563cSPaul Mackerras ps = p + 1; 7999b6b563cSPaul Mackerras p++; 8009b6b563cSPaul Mackerras } 8019b6b563cSPaul Mackerras if (pa < ps) 8029b6b563cSPaul Mackerras pa = p; 8039b6b563cSPaul Mackerras sz = (pa - ps) + 1; 8049b6b563cSPaul Mackerras pp = unflatten_dt_alloc(&mem, sizeof(struct property) + sz, 8059b6b563cSPaul Mackerras __alignof__(struct property)); 8069b6b563cSPaul Mackerras if (allnextpp) { 8079b6b563cSPaul Mackerras pp->name = "name"; 8089b6b563cSPaul Mackerras pp->length = sz; 8099b6b563cSPaul Mackerras pp->value = (unsigned char *)(pp + 1); 8109b6b563cSPaul Mackerras *prev_pp = pp; 8119b6b563cSPaul Mackerras prev_pp = &pp->next; 8129b6b563cSPaul Mackerras memcpy(pp->value, ps, sz - 1); 8139b6b563cSPaul Mackerras ((char *)pp->value)[sz - 1] = 0; 8149b6b563cSPaul Mackerras DBG("fixed up name for %s -> %s\n", pathp, pp->value); 8159b6b563cSPaul Mackerras } 8169b6b563cSPaul Mackerras } 8179b6b563cSPaul Mackerras if (allnextpp) { 8189b6b563cSPaul Mackerras *prev_pp = NULL; 8199b6b563cSPaul Mackerras np->name = get_property(np, "name", NULL); 8209b6b563cSPaul Mackerras np->type = get_property(np, "device_type", NULL); 8219b6b563cSPaul Mackerras 8229b6b563cSPaul Mackerras if (!np->name) 8239b6b563cSPaul Mackerras np->name = "<NULL>"; 8249b6b563cSPaul Mackerras if (!np->type) 8259b6b563cSPaul Mackerras np->type = "<NULL>"; 8269b6b563cSPaul Mackerras } 8279b6b563cSPaul Mackerras while (tag == OF_DT_BEGIN_NODE) { 8289b6b563cSPaul Mackerras mem = unflatten_dt_node(mem, p, np, allnextpp, fpsize); 8299b6b563cSPaul Mackerras tag = *((u32 *)(*p)); 8309b6b563cSPaul Mackerras } 8319b6b563cSPaul Mackerras if (tag != OF_DT_END_NODE) { 8329b6b563cSPaul Mackerras printk("Weird tag at end of node: %x\n", tag); 8339b6b563cSPaul Mackerras return mem; 8349b6b563cSPaul Mackerras } 8359b6b563cSPaul Mackerras *p += 4; 8369b6b563cSPaul Mackerras return mem; 8379b6b563cSPaul Mackerras } 8389b6b563cSPaul Mackerras 8399b6b563cSPaul Mackerras 8409b6b563cSPaul Mackerras /** 8419b6b563cSPaul Mackerras * unflattens the device-tree passed by the firmware, creating the 8429b6b563cSPaul Mackerras * tree of struct device_node. It also fills the "name" and "type" 8439b6b563cSPaul Mackerras * pointers of the nodes so the normal device-tree walking functions 8449b6b563cSPaul Mackerras * can be used (this used to be done by finish_device_tree) 8459b6b563cSPaul Mackerras */ 8469b6b563cSPaul Mackerras void __init unflatten_device_tree(void) 8479b6b563cSPaul Mackerras { 8489b6b563cSPaul Mackerras unsigned long start, mem, size; 8499b6b563cSPaul Mackerras struct device_node **allnextp = &allnodes; 8509b6b563cSPaul Mackerras 8519b6b563cSPaul Mackerras DBG(" -> unflatten_device_tree()\n"); 8529b6b563cSPaul Mackerras 8539b6b563cSPaul Mackerras /* First pass, scan for size */ 8549b6b563cSPaul Mackerras start = ((unsigned long)initial_boot_params) + 8559b6b563cSPaul Mackerras initial_boot_params->off_dt_struct; 8569b6b563cSPaul Mackerras size = unflatten_dt_node(0, &start, NULL, NULL, 0); 8579b6b563cSPaul Mackerras size = (size | 3) + 1; 8589b6b563cSPaul Mackerras 8599b6b563cSPaul Mackerras DBG(" size is %lx, allocating...\n", size); 8609b6b563cSPaul Mackerras 8619b6b563cSPaul Mackerras /* Allocate memory for the expanded device tree */ 8629b6b563cSPaul Mackerras mem = lmb_alloc(size + 4, __alignof__(struct device_node)); 8639b6b563cSPaul Mackerras mem = (unsigned long) __va(mem); 8649b6b563cSPaul Mackerras 8659b6b563cSPaul Mackerras ((u32 *)mem)[size / 4] = 0xdeadbeef; 8669b6b563cSPaul Mackerras 8679b6b563cSPaul Mackerras DBG(" unflattening %lx...\n", mem); 8689b6b563cSPaul Mackerras 8699b6b563cSPaul Mackerras /* Second pass, do actual unflattening */ 8709b6b563cSPaul Mackerras start = ((unsigned long)initial_boot_params) + 8719b6b563cSPaul Mackerras initial_boot_params->off_dt_struct; 8729b6b563cSPaul Mackerras unflatten_dt_node(mem, &start, NULL, &allnextp, 0); 8739b6b563cSPaul Mackerras if (*((u32 *)start) != OF_DT_END) 8749b6b563cSPaul Mackerras printk(KERN_WARNING "Weird tag at end of tree: %08x\n", *((u32 *)start)); 8759b6b563cSPaul Mackerras if (((u32 *)mem)[size / 4] != 0xdeadbeef) 8769b6b563cSPaul Mackerras printk(KERN_WARNING "End of tree marker overwritten: %08x\n", 8779b6b563cSPaul Mackerras ((u32 *)mem)[size / 4] ); 8789b6b563cSPaul Mackerras *allnextp = NULL; 8799b6b563cSPaul Mackerras 8809b6b563cSPaul Mackerras /* Get pointer to OF "/chosen" node for use everywhere */ 8819b6b563cSPaul Mackerras of_chosen = of_find_node_by_path("/chosen"); 882a575b807SPaul Mackerras if (of_chosen == NULL) 883a575b807SPaul Mackerras of_chosen = of_find_node_by_path("/chosen@0"); 8849b6b563cSPaul Mackerras 8859b6b563cSPaul Mackerras DBG(" <- unflatten_device_tree()\n"); 8869b6b563cSPaul Mackerras } 8879b6b563cSPaul Mackerras 888*d205819eSPaul Mackerras /* 889*d205819eSPaul Mackerras * ibm,pa-features is a per-cpu property that contains a string of 890*d205819eSPaul Mackerras * attribute descriptors, each of which has a 2 byte header plus up 891*d205819eSPaul Mackerras * to 254 bytes worth of processor attribute bits. First header 892*d205819eSPaul Mackerras * byte specifies the number of bytes following the header. 893*d205819eSPaul Mackerras * Second header byte is an "attribute-specifier" type, of which 894*d205819eSPaul Mackerras * zero is the only currently-defined value. 895*d205819eSPaul Mackerras * Implementation: Pass in the byte and bit offset for the feature 896*d205819eSPaul Mackerras * that we are interested in. The function will return -1 if the 897*d205819eSPaul Mackerras * pa-features property is missing, or a 1/0 to indicate if the feature 898*d205819eSPaul Mackerras * is supported/not supported. Note that the bit numbers are 899*d205819eSPaul Mackerras * big-endian to match the definition in PAPR. 900*d205819eSPaul Mackerras */ 901*d205819eSPaul Mackerras static struct ibm_pa_feature { 902*d205819eSPaul Mackerras unsigned long cpu_features; /* CPU_FTR_xxx bit */ 903*d205819eSPaul Mackerras unsigned int cpu_user_ftrs; /* PPC_FEATURE_xxx bit */ 904*d205819eSPaul Mackerras unsigned char pabyte; /* byte number in ibm,pa-features */ 905*d205819eSPaul Mackerras unsigned char pabit; /* bit number (big-endian) */ 906*d205819eSPaul Mackerras unsigned char invert; /* if 1, pa bit set => clear feature */ 907*d205819eSPaul Mackerras } ibm_pa_features[] __initdata = { 908*d205819eSPaul Mackerras {0, PPC_FEATURE_HAS_MMU, 0, 0, 0}, 909*d205819eSPaul Mackerras {0, PPC_FEATURE_HAS_FPU, 0, 1, 0}, 910*d205819eSPaul Mackerras {CPU_FTR_SLB, 0, 0, 2, 0}, 911*d205819eSPaul Mackerras {CPU_FTR_CTRL, 0, 0, 3, 0}, 912*d205819eSPaul Mackerras {CPU_FTR_NOEXECUTE, 0, 0, 6, 0}, 913*d205819eSPaul Mackerras {CPU_FTR_NODSISRALIGN, 0, 1, 1, 1}, 914*d205819eSPaul Mackerras {CPU_FTR_CI_LARGE_PAGE, 0, 1, 2, 0}, 915*d205819eSPaul Mackerras }; 916*d205819eSPaul Mackerras 917*d205819eSPaul Mackerras static void __init check_cpu_pa_features(unsigned long node) 918*d205819eSPaul Mackerras { 919*d205819eSPaul Mackerras unsigned char *pa_ftrs; 920*d205819eSPaul Mackerras unsigned long len, tablelen, i, bit; 921*d205819eSPaul Mackerras 922*d205819eSPaul Mackerras pa_ftrs = of_get_flat_dt_prop(node, "ibm,pa-features", &tablelen); 923*d205819eSPaul Mackerras if (pa_ftrs == NULL) 924*d205819eSPaul Mackerras return; 925*d205819eSPaul Mackerras 926*d205819eSPaul Mackerras /* find descriptor with type == 0 */ 927*d205819eSPaul Mackerras for (;;) { 928*d205819eSPaul Mackerras if (tablelen < 3) 929*d205819eSPaul Mackerras return; 930*d205819eSPaul Mackerras len = 2 + pa_ftrs[0]; 931*d205819eSPaul Mackerras if (tablelen < len) 932*d205819eSPaul Mackerras return; /* descriptor 0 not found */ 933*d205819eSPaul Mackerras if (pa_ftrs[1] == 0) 934*d205819eSPaul Mackerras break; 935*d205819eSPaul Mackerras tablelen -= len; 936*d205819eSPaul Mackerras pa_ftrs += len; 937*d205819eSPaul Mackerras } 938*d205819eSPaul Mackerras 939*d205819eSPaul Mackerras /* loop over bits we know about */ 940*d205819eSPaul Mackerras for (i = 0; i < ARRAY_SIZE(ibm_pa_features); ++i) { 941*d205819eSPaul Mackerras struct ibm_pa_feature *fp = &ibm_pa_features[i]; 942*d205819eSPaul Mackerras 943*d205819eSPaul Mackerras if (fp->pabyte >= pa_ftrs[0]) 944*d205819eSPaul Mackerras continue; 945*d205819eSPaul Mackerras bit = (pa_ftrs[2 + fp->pabyte] >> (7 - fp->pabit)) & 1; 946*d205819eSPaul Mackerras if (bit ^ fp->invert) { 947*d205819eSPaul Mackerras cur_cpu_spec->cpu_features |= fp->cpu_features; 948*d205819eSPaul Mackerras cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftrs; 949*d205819eSPaul Mackerras } else { 950*d205819eSPaul Mackerras cur_cpu_spec->cpu_features &= ~fp->cpu_features; 951*d205819eSPaul Mackerras cur_cpu_spec->cpu_user_features &= ~fp->cpu_user_ftrs; 952*d205819eSPaul Mackerras } 953*d205819eSPaul Mackerras } 954*d205819eSPaul Mackerras } 955*d205819eSPaul Mackerras 9569b6b563cSPaul Mackerras static int __init early_init_dt_scan_cpus(unsigned long node, 9574df20460SAnton Blanchard const char *uname, int depth, 9584df20460SAnton Blanchard void *data) 9599b6b563cSPaul Mackerras { 9604df20460SAnton Blanchard static int logical_cpuid = 0; 9614df20460SAnton Blanchard char *type = of_get_flat_dt_prop(node, "device_type", NULL); 9624d177fbfSStephen Rothwell #ifdef CONFIG_ALTIVEC 9634d177fbfSStephen Rothwell u32 *prop; 9644d177fbfSStephen Rothwell #endif 9654d177fbfSStephen Rothwell u32 *intserv; 9664df20460SAnton Blanchard int i, nthreads; 9674df20460SAnton Blanchard unsigned long len; 9684df20460SAnton Blanchard int found = 0; 9699b6b563cSPaul Mackerras 9709b6b563cSPaul Mackerras /* We are scanning "cpu" nodes only */ 9719b6b563cSPaul Mackerras if (type == NULL || strcmp(type, "cpu") != 0) 9729b6b563cSPaul Mackerras return 0; 9739b6b563cSPaul Mackerras 9744df20460SAnton Blanchard /* Get physical cpuid */ 9754df20460SAnton Blanchard intserv = of_get_flat_dt_prop(node, "ibm,ppc-interrupt-server#s", &len); 9764df20460SAnton Blanchard if (intserv) { 9774df20460SAnton Blanchard nthreads = len / sizeof(int); 9789b6b563cSPaul Mackerras } else { 9794df20460SAnton Blanchard intserv = of_get_flat_dt_prop(node, "reg", NULL); 9804df20460SAnton Blanchard nthreads = 1; 9814df20460SAnton Blanchard } 9824df20460SAnton Blanchard 9834df20460SAnton Blanchard /* 9844df20460SAnton Blanchard * Now see if any of these threads match our boot cpu. 9854df20460SAnton Blanchard * NOTE: This must match the parsing done in smp_setup_cpu_maps. 9864df20460SAnton Blanchard */ 9874df20460SAnton Blanchard for (i = 0; i < nthreads; i++) { 9884df20460SAnton Blanchard /* 9894df20460SAnton Blanchard * version 2 of the kexec param format adds the phys cpuid of 9904df20460SAnton Blanchard * booted proc. 9914df20460SAnton Blanchard */ 9924df20460SAnton Blanchard if (initial_boot_params && initial_boot_params->version >= 2) { 9934df20460SAnton Blanchard if (intserv[i] == 9944df20460SAnton Blanchard initial_boot_params->boot_cpuid_phys) { 9954df20460SAnton Blanchard found = 1; 9964df20460SAnton Blanchard break; 9974df20460SAnton Blanchard } 9984df20460SAnton Blanchard } else { 9994df20460SAnton Blanchard /* 10004df20460SAnton Blanchard * Check if it's the boot-cpu, set it's hw index now, 10014df20460SAnton Blanchard * unfortunately this format did not support booting 10024df20460SAnton Blanchard * off secondary threads. 10034df20460SAnton Blanchard */ 10043c726f8dSBenjamin Herrenschmidt if (of_get_flat_dt_prop(node, 10053c726f8dSBenjamin Herrenschmidt "linux,boot-cpu", NULL) != NULL) { 10064df20460SAnton Blanchard found = 1; 10074df20460SAnton Blanchard break; 10089b6b563cSPaul Mackerras } 10099b6b563cSPaul Mackerras } 10104df20460SAnton Blanchard 10114df20460SAnton Blanchard #ifdef CONFIG_SMP 10124df20460SAnton Blanchard /* logical cpu id is always 0 on UP kernels */ 10134df20460SAnton Blanchard logical_cpuid++; 10144df20460SAnton Blanchard #endif 10154df20460SAnton Blanchard } 10164df20460SAnton Blanchard 10174df20460SAnton Blanchard if (found) { 10184df20460SAnton Blanchard DBG("boot cpu: logical %d physical %d\n", logical_cpuid, 10194df20460SAnton Blanchard intserv[i]); 10204df20460SAnton Blanchard boot_cpuid = logical_cpuid; 10214df20460SAnton Blanchard set_hard_smp_processor_id(boot_cpuid, intserv[i]); 10224df20460SAnton Blanchard } 10239b6b563cSPaul Mackerras 10249b6b563cSPaul Mackerras #ifdef CONFIG_ALTIVEC 10259b6b563cSPaul Mackerras /* Check if we have a VMX and eventually update CPU features */ 1026676e2497SStephen Rothwell prop = (u32 *)of_get_flat_dt_prop(node, "ibm,vmx", NULL); 10279b6b563cSPaul Mackerras if (prop && (*prop) > 0) { 10289b6b563cSPaul Mackerras cur_cpu_spec->cpu_features |= CPU_FTR_ALTIVEC; 10299b6b563cSPaul Mackerras cur_cpu_spec->cpu_user_features |= PPC_FEATURE_HAS_ALTIVEC; 10309b6b563cSPaul Mackerras } 10319b6b563cSPaul Mackerras 10329b6b563cSPaul Mackerras /* Same goes for Apple's "altivec" property */ 10333c726f8dSBenjamin Herrenschmidt prop = (u32 *)of_get_flat_dt_prop(node, "altivec", NULL); 10349b6b563cSPaul Mackerras if (prop) { 10359b6b563cSPaul Mackerras cur_cpu_spec->cpu_features |= CPU_FTR_ALTIVEC; 10369b6b563cSPaul Mackerras cur_cpu_spec->cpu_user_features |= PPC_FEATURE_HAS_ALTIVEC; 10379b6b563cSPaul Mackerras } 10389b6b563cSPaul Mackerras #endif /* CONFIG_ALTIVEC */ 10399b6b563cSPaul Mackerras 1040*d205819eSPaul Mackerras check_cpu_pa_features(node); 1041*d205819eSPaul Mackerras 10429b6b563cSPaul Mackerras #ifdef CONFIG_PPC_PSERIES 10434df20460SAnton Blanchard if (nthreads > 1) 10449b6b563cSPaul Mackerras cur_cpu_spec->cpu_features |= CPU_FTR_SMT; 10454df20460SAnton Blanchard else 10464df20460SAnton Blanchard cur_cpu_spec->cpu_features &= ~CPU_FTR_SMT; 10479b6b563cSPaul Mackerras #endif 10489b6b563cSPaul Mackerras 10499b6b563cSPaul Mackerras return 0; 10509b6b563cSPaul Mackerras } 10519b6b563cSPaul Mackerras 10529b6b563cSPaul Mackerras static int __init early_init_dt_scan_chosen(unsigned long node, 10539b6b563cSPaul Mackerras const char *uname, int depth, void *data) 10549b6b563cSPaul Mackerras { 10559b6b563cSPaul Mackerras unsigned long *lprop; 1056329dda08SKumar Gala unsigned long l; 1057329dda08SKumar Gala char *p; 10589b6b563cSPaul Mackerras 10599b6b563cSPaul Mackerras DBG("search \"chosen\", depth: %d, uname: %s\n", depth, uname); 10609b6b563cSPaul Mackerras 1061a575b807SPaul Mackerras if (depth != 1 || 1062a575b807SPaul Mackerras (strcmp(uname, "chosen") != 0 && strcmp(uname, "chosen@0") != 0)) 10639b6b563cSPaul Mackerras return 0; 10649b6b563cSPaul Mackerras 10659b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 10669b6b563cSPaul Mackerras /* check if iommu is forced on or off */ 10673c726f8dSBenjamin Herrenschmidt if (of_get_flat_dt_prop(node, "linux,iommu-off", NULL) != NULL) 10689b6b563cSPaul Mackerras iommu_is_off = 1; 10693c726f8dSBenjamin Herrenschmidt if (of_get_flat_dt_prop(node, "linux,iommu-force-on", NULL) != NULL) 10709b6b563cSPaul Mackerras iommu_force_on = 1; 10719b6b563cSPaul Mackerras #endif 10729b6b563cSPaul Mackerras 10733c726f8dSBenjamin Herrenschmidt lprop = of_get_flat_dt_prop(node, "linux,memory-limit", NULL); 10749b6b563cSPaul Mackerras if (lprop) 10759b6b563cSPaul Mackerras memory_limit = *lprop; 10769b6b563cSPaul Mackerras 10779b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 10783c726f8dSBenjamin Herrenschmidt lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-start", NULL); 10799b6b563cSPaul Mackerras if (lprop) 10809b6b563cSPaul Mackerras tce_alloc_start = *lprop; 10813c726f8dSBenjamin Herrenschmidt lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-end", NULL); 10829b6b563cSPaul Mackerras if (lprop) 10839b6b563cSPaul Mackerras tce_alloc_end = *lprop; 10849b6b563cSPaul Mackerras #endif 10859b6b563cSPaul Mackerras 10869b6b563cSPaul Mackerras #ifdef CONFIG_PPC_RTAS 1087943ffb58SAdrian Bunk /* To help early debugging via the front panel, we retrieve a minimal 10889b6b563cSPaul Mackerras * set of RTAS infos now if available 10899b6b563cSPaul Mackerras */ 10909b6b563cSPaul Mackerras { 1091e8222502SBenjamin Herrenschmidt u64 *basep, *entryp, *sizep; 10929b6b563cSPaul Mackerras 10933c726f8dSBenjamin Herrenschmidt basep = of_get_flat_dt_prop(node, "linux,rtas-base", NULL); 10943c726f8dSBenjamin Herrenschmidt entryp = of_get_flat_dt_prop(node, "linux,rtas-entry", NULL); 1095e8222502SBenjamin Herrenschmidt sizep = of_get_flat_dt_prop(node, "linux,rtas-size", NULL); 1096e8222502SBenjamin Herrenschmidt if (basep && entryp && sizep) { 10979b6b563cSPaul Mackerras rtas.base = *basep; 10989b6b563cSPaul Mackerras rtas.entry = *entryp; 1099e8222502SBenjamin Herrenschmidt rtas.size = *sizep; 11009b6b563cSPaul Mackerras } 11019b6b563cSPaul Mackerras } 11029b6b563cSPaul Mackerras #endif /* CONFIG_PPC_RTAS */ 11039b6b563cSPaul Mackerras 1104dcee3036SMichael Ellerman #ifdef CONFIG_KEXEC 1105dcee3036SMichael Ellerman lprop = (u64*)of_get_flat_dt_prop(node, "linux,crashkernel-base", NULL); 1106dcee3036SMichael Ellerman if (lprop) 1107dcee3036SMichael Ellerman crashk_res.start = *lprop; 1108dcee3036SMichael Ellerman 1109dcee3036SMichael Ellerman lprop = (u64*)of_get_flat_dt_prop(node, "linux,crashkernel-size", NULL); 1110dcee3036SMichael Ellerman if (lprop) 1111dcee3036SMichael Ellerman crashk_res.end = crashk_res.start + *lprop - 1; 1112dcee3036SMichael Ellerman #endif 1113dcee3036SMichael Ellerman 1114329dda08SKumar Gala /* Retreive command line */ 1115329dda08SKumar Gala p = of_get_flat_dt_prop(node, "bootargs", &l); 1116329dda08SKumar Gala if (p != NULL && l > 0) 1117329dda08SKumar Gala strlcpy(cmd_line, p, min((int)l, COMMAND_LINE_SIZE)); 1118329dda08SKumar Gala 1119329dda08SKumar Gala #ifdef CONFIG_CMDLINE 1120329dda08SKumar Gala if (l == 0 || (l == 1 && (*p) == 0)) 1121329dda08SKumar Gala strlcpy(cmd_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE); 1122329dda08SKumar Gala #endif /* CONFIG_CMDLINE */ 1123329dda08SKumar Gala 1124329dda08SKumar Gala DBG("Command line is: %s\n", cmd_line); 1125329dda08SKumar Gala 1126329dda08SKumar Gala if (strstr(cmd_line, "mem=")) { 1127329dda08SKumar Gala char *p, *q; 1128329dda08SKumar Gala 1129329dda08SKumar Gala for (q = cmd_line; (p = strstr(q, "mem=")) != 0; ) { 1130329dda08SKumar Gala q = p + 4; 1131329dda08SKumar Gala if (p > cmd_line && p[-1] != ' ') 1132329dda08SKumar Gala continue; 113310d713aeSKumar Gala memory_limit = memparse(q, &q); 1134329dda08SKumar Gala } 1135329dda08SKumar Gala } 1136329dda08SKumar Gala 11379b6b563cSPaul Mackerras /* break now */ 11389b6b563cSPaul Mackerras return 1; 11399b6b563cSPaul Mackerras } 11409b6b563cSPaul Mackerras 11419b6b563cSPaul Mackerras static int __init early_init_dt_scan_root(unsigned long node, 11429b6b563cSPaul Mackerras const char *uname, int depth, void *data) 11439b6b563cSPaul Mackerras { 11449b6b563cSPaul Mackerras u32 *prop; 11459b6b563cSPaul Mackerras 11469b6b563cSPaul Mackerras if (depth != 0) 11479b6b563cSPaul Mackerras return 0; 11489b6b563cSPaul Mackerras 11493c726f8dSBenjamin Herrenschmidt prop = of_get_flat_dt_prop(node, "#size-cells", NULL); 11509b6b563cSPaul Mackerras dt_root_size_cells = (prop == NULL) ? 1 : *prop; 11519b6b563cSPaul Mackerras DBG("dt_root_size_cells = %x\n", dt_root_size_cells); 11529b6b563cSPaul Mackerras 11533c726f8dSBenjamin Herrenschmidt prop = of_get_flat_dt_prop(node, "#address-cells", NULL); 11549b6b563cSPaul Mackerras dt_root_addr_cells = (prop == NULL) ? 2 : *prop; 11559b6b563cSPaul Mackerras DBG("dt_root_addr_cells = %x\n", dt_root_addr_cells); 11569b6b563cSPaul Mackerras 11579b6b563cSPaul Mackerras /* break now */ 11589b6b563cSPaul Mackerras return 1; 11599b6b563cSPaul Mackerras } 11609b6b563cSPaul Mackerras 11619b6b563cSPaul Mackerras static unsigned long __init dt_mem_next_cell(int s, cell_t **cellp) 11629b6b563cSPaul Mackerras { 11639b6b563cSPaul Mackerras cell_t *p = *cellp; 11649b6b563cSPaul Mackerras unsigned long r; 11659b6b563cSPaul Mackerras 11669b6b563cSPaul Mackerras /* Ignore more than 2 cells */ 11679b6b563cSPaul Mackerras while (s > sizeof(unsigned long) / 4) { 11689b6b563cSPaul Mackerras p++; 11699b6b563cSPaul Mackerras s--; 11709b6b563cSPaul Mackerras } 11719b6b563cSPaul Mackerras r = *p++; 11729b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 11739b6b563cSPaul Mackerras if (s > 1) { 11749b6b563cSPaul Mackerras r <<= 32; 11759b6b563cSPaul Mackerras r |= *(p++); 11769b6b563cSPaul Mackerras s--; 11779b6b563cSPaul Mackerras } 11789b6b563cSPaul Mackerras #endif 11799b6b563cSPaul Mackerras 11809b6b563cSPaul Mackerras *cellp = p; 11819b6b563cSPaul Mackerras return r; 11829b6b563cSPaul Mackerras } 11839b6b563cSPaul Mackerras 11849b6b563cSPaul Mackerras 11859b6b563cSPaul Mackerras static int __init early_init_dt_scan_memory(unsigned long node, 11869b6b563cSPaul Mackerras const char *uname, int depth, void *data) 11879b6b563cSPaul Mackerras { 11883c726f8dSBenjamin Herrenschmidt char *type = of_get_flat_dt_prop(node, "device_type", NULL); 11899b6b563cSPaul Mackerras cell_t *reg, *endp; 11909b6b563cSPaul Mackerras unsigned long l; 11919b6b563cSPaul Mackerras 11929b6b563cSPaul Mackerras /* We are scanning "memory" nodes only */ 1193a23414beSPaul Mackerras if (type == NULL) { 1194a23414beSPaul Mackerras /* 1195a23414beSPaul Mackerras * The longtrail doesn't have a device_type on the 1196a23414beSPaul Mackerras * /memory node, so look for the node called /memory@0. 1197a23414beSPaul Mackerras */ 1198a23414beSPaul Mackerras if (depth != 1 || strcmp(uname, "memory@0") != 0) 1199a23414beSPaul Mackerras return 0; 1200a23414beSPaul Mackerras } else if (strcmp(type, "memory") != 0) 12019b6b563cSPaul Mackerras return 0; 12029b6b563cSPaul Mackerras 1203ba759485SMichael Ellerman reg = (cell_t *)of_get_flat_dt_prop(node, "linux,usable-memory", &l); 1204ba759485SMichael Ellerman if (reg == NULL) 12053c726f8dSBenjamin Herrenschmidt reg = (cell_t *)of_get_flat_dt_prop(node, "reg", &l); 12069b6b563cSPaul Mackerras if (reg == NULL) 12079b6b563cSPaul Mackerras return 0; 12089b6b563cSPaul Mackerras 12099b6b563cSPaul Mackerras endp = reg + (l / sizeof(cell_t)); 12109b6b563cSPaul Mackerras 1211358c86fdSMichael Ellerman DBG("memory scan node %s, reg size %ld, data: %x %x %x %x,\n", 12129b6b563cSPaul Mackerras uname, l, reg[0], reg[1], reg[2], reg[3]); 12139b6b563cSPaul Mackerras 12149b6b563cSPaul Mackerras while ((endp - reg) >= (dt_root_addr_cells + dt_root_size_cells)) { 12159b6b563cSPaul Mackerras unsigned long base, size; 12169b6b563cSPaul Mackerras 12179b6b563cSPaul Mackerras base = dt_mem_next_cell(dt_root_addr_cells, ®); 12189b6b563cSPaul Mackerras size = dt_mem_next_cell(dt_root_size_cells, ®); 12199b6b563cSPaul Mackerras 12209b6b563cSPaul Mackerras if (size == 0) 12219b6b563cSPaul Mackerras continue; 12229b6b563cSPaul Mackerras DBG(" - %lx , %lx\n", base, size); 12239b6b563cSPaul Mackerras #ifdef CONFIG_PPC64 12249b6b563cSPaul Mackerras if (iommu_is_off) { 12259b6b563cSPaul Mackerras if (base >= 0x80000000ul) 12269b6b563cSPaul Mackerras continue; 12279b6b563cSPaul Mackerras if ((base + size) > 0x80000000ul) 12289b6b563cSPaul Mackerras size = 0x80000000ul - base; 12299b6b563cSPaul Mackerras } 12309b6b563cSPaul Mackerras #endif 12319b6b563cSPaul Mackerras lmb_add(base, size); 12329b6b563cSPaul Mackerras } 12339b6b563cSPaul Mackerras return 0; 12349b6b563cSPaul Mackerras } 12359b6b563cSPaul Mackerras 12369b6b563cSPaul Mackerras static void __init early_reserve_mem(void) 12379b6b563cSPaul Mackerras { 1238cbbcf340SKumar Gala u64 base, size; 1239cbbcf340SKumar Gala u64 *reserve_map; 12409b6b563cSPaul Mackerras 1241cbbcf340SKumar Gala reserve_map = (u64 *)(((unsigned long)initial_boot_params) + 12429b6b563cSPaul Mackerras initial_boot_params->off_mem_rsvmap); 1243cbbcf340SKumar Gala #ifdef CONFIG_PPC32 1244cbbcf340SKumar Gala /* 1245cbbcf340SKumar Gala * Handle the case where we might be booting from an old kexec 1246cbbcf340SKumar Gala * image that setup the mem_rsvmap as pairs of 32-bit values 1247cbbcf340SKumar Gala */ 1248cbbcf340SKumar Gala if (*reserve_map > 0xffffffffull) { 1249cbbcf340SKumar Gala u32 base_32, size_32; 1250cbbcf340SKumar Gala u32 *reserve_map_32 = (u32 *)reserve_map; 1251cbbcf340SKumar Gala 1252cbbcf340SKumar Gala while (1) { 1253cbbcf340SKumar Gala base_32 = *(reserve_map_32++); 1254cbbcf340SKumar Gala size_32 = *(reserve_map_32++); 1255cbbcf340SKumar Gala if (size_32 == 0) 1256cbbcf340SKumar Gala break; 1257329dda08SKumar Gala DBG("reserving: %x -> %x\n", base_32, size_32); 1258cbbcf340SKumar Gala lmb_reserve(base_32, size_32); 1259cbbcf340SKumar Gala } 1260cbbcf340SKumar Gala return; 1261cbbcf340SKumar Gala } 1262cbbcf340SKumar Gala #endif 12639b6b563cSPaul Mackerras while (1) { 12649b6b563cSPaul Mackerras base = *(reserve_map++); 12659b6b563cSPaul Mackerras size = *(reserve_map++); 12669b6b563cSPaul Mackerras if (size == 0) 12679b6b563cSPaul Mackerras break; 1268cbbcf340SKumar Gala DBG("reserving: %llx -> %llx\n", base, size); 12699b6b563cSPaul Mackerras lmb_reserve(base, size); 12709b6b563cSPaul Mackerras } 12719b6b563cSPaul Mackerras 12729b6b563cSPaul Mackerras #if 0 12739b6b563cSPaul Mackerras DBG("memory reserved, lmbs :\n"); 12749b6b563cSPaul Mackerras lmb_dump_all(); 12759b6b563cSPaul Mackerras #endif 12769b6b563cSPaul Mackerras } 12779b6b563cSPaul Mackerras 12789b6b563cSPaul Mackerras void __init early_init_devtree(void *params) 12799b6b563cSPaul Mackerras { 12809b6b563cSPaul Mackerras DBG(" -> early_init_devtree()\n"); 12819b6b563cSPaul Mackerras 12829b6b563cSPaul Mackerras /* Setup flat device-tree pointer */ 12839b6b563cSPaul Mackerras initial_boot_params = params; 12849b6b563cSPaul Mackerras 12859b6b563cSPaul Mackerras /* Retrieve various informations from the /chosen node of the 12869b6b563cSPaul Mackerras * device-tree, including the platform type, initrd location and 12879b6b563cSPaul Mackerras * size, TCE reserve, and more ... 12889b6b563cSPaul Mackerras */ 12893c726f8dSBenjamin Herrenschmidt of_scan_flat_dt(early_init_dt_scan_chosen, NULL); 12909b6b563cSPaul Mackerras 12919b6b563cSPaul Mackerras /* Scan memory nodes and rebuild LMBs */ 12929b6b563cSPaul Mackerras lmb_init(); 12933c726f8dSBenjamin Herrenschmidt of_scan_flat_dt(early_init_dt_scan_root, NULL); 12943c726f8dSBenjamin Herrenschmidt of_scan_flat_dt(early_init_dt_scan_memory, NULL); 12959b6b563cSPaul Mackerras lmb_enforce_memory_limit(memory_limit); 12969b6b563cSPaul Mackerras lmb_analyze(); 12979b6b563cSPaul Mackerras 12989b6b563cSPaul Mackerras DBG("Phys. mem: %lx\n", lmb_phys_mem_size()); 12999b6b563cSPaul Mackerras 13009b6b563cSPaul Mackerras /* Reserve LMB regions used by kernel, initrd, dt, etc... */ 13010cc4746cSMichael Ellerman lmb_reserve(PHYSICAL_START, __pa(klimit) - PHYSICAL_START); 13020cc4746cSMichael Ellerman #ifdef CONFIG_CRASH_DUMP 13030cc4746cSMichael Ellerman lmb_reserve(0, KDUMP_RESERVE_LIMIT); 13040cc4746cSMichael Ellerman #endif 13059b6b563cSPaul Mackerras early_reserve_mem(); 13069b6b563cSPaul Mackerras 13079b6b563cSPaul Mackerras DBG("Scanning CPUs ...\n"); 13089b6b563cSPaul Mackerras 13093c726f8dSBenjamin Herrenschmidt /* Retreive CPU related informations from the flat tree 13103c726f8dSBenjamin Herrenschmidt * (altivec support, boot CPU ID, ...) 13119b6b563cSPaul Mackerras */ 13123c726f8dSBenjamin Herrenschmidt of_scan_flat_dt(early_init_dt_scan_cpus, NULL); 13139b6b563cSPaul Mackerras 13149b6b563cSPaul Mackerras DBG(" <- early_init_devtree()\n"); 13159b6b563cSPaul Mackerras } 13169b6b563cSPaul Mackerras 13179b6b563cSPaul Mackerras #undef printk 13189b6b563cSPaul Mackerras 13199b6b563cSPaul Mackerras int 13209b6b563cSPaul Mackerras prom_n_addr_cells(struct device_node* np) 13219b6b563cSPaul Mackerras { 13229b6b563cSPaul Mackerras int* ip; 13239b6b563cSPaul Mackerras do { 13249b6b563cSPaul Mackerras if (np->parent) 13259b6b563cSPaul Mackerras np = np->parent; 13269b6b563cSPaul Mackerras ip = (int *) get_property(np, "#address-cells", NULL); 13279b6b563cSPaul Mackerras if (ip != NULL) 13289b6b563cSPaul Mackerras return *ip; 13299b6b563cSPaul Mackerras } while (np->parent); 13309b6b563cSPaul Mackerras /* No #address-cells property for the root node, default to 1 */ 13319b6b563cSPaul Mackerras return 1; 13329b6b563cSPaul Mackerras } 13331dfc6772SPaul Mackerras EXPORT_SYMBOL(prom_n_addr_cells); 13349b6b563cSPaul Mackerras 13359b6b563cSPaul Mackerras int 13369b6b563cSPaul Mackerras prom_n_size_cells(struct device_node* np) 13379b6b563cSPaul Mackerras { 13389b6b563cSPaul Mackerras int* ip; 13399b6b563cSPaul Mackerras do { 13409b6b563cSPaul Mackerras if (np->parent) 13419b6b563cSPaul Mackerras np = np->parent; 13429b6b563cSPaul Mackerras ip = (int *) get_property(np, "#size-cells", NULL); 13439b6b563cSPaul Mackerras if (ip != NULL) 13449b6b563cSPaul Mackerras return *ip; 13459b6b563cSPaul Mackerras } while (np->parent); 13469b6b563cSPaul Mackerras /* No #size-cells property for the root node, default to 1 */ 13479b6b563cSPaul Mackerras return 1; 13489b6b563cSPaul Mackerras } 13491dfc6772SPaul Mackerras EXPORT_SYMBOL(prom_n_size_cells); 13509b6b563cSPaul Mackerras 13519b6b563cSPaul Mackerras /** 13529b6b563cSPaul Mackerras * Work out the sense (active-low level / active-high edge) 13539b6b563cSPaul Mackerras * of each interrupt from the device tree. 13549b6b563cSPaul Mackerras */ 13559b6b563cSPaul Mackerras void __init prom_get_irq_senses(unsigned char *senses, int off, int max) 13569b6b563cSPaul Mackerras { 13579b6b563cSPaul Mackerras struct device_node *np; 13589b6b563cSPaul Mackerras int i, j; 13599b6b563cSPaul Mackerras 13609b6b563cSPaul Mackerras /* default to level-triggered */ 13616d0124fcSPaul Mackerras memset(senses, IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE, max - off); 13629b6b563cSPaul Mackerras 13639b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) { 13649b6b563cSPaul Mackerras for (j = 0; j < np->n_intrs; j++) { 13659b6b563cSPaul Mackerras i = np->intrs[j].line; 13669b6b563cSPaul Mackerras if (i >= off && i < max) 13676d0124fcSPaul Mackerras senses[i-off] = np->intrs[j].sense; 13689b6b563cSPaul Mackerras } 13699b6b563cSPaul Mackerras } 13709b6b563cSPaul Mackerras } 13719b6b563cSPaul Mackerras 13729b6b563cSPaul Mackerras /** 13739b6b563cSPaul Mackerras * Construct and return a list of the device_nodes with a given name. 13749b6b563cSPaul Mackerras */ 13759b6b563cSPaul Mackerras struct device_node *find_devices(const char *name) 13769b6b563cSPaul Mackerras { 13779b6b563cSPaul Mackerras struct device_node *head, **prevp, *np; 13789b6b563cSPaul Mackerras 13799b6b563cSPaul Mackerras prevp = &head; 13809b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) { 13819b6b563cSPaul Mackerras if (np->name != 0 && strcasecmp(np->name, name) == 0) { 13829b6b563cSPaul Mackerras *prevp = np; 13839b6b563cSPaul Mackerras prevp = &np->next; 13849b6b563cSPaul Mackerras } 13859b6b563cSPaul Mackerras } 13869b6b563cSPaul Mackerras *prevp = NULL; 13879b6b563cSPaul Mackerras return head; 13889b6b563cSPaul Mackerras } 13899b6b563cSPaul Mackerras EXPORT_SYMBOL(find_devices); 13909b6b563cSPaul Mackerras 13919b6b563cSPaul Mackerras /** 13929b6b563cSPaul Mackerras * Construct and return a list of the device_nodes with a given type. 13939b6b563cSPaul Mackerras */ 13949b6b563cSPaul Mackerras struct device_node *find_type_devices(const char *type) 13959b6b563cSPaul Mackerras { 13969b6b563cSPaul Mackerras struct device_node *head, **prevp, *np; 13979b6b563cSPaul Mackerras 13989b6b563cSPaul Mackerras prevp = &head; 13999b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) { 14009b6b563cSPaul Mackerras if (np->type != 0 && strcasecmp(np->type, type) == 0) { 14019b6b563cSPaul Mackerras *prevp = np; 14029b6b563cSPaul Mackerras prevp = &np->next; 14039b6b563cSPaul Mackerras } 14049b6b563cSPaul Mackerras } 14059b6b563cSPaul Mackerras *prevp = NULL; 14069b6b563cSPaul Mackerras return head; 14079b6b563cSPaul Mackerras } 14089b6b563cSPaul Mackerras EXPORT_SYMBOL(find_type_devices); 14099b6b563cSPaul Mackerras 14109b6b563cSPaul Mackerras /** 14119b6b563cSPaul Mackerras * Returns all nodes linked together 14129b6b563cSPaul Mackerras */ 14139b6b563cSPaul Mackerras struct device_node *find_all_nodes(void) 14149b6b563cSPaul Mackerras { 14159b6b563cSPaul Mackerras struct device_node *head, **prevp, *np; 14169b6b563cSPaul Mackerras 14179b6b563cSPaul Mackerras prevp = &head; 14189b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) { 14199b6b563cSPaul Mackerras *prevp = np; 14209b6b563cSPaul Mackerras prevp = &np->next; 14219b6b563cSPaul Mackerras } 14229b6b563cSPaul Mackerras *prevp = NULL; 14239b6b563cSPaul Mackerras return head; 14249b6b563cSPaul Mackerras } 14259b6b563cSPaul Mackerras EXPORT_SYMBOL(find_all_nodes); 14269b6b563cSPaul Mackerras 14279b6b563cSPaul Mackerras /** Checks if the given "compat" string matches one of the strings in 14289b6b563cSPaul Mackerras * the device's "compatible" property 14299b6b563cSPaul Mackerras */ 14309b6b563cSPaul Mackerras int device_is_compatible(struct device_node *device, const char *compat) 14319b6b563cSPaul Mackerras { 14329b6b563cSPaul Mackerras const char* cp; 14339b6b563cSPaul Mackerras int cplen, l; 14349b6b563cSPaul Mackerras 14359b6b563cSPaul Mackerras cp = (char *) get_property(device, "compatible", &cplen); 14369b6b563cSPaul Mackerras if (cp == NULL) 14379b6b563cSPaul Mackerras return 0; 14389b6b563cSPaul Mackerras while (cplen > 0) { 14399b6b563cSPaul Mackerras if (strncasecmp(cp, compat, strlen(compat)) == 0) 14409b6b563cSPaul Mackerras return 1; 14419b6b563cSPaul Mackerras l = strlen(cp) + 1; 14429b6b563cSPaul Mackerras cp += l; 14439b6b563cSPaul Mackerras cplen -= l; 14449b6b563cSPaul Mackerras } 14459b6b563cSPaul Mackerras 14469b6b563cSPaul Mackerras return 0; 14479b6b563cSPaul Mackerras } 14489b6b563cSPaul Mackerras EXPORT_SYMBOL(device_is_compatible); 14499b6b563cSPaul Mackerras 14509b6b563cSPaul Mackerras 14519b6b563cSPaul Mackerras /** 14529b6b563cSPaul Mackerras * Indicates whether the root node has a given value in its 14539b6b563cSPaul Mackerras * compatible property. 14549b6b563cSPaul Mackerras */ 14559b6b563cSPaul Mackerras int machine_is_compatible(const char *compat) 14569b6b563cSPaul Mackerras { 14579b6b563cSPaul Mackerras struct device_node *root; 14589b6b563cSPaul Mackerras int rc = 0; 14599b6b563cSPaul Mackerras 14609b6b563cSPaul Mackerras root = of_find_node_by_path("/"); 14619b6b563cSPaul Mackerras if (root) { 14629b6b563cSPaul Mackerras rc = device_is_compatible(root, compat); 14639b6b563cSPaul Mackerras of_node_put(root); 14649b6b563cSPaul Mackerras } 14659b6b563cSPaul Mackerras return rc; 14669b6b563cSPaul Mackerras } 14679b6b563cSPaul Mackerras EXPORT_SYMBOL(machine_is_compatible); 14689b6b563cSPaul Mackerras 14699b6b563cSPaul Mackerras /** 14709b6b563cSPaul Mackerras * Construct and return a list of the device_nodes with a given type 14719b6b563cSPaul Mackerras * and compatible property. 14729b6b563cSPaul Mackerras */ 14739b6b563cSPaul Mackerras struct device_node *find_compatible_devices(const char *type, 14749b6b563cSPaul Mackerras const char *compat) 14759b6b563cSPaul Mackerras { 14769b6b563cSPaul Mackerras struct device_node *head, **prevp, *np; 14779b6b563cSPaul Mackerras 14789b6b563cSPaul Mackerras prevp = &head; 14799b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) { 14809b6b563cSPaul Mackerras if (type != NULL 14819b6b563cSPaul Mackerras && !(np->type != 0 && strcasecmp(np->type, type) == 0)) 14829b6b563cSPaul Mackerras continue; 14839b6b563cSPaul Mackerras if (device_is_compatible(np, compat)) { 14849b6b563cSPaul Mackerras *prevp = np; 14859b6b563cSPaul Mackerras prevp = &np->next; 14869b6b563cSPaul Mackerras } 14879b6b563cSPaul Mackerras } 14889b6b563cSPaul Mackerras *prevp = NULL; 14899b6b563cSPaul Mackerras return head; 14909b6b563cSPaul Mackerras } 14919b6b563cSPaul Mackerras EXPORT_SYMBOL(find_compatible_devices); 14929b6b563cSPaul Mackerras 14939b6b563cSPaul Mackerras /** 14949b6b563cSPaul Mackerras * Find the device_node with a given full_name. 14959b6b563cSPaul Mackerras */ 14969b6b563cSPaul Mackerras struct device_node *find_path_device(const char *path) 14979b6b563cSPaul Mackerras { 14989b6b563cSPaul Mackerras struct device_node *np; 14999b6b563cSPaul Mackerras 15009b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) 15019b6b563cSPaul Mackerras if (np->full_name != 0 && strcasecmp(np->full_name, path) == 0) 15029b6b563cSPaul Mackerras return np; 15039b6b563cSPaul Mackerras return NULL; 15049b6b563cSPaul Mackerras } 15059b6b563cSPaul Mackerras EXPORT_SYMBOL(find_path_device); 15069b6b563cSPaul Mackerras 15079b6b563cSPaul Mackerras /******* 15089b6b563cSPaul Mackerras * 15099b6b563cSPaul Mackerras * New implementation of the OF "find" APIs, return a refcounted 15109b6b563cSPaul Mackerras * object, call of_node_put() when done. The device tree and list 15119b6b563cSPaul Mackerras * are protected by a rw_lock. 15129b6b563cSPaul Mackerras * 15139b6b563cSPaul Mackerras * Note that property management will need some locking as well, 15149b6b563cSPaul Mackerras * this isn't dealt with yet. 15159b6b563cSPaul Mackerras * 15169b6b563cSPaul Mackerras *******/ 15179b6b563cSPaul Mackerras 15189b6b563cSPaul Mackerras /** 15199b6b563cSPaul Mackerras * of_find_node_by_name - Find a node by its "name" property 15209b6b563cSPaul Mackerras * @from: The node to start searching from or NULL, the node 15219b6b563cSPaul Mackerras * you pass will not be searched, only the next one 15229b6b563cSPaul Mackerras * will; typically, you pass what the previous call 15239b6b563cSPaul Mackerras * returned. of_node_put() will be called on it 15249b6b563cSPaul Mackerras * @name: The name string to match against 15259b6b563cSPaul Mackerras * 15269b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 15279b6b563cSPaul Mackerras * of_node_put() on it when done. 15289b6b563cSPaul Mackerras */ 15299b6b563cSPaul Mackerras struct device_node *of_find_node_by_name(struct device_node *from, 15309b6b563cSPaul Mackerras const char *name) 15319b6b563cSPaul Mackerras { 15329b6b563cSPaul Mackerras struct device_node *np; 15339b6b563cSPaul Mackerras 15349b6b563cSPaul Mackerras read_lock(&devtree_lock); 15359b6b563cSPaul Mackerras np = from ? from->allnext : allnodes; 1536090db7c8SOlaf Hering for (; np != NULL; np = np->allnext) 1537090db7c8SOlaf Hering if (np->name != NULL && strcasecmp(np->name, name) == 0 15389b6b563cSPaul Mackerras && of_node_get(np)) 15399b6b563cSPaul Mackerras break; 15409b6b563cSPaul Mackerras if (from) 15419b6b563cSPaul Mackerras of_node_put(from); 15429b6b563cSPaul Mackerras read_unlock(&devtree_lock); 15439b6b563cSPaul Mackerras return np; 15449b6b563cSPaul Mackerras } 15459b6b563cSPaul Mackerras EXPORT_SYMBOL(of_find_node_by_name); 15469b6b563cSPaul Mackerras 15479b6b563cSPaul Mackerras /** 15489b6b563cSPaul Mackerras * of_find_node_by_type - Find a node by its "device_type" property 15499b6b563cSPaul Mackerras * @from: The node to start searching from or NULL, the node 15509b6b563cSPaul Mackerras * you pass will not be searched, only the next one 15519b6b563cSPaul Mackerras * will; typically, you pass what the previous call 15529b6b563cSPaul Mackerras * returned. of_node_put() will be called on it 15539b6b563cSPaul Mackerras * @name: The type string to match against 15549b6b563cSPaul Mackerras * 15559b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 15569b6b563cSPaul Mackerras * of_node_put() on it when done. 15579b6b563cSPaul Mackerras */ 15589b6b563cSPaul Mackerras struct device_node *of_find_node_by_type(struct device_node *from, 15599b6b563cSPaul Mackerras const char *type) 15609b6b563cSPaul Mackerras { 15619b6b563cSPaul Mackerras struct device_node *np; 15629b6b563cSPaul Mackerras 15639b6b563cSPaul Mackerras read_lock(&devtree_lock); 15649b6b563cSPaul Mackerras np = from ? from->allnext : allnodes; 15659b6b563cSPaul Mackerras for (; np != 0; np = np->allnext) 15669b6b563cSPaul Mackerras if (np->type != 0 && strcasecmp(np->type, type) == 0 15679b6b563cSPaul Mackerras && of_node_get(np)) 15689b6b563cSPaul Mackerras break; 15699b6b563cSPaul Mackerras if (from) 15709b6b563cSPaul Mackerras of_node_put(from); 15719b6b563cSPaul Mackerras read_unlock(&devtree_lock); 15729b6b563cSPaul Mackerras return np; 15739b6b563cSPaul Mackerras } 15749b6b563cSPaul Mackerras EXPORT_SYMBOL(of_find_node_by_type); 15759b6b563cSPaul Mackerras 15769b6b563cSPaul Mackerras /** 15779b6b563cSPaul Mackerras * of_find_compatible_node - Find a node based on type and one of the 15789b6b563cSPaul Mackerras * tokens in its "compatible" property 15799b6b563cSPaul Mackerras * @from: The node to start searching from or NULL, the node 15809b6b563cSPaul Mackerras * you pass will not be searched, only the next one 15819b6b563cSPaul Mackerras * will; typically, you pass what the previous call 15829b6b563cSPaul Mackerras * returned. of_node_put() will be called on it 15839b6b563cSPaul Mackerras * @type: The type string to match "device_type" or NULL to ignore 15849b6b563cSPaul Mackerras * @compatible: The string to match to one of the tokens in the device 15859b6b563cSPaul Mackerras * "compatible" list. 15869b6b563cSPaul Mackerras * 15879b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 15889b6b563cSPaul Mackerras * of_node_put() on it when done. 15899b6b563cSPaul Mackerras */ 15909b6b563cSPaul Mackerras struct device_node *of_find_compatible_node(struct device_node *from, 15919b6b563cSPaul Mackerras const char *type, const char *compatible) 15929b6b563cSPaul Mackerras { 15939b6b563cSPaul Mackerras struct device_node *np; 15949b6b563cSPaul Mackerras 15959b6b563cSPaul Mackerras read_lock(&devtree_lock); 15969b6b563cSPaul Mackerras np = from ? from->allnext : allnodes; 15979b6b563cSPaul Mackerras for (; np != 0; np = np->allnext) { 15989b6b563cSPaul Mackerras if (type != NULL 15999b6b563cSPaul Mackerras && !(np->type != 0 && strcasecmp(np->type, type) == 0)) 16009b6b563cSPaul Mackerras continue; 16019b6b563cSPaul Mackerras if (device_is_compatible(np, compatible) && of_node_get(np)) 16029b6b563cSPaul Mackerras break; 16039b6b563cSPaul Mackerras } 16049b6b563cSPaul Mackerras if (from) 16059b6b563cSPaul Mackerras of_node_put(from); 16069b6b563cSPaul Mackerras read_unlock(&devtree_lock); 16079b6b563cSPaul Mackerras return np; 16089b6b563cSPaul Mackerras } 16099b6b563cSPaul Mackerras EXPORT_SYMBOL(of_find_compatible_node); 16109b6b563cSPaul Mackerras 16119b6b563cSPaul Mackerras /** 16129b6b563cSPaul Mackerras * of_find_node_by_path - Find a node matching a full OF path 16139b6b563cSPaul Mackerras * @path: The full path to match 16149b6b563cSPaul Mackerras * 16159b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 16169b6b563cSPaul Mackerras * of_node_put() on it when done. 16179b6b563cSPaul Mackerras */ 16189b6b563cSPaul Mackerras struct device_node *of_find_node_by_path(const char *path) 16199b6b563cSPaul Mackerras { 16209b6b563cSPaul Mackerras struct device_node *np = allnodes; 16219b6b563cSPaul Mackerras 16229b6b563cSPaul Mackerras read_lock(&devtree_lock); 16239b6b563cSPaul Mackerras for (; np != 0; np = np->allnext) { 16249b6b563cSPaul Mackerras if (np->full_name != 0 && strcasecmp(np->full_name, path) == 0 16259b6b563cSPaul Mackerras && of_node_get(np)) 16269b6b563cSPaul Mackerras break; 16279b6b563cSPaul Mackerras } 16289b6b563cSPaul Mackerras read_unlock(&devtree_lock); 16299b6b563cSPaul Mackerras return np; 16309b6b563cSPaul Mackerras } 16319b6b563cSPaul Mackerras EXPORT_SYMBOL(of_find_node_by_path); 16329b6b563cSPaul Mackerras 16339b6b563cSPaul Mackerras /** 16349b6b563cSPaul Mackerras * of_find_node_by_phandle - Find a node given a phandle 16359b6b563cSPaul Mackerras * @handle: phandle of the node to find 16369b6b563cSPaul Mackerras * 16379b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 16389b6b563cSPaul Mackerras * of_node_put() on it when done. 16399b6b563cSPaul Mackerras */ 16409b6b563cSPaul Mackerras struct device_node *of_find_node_by_phandle(phandle handle) 16419b6b563cSPaul Mackerras { 16429b6b563cSPaul Mackerras struct device_node *np; 16439b6b563cSPaul Mackerras 16449b6b563cSPaul Mackerras read_lock(&devtree_lock); 16459b6b563cSPaul Mackerras for (np = allnodes; np != 0; np = np->allnext) 16469b6b563cSPaul Mackerras if (np->linux_phandle == handle) 16479b6b563cSPaul Mackerras break; 16489b6b563cSPaul Mackerras if (np) 16499b6b563cSPaul Mackerras of_node_get(np); 16509b6b563cSPaul Mackerras read_unlock(&devtree_lock); 16519b6b563cSPaul Mackerras return np; 16529b6b563cSPaul Mackerras } 16539b6b563cSPaul Mackerras EXPORT_SYMBOL(of_find_node_by_phandle); 16549b6b563cSPaul Mackerras 16559b6b563cSPaul Mackerras /** 16569b6b563cSPaul Mackerras * of_find_all_nodes - Get next node in global list 16579b6b563cSPaul Mackerras * @prev: Previous node or NULL to start iteration 16589b6b563cSPaul Mackerras * of_node_put() will be called on it 16599b6b563cSPaul Mackerras * 16609b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 16619b6b563cSPaul Mackerras * of_node_put() on it when done. 16629b6b563cSPaul Mackerras */ 16639b6b563cSPaul Mackerras struct device_node *of_find_all_nodes(struct device_node *prev) 16649b6b563cSPaul Mackerras { 16659b6b563cSPaul Mackerras struct device_node *np; 16669b6b563cSPaul Mackerras 16679b6b563cSPaul Mackerras read_lock(&devtree_lock); 16689b6b563cSPaul Mackerras np = prev ? prev->allnext : allnodes; 16699b6b563cSPaul Mackerras for (; np != 0; np = np->allnext) 16709b6b563cSPaul Mackerras if (of_node_get(np)) 16719b6b563cSPaul Mackerras break; 16729b6b563cSPaul Mackerras if (prev) 16739b6b563cSPaul Mackerras of_node_put(prev); 16749b6b563cSPaul Mackerras read_unlock(&devtree_lock); 16759b6b563cSPaul Mackerras return np; 16769b6b563cSPaul Mackerras } 16779b6b563cSPaul Mackerras EXPORT_SYMBOL(of_find_all_nodes); 16789b6b563cSPaul Mackerras 16799b6b563cSPaul Mackerras /** 16809b6b563cSPaul Mackerras * of_get_parent - Get a node's parent if any 16819b6b563cSPaul Mackerras * @node: Node to get parent 16829b6b563cSPaul Mackerras * 16839b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 16849b6b563cSPaul Mackerras * of_node_put() on it when done. 16859b6b563cSPaul Mackerras */ 16869b6b563cSPaul Mackerras struct device_node *of_get_parent(const struct device_node *node) 16879b6b563cSPaul Mackerras { 16889b6b563cSPaul Mackerras struct device_node *np; 16899b6b563cSPaul Mackerras 16909b6b563cSPaul Mackerras if (!node) 16919b6b563cSPaul Mackerras return NULL; 16929b6b563cSPaul Mackerras 16939b6b563cSPaul Mackerras read_lock(&devtree_lock); 16949b6b563cSPaul Mackerras np = of_node_get(node->parent); 16959b6b563cSPaul Mackerras read_unlock(&devtree_lock); 16969b6b563cSPaul Mackerras return np; 16979b6b563cSPaul Mackerras } 16989b6b563cSPaul Mackerras EXPORT_SYMBOL(of_get_parent); 16999b6b563cSPaul Mackerras 17009b6b563cSPaul Mackerras /** 17019b6b563cSPaul Mackerras * of_get_next_child - Iterate a node childs 17029b6b563cSPaul Mackerras * @node: parent node 17039b6b563cSPaul Mackerras * @prev: previous child of the parent node, or NULL to get first 17049b6b563cSPaul Mackerras * 17059b6b563cSPaul Mackerras * Returns a node pointer with refcount incremented, use 17069b6b563cSPaul Mackerras * of_node_put() on it when done. 17079b6b563cSPaul Mackerras */ 17089b6b563cSPaul Mackerras struct device_node *of_get_next_child(const struct device_node *node, 17099b6b563cSPaul Mackerras struct device_node *prev) 17109b6b563cSPaul Mackerras { 17119b6b563cSPaul Mackerras struct device_node *next; 17129b6b563cSPaul Mackerras 17139b6b563cSPaul Mackerras read_lock(&devtree_lock); 17149b6b563cSPaul Mackerras next = prev ? prev->sibling : node->child; 17159b6b563cSPaul Mackerras for (; next != 0; next = next->sibling) 17169b6b563cSPaul Mackerras if (of_node_get(next)) 17179b6b563cSPaul Mackerras break; 17189b6b563cSPaul Mackerras if (prev) 17199b6b563cSPaul Mackerras of_node_put(prev); 17209b6b563cSPaul Mackerras read_unlock(&devtree_lock); 17219b6b563cSPaul Mackerras return next; 17229b6b563cSPaul Mackerras } 17239b6b563cSPaul Mackerras EXPORT_SYMBOL(of_get_next_child); 17249b6b563cSPaul Mackerras 17259b6b563cSPaul Mackerras /** 17269b6b563cSPaul Mackerras * of_node_get - Increment refcount of a node 17279b6b563cSPaul Mackerras * @node: Node to inc refcount, NULL is supported to 17289b6b563cSPaul Mackerras * simplify writing of callers 17299b6b563cSPaul Mackerras * 17309b6b563cSPaul Mackerras * Returns node. 17319b6b563cSPaul Mackerras */ 17329b6b563cSPaul Mackerras struct device_node *of_node_get(struct device_node *node) 17339b6b563cSPaul Mackerras { 17349b6b563cSPaul Mackerras if (node) 17359b6b563cSPaul Mackerras kref_get(&node->kref); 17369b6b563cSPaul Mackerras return node; 17379b6b563cSPaul Mackerras } 17389b6b563cSPaul Mackerras EXPORT_SYMBOL(of_node_get); 17399b6b563cSPaul Mackerras 17409b6b563cSPaul Mackerras static inline struct device_node * kref_to_device_node(struct kref *kref) 17419b6b563cSPaul Mackerras { 17429b6b563cSPaul Mackerras return container_of(kref, struct device_node, kref); 17439b6b563cSPaul Mackerras } 17449b6b563cSPaul Mackerras 17459b6b563cSPaul Mackerras /** 17469b6b563cSPaul Mackerras * of_node_release - release a dynamically allocated node 17479b6b563cSPaul Mackerras * @kref: kref element of the node to be released 17489b6b563cSPaul Mackerras * 17499b6b563cSPaul Mackerras * In of_node_put() this function is passed to kref_put() 17509b6b563cSPaul Mackerras * as the destructor. 17519b6b563cSPaul Mackerras */ 17529b6b563cSPaul Mackerras static void of_node_release(struct kref *kref) 17539b6b563cSPaul Mackerras { 17549b6b563cSPaul Mackerras struct device_node *node = kref_to_device_node(kref); 17559b6b563cSPaul Mackerras struct property *prop = node->properties; 17569b6b563cSPaul Mackerras 17579b6b563cSPaul Mackerras if (!OF_IS_DYNAMIC(node)) 17589b6b563cSPaul Mackerras return; 17599b6b563cSPaul Mackerras while (prop) { 17609b6b563cSPaul Mackerras struct property *next = prop->next; 17619b6b563cSPaul Mackerras kfree(prop->name); 17629b6b563cSPaul Mackerras kfree(prop->value); 17639b6b563cSPaul Mackerras kfree(prop); 17649b6b563cSPaul Mackerras prop = next; 1765088186deSDave C Boutcher 1766088186deSDave C Boutcher if (!prop) { 1767088186deSDave C Boutcher prop = node->deadprops; 1768088186deSDave C Boutcher node->deadprops = NULL; 1769088186deSDave C Boutcher } 17709b6b563cSPaul Mackerras } 17719b6b563cSPaul Mackerras kfree(node->intrs); 17729b6b563cSPaul Mackerras kfree(node->full_name); 17739b6b563cSPaul Mackerras kfree(node->data); 17749b6b563cSPaul Mackerras kfree(node); 17759b6b563cSPaul Mackerras } 17769b6b563cSPaul Mackerras 17779b6b563cSPaul Mackerras /** 17789b6b563cSPaul Mackerras * of_node_put - Decrement refcount of a node 17799b6b563cSPaul Mackerras * @node: Node to dec refcount, NULL is supported to 17809b6b563cSPaul Mackerras * simplify writing of callers 17819b6b563cSPaul Mackerras * 17829b6b563cSPaul Mackerras */ 17839b6b563cSPaul Mackerras void of_node_put(struct device_node *node) 17849b6b563cSPaul Mackerras { 17859b6b563cSPaul Mackerras if (node) 17869b6b563cSPaul Mackerras kref_put(&node->kref, of_node_release); 17879b6b563cSPaul Mackerras } 17889b6b563cSPaul Mackerras EXPORT_SYMBOL(of_node_put); 17899b6b563cSPaul Mackerras 17909b6b563cSPaul Mackerras /* 17919b6b563cSPaul Mackerras * Plug a device node into the tree and global list. 17929b6b563cSPaul Mackerras */ 17939b6b563cSPaul Mackerras void of_attach_node(struct device_node *np) 17949b6b563cSPaul Mackerras { 17959b6b563cSPaul Mackerras write_lock(&devtree_lock); 17969b6b563cSPaul Mackerras np->sibling = np->parent->child; 17979b6b563cSPaul Mackerras np->allnext = allnodes; 17989b6b563cSPaul Mackerras np->parent->child = np; 17999b6b563cSPaul Mackerras allnodes = np; 18009b6b563cSPaul Mackerras write_unlock(&devtree_lock); 18019b6b563cSPaul Mackerras } 18029b6b563cSPaul Mackerras 18039b6b563cSPaul Mackerras /* 18049b6b563cSPaul Mackerras * "Unplug" a node from the device tree. The caller must hold 18059b6b563cSPaul Mackerras * a reference to the node. The memory associated with the node 18069b6b563cSPaul Mackerras * is not freed until its refcount goes to zero. 18079b6b563cSPaul Mackerras */ 18089b6b563cSPaul Mackerras void of_detach_node(const struct device_node *np) 18099b6b563cSPaul Mackerras { 18109b6b563cSPaul Mackerras struct device_node *parent; 18119b6b563cSPaul Mackerras 18129b6b563cSPaul Mackerras write_lock(&devtree_lock); 18139b6b563cSPaul Mackerras 18149b6b563cSPaul Mackerras parent = np->parent; 18159b6b563cSPaul Mackerras 18169b6b563cSPaul Mackerras if (allnodes == np) 18179b6b563cSPaul Mackerras allnodes = np->allnext; 18189b6b563cSPaul Mackerras else { 18199b6b563cSPaul Mackerras struct device_node *prev; 18209b6b563cSPaul Mackerras for (prev = allnodes; 18219b6b563cSPaul Mackerras prev->allnext != np; 18229b6b563cSPaul Mackerras prev = prev->allnext) 18239b6b563cSPaul Mackerras ; 18249b6b563cSPaul Mackerras prev->allnext = np->allnext; 18259b6b563cSPaul Mackerras } 18269b6b563cSPaul Mackerras 18279b6b563cSPaul Mackerras if (parent->child == np) 18289b6b563cSPaul Mackerras parent->child = np->sibling; 18299b6b563cSPaul Mackerras else { 18309b6b563cSPaul Mackerras struct device_node *prevsib; 18319b6b563cSPaul Mackerras for (prevsib = np->parent->child; 18329b6b563cSPaul Mackerras prevsib->sibling != np; 18339b6b563cSPaul Mackerras prevsib = prevsib->sibling) 18349b6b563cSPaul Mackerras ; 18359b6b563cSPaul Mackerras prevsib->sibling = np->sibling; 18369b6b563cSPaul Mackerras } 18379b6b563cSPaul Mackerras 18389b6b563cSPaul Mackerras write_unlock(&devtree_lock); 18399b6b563cSPaul Mackerras } 18409b6b563cSPaul Mackerras 18419b6b563cSPaul Mackerras #ifdef CONFIG_PPC_PSERIES 18429b6b563cSPaul Mackerras /* 18439b6b563cSPaul Mackerras * Fix up the uninitialized fields in a new device node: 18449b6b563cSPaul Mackerras * name, type, n_addrs, addrs, n_intrs, intrs, and pci-specific fields 18459b6b563cSPaul Mackerras * 18469b6b563cSPaul Mackerras * A lot of boot-time code is duplicated here, because functions such 18479b6b563cSPaul Mackerras * as finish_node_interrupts, interpret_pci_props, etc. cannot use the 18489b6b563cSPaul Mackerras * slab allocator. 18499b6b563cSPaul Mackerras * 18509b6b563cSPaul Mackerras * This should probably be split up into smaller chunks. 18519b6b563cSPaul Mackerras */ 18529b6b563cSPaul Mackerras 1853cc5d0189SBenjamin Herrenschmidt static int of_finish_dynamic_node(struct device_node *node) 18549b6b563cSPaul Mackerras { 18559b6b563cSPaul Mackerras struct device_node *parent = of_get_parent(node); 18569b6b563cSPaul Mackerras int err = 0; 18579b6b563cSPaul Mackerras phandle *ibm_phandle; 18589b6b563cSPaul Mackerras 18599b6b563cSPaul Mackerras node->name = get_property(node, "name", NULL); 18609b6b563cSPaul Mackerras node->type = get_property(node, "device_type", NULL); 18619b6b563cSPaul Mackerras 18629b6b563cSPaul Mackerras if (!parent) { 18639b6b563cSPaul Mackerras err = -ENODEV; 18649b6b563cSPaul Mackerras goto out; 18659b6b563cSPaul Mackerras } 18669b6b563cSPaul Mackerras 18679b6b563cSPaul Mackerras /* We don't support that function on PowerMac, at least 18689b6b563cSPaul Mackerras * not yet 18699b6b563cSPaul Mackerras */ 1870e8222502SBenjamin Herrenschmidt if (machine_is(powermac)) 18719b6b563cSPaul Mackerras return -ENODEV; 18729b6b563cSPaul Mackerras 18739b6b563cSPaul Mackerras /* fix up new node's linux_phandle field */ 1874cc5d0189SBenjamin Herrenschmidt if ((ibm_phandle = (unsigned int *)get_property(node, 1875cc5d0189SBenjamin Herrenschmidt "ibm,phandle", NULL))) 18769b6b563cSPaul Mackerras node->linux_phandle = *ibm_phandle; 18779b6b563cSPaul Mackerras 18789b6b563cSPaul Mackerras out: 18799b6b563cSPaul Mackerras of_node_put(parent); 18809b6b563cSPaul Mackerras return err; 18819b6b563cSPaul Mackerras } 18829b6b563cSPaul Mackerras 18839b6b563cSPaul Mackerras static int prom_reconfig_notifier(struct notifier_block *nb, 18849b6b563cSPaul Mackerras unsigned long action, void *node) 18859b6b563cSPaul Mackerras { 18869b6b563cSPaul Mackerras int err; 18879b6b563cSPaul Mackerras 18889b6b563cSPaul Mackerras switch (action) { 18899b6b563cSPaul Mackerras case PSERIES_RECONFIG_ADD: 1890cc5d0189SBenjamin Herrenschmidt err = of_finish_dynamic_node(node); 1891cc5d0189SBenjamin Herrenschmidt if (!err) 1892cc5d0189SBenjamin Herrenschmidt finish_node(node, NULL, 0); 18939b6b563cSPaul Mackerras if (err < 0) { 18949b6b563cSPaul Mackerras printk(KERN_ERR "finish_node returned %d\n", err); 18959b6b563cSPaul Mackerras err = NOTIFY_BAD; 18969b6b563cSPaul Mackerras } 18979b6b563cSPaul Mackerras break; 18989b6b563cSPaul Mackerras default: 18999b6b563cSPaul Mackerras err = NOTIFY_DONE; 19009b6b563cSPaul Mackerras break; 19019b6b563cSPaul Mackerras } 19029b6b563cSPaul Mackerras return err; 19039b6b563cSPaul Mackerras } 19049b6b563cSPaul Mackerras 19059b6b563cSPaul Mackerras static struct notifier_block prom_reconfig_nb = { 19069b6b563cSPaul Mackerras .notifier_call = prom_reconfig_notifier, 19079b6b563cSPaul Mackerras .priority = 10, /* This one needs to run first */ 19089b6b563cSPaul Mackerras }; 19099b6b563cSPaul Mackerras 19109b6b563cSPaul Mackerras static int __init prom_reconfig_setup(void) 19119b6b563cSPaul Mackerras { 19129b6b563cSPaul Mackerras return pSeries_reconfig_notifier_register(&prom_reconfig_nb); 19139b6b563cSPaul Mackerras } 19149b6b563cSPaul Mackerras __initcall(prom_reconfig_setup); 19159b6b563cSPaul Mackerras #endif 19169b6b563cSPaul Mackerras 1917ecaa8b0fSDave C Boutcher struct property *of_find_property(struct device_node *np, const char *name, 19189b6b563cSPaul Mackerras int *lenp) 19199b6b563cSPaul Mackerras { 19209b6b563cSPaul Mackerras struct property *pp; 19219b6b563cSPaul Mackerras 1922088186deSDave C Boutcher read_lock(&devtree_lock); 19239b6b563cSPaul Mackerras for (pp = np->properties; pp != 0; pp = pp->next) 19249b6b563cSPaul Mackerras if (strcmp(pp->name, name) == 0) { 19259b6b563cSPaul Mackerras if (lenp != 0) 19269b6b563cSPaul Mackerras *lenp = pp->length; 1927088186deSDave C Boutcher break; 19289b6b563cSPaul Mackerras } 1929088186deSDave C Boutcher read_unlock(&devtree_lock); 1930088186deSDave C Boutcher 1931ecaa8b0fSDave C Boutcher return pp; 1932ecaa8b0fSDave C Boutcher } 1933ecaa8b0fSDave C Boutcher 1934ecaa8b0fSDave C Boutcher /* 1935ecaa8b0fSDave C Boutcher * Find a property with a given name for a given node 1936ecaa8b0fSDave C Boutcher * and return the value. 1937ecaa8b0fSDave C Boutcher */ 1938ecaa8b0fSDave C Boutcher unsigned char *get_property(struct device_node *np, const char *name, 1939ecaa8b0fSDave C Boutcher int *lenp) 1940ecaa8b0fSDave C Boutcher { 1941ecaa8b0fSDave C Boutcher struct property *pp = of_find_property(np,name,lenp); 1942088186deSDave C Boutcher return pp ? pp->value : NULL; 19439b6b563cSPaul Mackerras } 19449b6b563cSPaul Mackerras EXPORT_SYMBOL(get_property); 19459b6b563cSPaul Mackerras 19469b6b563cSPaul Mackerras /* 19479b6b563cSPaul Mackerras * Add a property to a node 19489b6b563cSPaul Mackerras */ 1949183d0202SBenjamin Herrenschmidt int prom_add_property(struct device_node* np, struct property* prop) 19509b6b563cSPaul Mackerras { 1951183d0202SBenjamin Herrenschmidt struct property **next; 19529b6b563cSPaul Mackerras 19539b6b563cSPaul Mackerras prop->next = NULL; 1954183d0202SBenjamin Herrenschmidt write_lock(&devtree_lock); 1955183d0202SBenjamin Herrenschmidt next = &np->properties; 1956183d0202SBenjamin Herrenschmidt while (*next) { 1957183d0202SBenjamin Herrenschmidt if (strcmp(prop->name, (*next)->name) == 0) { 1958183d0202SBenjamin Herrenschmidt /* duplicate ! don't insert it */ 1959183d0202SBenjamin Herrenschmidt write_unlock(&devtree_lock); 1960183d0202SBenjamin Herrenschmidt return -1; 1961183d0202SBenjamin Herrenschmidt } 19629b6b563cSPaul Mackerras next = &(*next)->next; 1963183d0202SBenjamin Herrenschmidt } 19649b6b563cSPaul Mackerras *next = prop; 1965183d0202SBenjamin Herrenschmidt write_unlock(&devtree_lock); 1966183d0202SBenjamin Herrenschmidt 1967799d6046SPaul Mackerras #ifdef CONFIG_PROC_DEVICETREE 1968183d0202SBenjamin Herrenschmidt /* try to add to proc as well if it was initialized */ 1969183d0202SBenjamin Herrenschmidt if (np->pde) 1970183d0202SBenjamin Herrenschmidt proc_device_tree_add_prop(np->pde, prop); 1971799d6046SPaul Mackerras #endif /* CONFIG_PROC_DEVICETREE */ 1972183d0202SBenjamin Herrenschmidt 1973183d0202SBenjamin Herrenschmidt return 0; 19749b6b563cSPaul Mackerras } 19759b6b563cSPaul Mackerras 1976088186deSDave C Boutcher /* 1977088186deSDave C Boutcher * Remove a property from a node. Note that we don't actually 1978088186deSDave C Boutcher * remove it, since we have given out who-knows-how-many pointers 1979088186deSDave C Boutcher * to the data using get-property. Instead we just move the property 1980088186deSDave C Boutcher * to the "dead properties" list, so it won't be found any more. 1981088186deSDave C Boutcher */ 1982088186deSDave C Boutcher int prom_remove_property(struct device_node *np, struct property *prop) 1983088186deSDave C Boutcher { 1984088186deSDave C Boutcher struct property **next; 1985088186deSDave C Boutcher int found = 0; 19869b6b563cSPaul Mackerras 1987088186deSDave C Boutcher write_lock(&devtree_lock); 1988088186deSDave C Boutcher next = &np->properties; 1989088186deSDave C Boutcher while (*next) { 1990088186deSDave C Boutcher if (*next == prop) { 1991088186deSDave C Boutcher /* found the node */ 1992088186deSDave C Boutcher *next = prop->next; 1993088186deSDave C Boutcher prop->next = np->deadprops; 1994088186deSDave C Boutcher np->deadprops = prop; 1995088186deSDave C Boutcher found = 1; 1996088186deSDave C Boutcher break; 1997088186deSDave C Boutcher } 1998088186deSDave C Boutcher next = &(*next)->next; 1999088186deSDave C Boutcher } 2000088186deSDave C Boutcher write_unlock(&devtree_lock); 2001088186deSDave C Boutcher 2002088186deSDave C Boutcher if (!found) 2003088186deSDave C Boutcher return -ENODEV; 2004088186deSDave C Boutcher 2005088186deSDave C Boutcher #ifdef CONFIG_PROC_DEVICETREE 2006088186deSDave C Boutcher /* try to remove the proc node as well */ 2007088186deSDave C Boutcher if (np->pde) 2008088186deSDave C Boutcher proc_device_tree_remove_prop(np->pde, prop); 2009088186deSDave C Boutcher #endif /* CONFIG_PROC_DEVICETREE */ 2010088186deSDave C Boutcher 2011088186deSDave C Boutcher return 0; 2012088186deSDave C Boutcher } 2013088186deSDave C Boutcher 2014088186deSDave C Boutcher /* 2015088186deSDave C Boutcher * Update a property in a node. Note that we don't actually 2016088186deSDave C Boutcher * remove it, since we have given out who-knows-how-many pointers 2017088186deSDave C Boutcher * to the data using get-property. Instead we just move the property 2018088186deSDave C Boutcher * to the "dead properties" list, and add the new property to the 2019088186deSDave C Boutcher * property list 2020088186deSDave C Boutcher */ 2021088186deSDave C Boutcher int prom_update_property(struct device_node *np, 2022088186deSDave C Boutcher struct property *newprop, 2023088186deSDave C Boutcher struct property *oldprop) 2024088186deSDave C Boutcher { 2025088186deSDave C Boutcher struct property **next; 2026088186deSDave C Boutcher int found = 0; 2027088186deSDave C Boutcher 2028088186deSDave C Boutcher write_lock(&devtree_lock); 2029088186deSDave C Boutcher next = &np->properties; 2030088186deSDave C Boutcher while (*next) { 2031088186deSDave C Boutcher if (*next == oldprop) { 2032088186deSDave C Boutcher /* found the node */ 2033088186deSDave C Boutcher newprop->next = oldprop->next; 2034088186deSDave C Boutcher *next = newprop; 2035088186deSDave C Boutcher oldprop->next = np->deadprops; 2036088186deSDave C Boutcher np->deadprops = oldprop; 2037088186deSDave C Boutcher found = 1; 2038088186deSDave C Boutcher break; 2039088186deSDave C Boutcher } 2040088186deSDave C Boutcher next = &(*next)->next; 2041088186deSDave C Boutcher } 2042088186deSDave C Boutcher write_unlock(&devtree_lock); 2043088186deSDave C Boutcher 2044088186deSDave C Boutcher if (!found) 2045088186deSDave C Boutcher return -ENODEV; 2046088186deSDave C Boutcher 2047088186deSDave C Boutcher #ifdef CONFIG_PROC_DEVICETREE 2048088186deSDave C Boutcher /* try to add to proc as well if it was initialized */ 2049088186deSDave C Boutcher if (np->pde) 2050088186deSDave C Boutcher proc_device_tree_update_prop(np->pde, newprop, oldprop); 2051088186deSDave C Boutcher #endif /* CONFIG_PROC_DEVICETREE */ 2052088186deSDave C Boutcher 2053088186deSDave C Boutcher return 0; 2054088186deSDave C Boutcher } 2055b68239eeSMichael Ellerman 2056b68239eeSMichael Ellerman #ifdef CONFIG_KEXEC 2057b68239eeSMichael Ellerman /* We may have allocated the flat device tree inside the crash kernel region 2058b68239eeSMichael Ellerman * in prom_init. If so we need to move it out into regular memory. */ 2059b68239eeSMichael Ellerman void kdump_move_device_tree(void) 2060b68239eeSMichael Ellerman { 2061b68239eeSMichael Ellerman unsigned long start, end; 2062b68239eeSMichael Ellerman struct boot_param_header *new; 2063b68239eeSMichael Ellerman 2064b68239eeSMichael Ellerman start = __pa((unsigned long)initial_boot_params); 2065b68239eeSMichael Ellerman end = start + initial_boot_params->totalsize; 2066b68239eeSMichael Ellerman 2067b68239eeSMichael Ellerman if (end < crashk_res.start || start > crashk_res.end) 2068b68239eeSMichael Ellerman return; 2069b68239eeSMichael Ellerman 2070b68239eeSMichael Ellerman new = (struct boot_param_header*) 2071b68239eeSMichael Ellerman __va(lmb_alloc(initial_boot_params->totalsize, PAGE_SIZE)); 2072b68239eeSMichael Ellerman 2073b68239eeSMichael Ellerman memcpy(new, initial_boot_params, initial_boot_params->totalsize); 2074b68239eeSMichael Ellerman 2075b68239eeSMichael Ellerman initial_boot_params = new; 2076b68239eeSMichael Ellerman 2077b68239eeSMichael Ellerman DBG("Flat device tree blob moved to %p\n", initial_boot_params); 2078b68239eeSMichael Ellerman 2079b68239eeSMichael Ellerman /* XXX should we unreserve the old DT? */ 2080b68239eeSMichael Ellerman } 2081b68239eeSMichael Ellerman #endif /* CONFIG_KEXEC */ 2082