prom.c 43 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792
  1. /*
  2. * Procedures for creating, accessing and interpreting the device tree.
  3. *
  4. * Paul Mackerras August 1996.
  5. * Copyright (C) 1996-2005 Paul Mackerras.
  6. *
  7. * Adapted for 64bit PowerPC by Dave Engebretsen and Peter Bergner.
  8. * {engebret|bergner}@us.ibm.com
  9. *
  10. * This program is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU General Public License
  12. * as published by the Free Software Foundation; either version
  13. * 2 of the License, or (at your option) any later version.
  14. */
  15. #undef DEBUG
  16. #include <stdarg.h>
  17. #include <linux/kernel.h>
  18. #include <linux/string.h>
  19. #include <linux/init.h>
  20. #include <linux/threads.h>
  21. #include <linux/spinlock.h>
  22. #include <linux/types.h>
  23. #include <linux/pci.h>
  24. #include <linux/stringify.h>
  25. #include <linux/delay.h>
  26. #include <linux/initrd.h>
  27. #include <linux/bitops.h>
  28. #include <linux/module.h>
  29. #include <linux/kexec.h>
  30. #include <linux/debugfs.h>
  31. #include <linux/irq.h>
  32. #include <asm/prom.h>
  33. #include <asm/rtas.h>
  34. #include <asm/lmb.h>
  35. #include <asm/page.h>
  36. #include <asm/processor.h>
  37. #include <asm/irq.h>
  38. #include <asm/io.h>
  39. #include <asm/kdump.h>
  40. #include <asm/smp.h>
  41. #include <asm/system.h>
  42. #include <asm/mmu.h>
  43. #include <asm/pgtable.h>
  44. #include <asm/pci.h>
  45. #include <asm/iommu.h>
  46. #include <asm/btext.h>
  47. #include <asm/sections.h>
  48. #include <asm/machdep.h>
  49. #include <asm/pSeries_reconfig.h>
  50. #include <asm/pci-bridge.h>
  51. #include <asm/kexec.h>
  52. #ifdef DEBUG
  53. #define DBG(fmt...) printk(KERN_ERR fmt)
  54. #else
  55. #define DBG(fmt...)
  56. #endif
  57. static int __initdata dt_root_addr_cells;
  58. static int __initdata dt_root_size_cells;
  59. #ifdef CONFIG_PPC64
  60. int __initdata iommu_is_off;
  61. int __initdata iommu_force_on;
  62. unsigned long tce_alloc_start, tce_alloc_end;
  63. #endif
  64. typedef u32 cell_t;
  65. #if 0
  66. static struct boot_param_header *initial_boot_params __initdata;
  67. #else
  68. struct boot_param_header *initial_boot_params;
  69. #endif
  70. static struct device_node *allnodes = NULL;
  71. /* use when traversing tree through the allnext, child, sibling,
  72. * or parent members of struct device_node.
  73. */
  74. static DEFINE_RWLOCK(devtree_lock);
  75. /* export that to outside world */
  76. struct device_node *of_chosen;
  77. static inline char *find_flat_dt_string(u32 offset)
  78. {
  79. return ((char *)initial_boot_params) +
  80. initial_boot_params->off_dt_strings + offset;
  81. }
  82. /**
  83. * This function is used to scan the flattened device-tree, it is
  84. * used to extract the memory informations at boot before we can
  85. * unflatten the tree
  86. */
  87. int __init of_scan_flat_dt(int (*it)(unsigned long node,
  88. const char *uname, int depth,
  89. void *data),
  90. void *data)
  91. {
  92. unsigned long p = ((unsigned long)initial_boot_params) +
  93. initial_boot_params->off_dt_struct;
  94. int rc = 0;
  95. int depth = -1;
  96. do {
  97. u32 tag = *((u32 *)p);
  98. char *pathp;
  99. p += 4;
  100. if (tag == OF_DT_END_NODE) {
  101. depth --;
  102. continue;
  103. }
  104. if (tag == OF_DT_NOP)
  105. continue;
  106. if (tag == OF_DT_END)
  107. break;
  108. if (tag == OF_DT_PROP) {
  109. u32 sz = *((u32 *)p);
  110. p += 8;
  111. if (initial_boot_params->version < 0x10)
  112. p = _ALIGN(p, sz >= 8 ? 8 : 4);
  113. p += sz;
  114. p = _ALIGN(p, 4);
  115. continue;
  116. }
  117. if (tag != OF_DT_BEGIN_NODE) {
  118. printk(KERN_WARNING "Invalid tag %x scanning flattened"
  119. " device tree !\n", tag);
  120. return -EINVAL;
  121. }
  122. depth++;
  123. pathp = (char *)p;
  124. p = _ALIGN(p + strlen(pathp) + 1, 4);
  125. if ((*pathp) == '/') {
  126. char *lp, *np;
  127. for (lp = NULL, np = pathp; *np; np++)
  128. if ((*np) == '/')
  129. lp = np+1;
  130. if (lp != NULL)
  131. pathp = lp;
  132. }
  133. rc = it(p, pathp, depth, data);
  134. if (rc != 0)
  135. break;
  136. } while(1);
  137. return rc;
  138. }
  139. unsigned long __init of_get_flat_dt_root(void)
  140. {
  141. unsigned long p = ((unsigned long)initial_boot_params) +
  142. initial_boot_params->off_dt_struct;
  143. while(*((u32 *)p) == OF_DT_NOP)
  144. p += 4;
  145. BUG_ON (*((u32 *)p) != OF_DT_BEGIN_NODE);
  146. p += 4;
  147. return _ALIGN(p + strlen((char *)p) + 1, 4);
  148. }
  149. /**
  150. * This function can be used within scan_flattened_dt callback to get
  151. * access to properties
  152. */
  153. void* __init of_get_flat_dt_prop(unsigned long node, const char *name,
  154. unsigned long *size)
  155. {
  156. unsigned long p = node;
  157. do {
  158. u32 tag = *((u32 *)p);
  159. u32 sz, noff;
  160. const char *nstr;
  161. p += 4;
  162. if (tag == OF_DT_NOP)
  163. continue;
  164. if (tag != OF_DT_PROP)
  165. return NULL;
  166. sz = *((u32 *)p);
  167. noff = *((u32 *)(p + 4));
  168. p += 8;
  169. if (initial_boot_params->version < 0x10)
  170. p = _ALIGN(p, sz >= 8 ? 8 : 4);
  171. nstr = find_flat_dt_string(noff);
  172. if (nstr == NULL) {
  173. printk(KERN_WARNING "Can't find property index"
  174. " name !\n");
  175. return NULL;
  176. }
  177. if (strcmp(name, nstr) == 0) {
  178. if (size)
  179. *size = sz;
  180. return (void *)p;
  181. }
  182. p += sz;
  183. p = _ALIGN(p, 4);
  184. } while(1);
  185. }
  186. int __init of_flat_dt_is_compatible(unsigned long node, const char *compat)
  187. {
  188. const char* cp;
  189. unsigned long cplen, l;
  190. cp = of_get_flat_dt_prop(node, "compatible", &cplen);
  191. if (cp == NULL)
  192. return 0;
  193. while (cplen > 0) {
  194. if (strncasecmp(cp, compat, strlen(compat)) == 0)
  195. return 1;
  196. l = strlen(cp) + 1;
  197. cp += l;
  198. cplen -= l;
  199. }
  200. return 0;
  201. }
  202. static void *__init unflatten_dt_alloc(unsigned long *mem, unsigned long size,
  203. unsigned long align)
  204. {
  205. void *res;
  206. *mem = _ALIGN(*mem, align);
  207. res = (void *)*mem;
  208. *mem += size;
  209. return res;
  210. }
  211. static unsigned long __init unflatten_dt_node(unsigned long mem,
  212. unsigned long *p,
  213. struct device_node *dad,
  214. struct device_node ***allnextpp,
  215. unsigned long fpsize)
  216. {
  217. struct device_node *np;
  218. struct property *pp, **prev_pp = NULL;
  219. char *pathp;
  220. u32 tag;
  221. unsigned int l, allocl;
  222. int has_name = 0;
  223. int new_format = 0;
  224. tag = *((u32 *)(*p));
  225. if (tag != OF_DT_BEGIN_NODE) {
  226. printk("Weird tag at start of node: %x\n", tag);
  227. return mem;
  228. }
  229. *p += 4;
  230. pathp = (char *)*p;
  231. l = allocl = strlen(pathp) + 1;
  232. *p = _ALIGN(*p + l, 4);
  233. /* version 0x10 has a more compact unit name here instead of the full
  234. * path. we accumulate the full path size using "fpsize", we'll rebuild
  235. * it later. We detect this because the first character of the name is
  236. * not '/'.
  237. */
  238. if ((*pathp) != '/') {
  239. new_format = 1;
  240. if (fpsize == 0) {
  241. /* root node: special case. fpsize accounts for path
  242. * plus terminating zero. root node only has '/', so
  243. * fpsize should be 2, but we want to avoid the first
  244. * level nodes to have two '/' so we use fpsize 1 here
  245. */
  246. fpsize = 1;
  247. allocl = 2;
  248. } else {
  249. /* account for '/' and path size minus terminal 0
  250. * already in 'l'
  251. */
  252. fpsize += l;
  253. allocl = fpsize;
  254. }
  255. }
  256. np = unflatten_dt_alloc(&mem, sizeof(struct device_node) + allocl,
  257. __alignof__(struct device_node));
  258. if (allnextpp) {
  259. memset(np, 0, sizeof(*np));
  260. np->full_name = ((char*)np) + sizeof(struct device_node);
  261. if (new_format) {
  262. char *p = np->full_name;
  263. /* rebuild full path for new format */
  264. if (dad && dad->parent) {
  265. strcpy(p, dad->full_name);
  266. #ifdef DEBUG
  267. if ((strlen(p) + l + 1) != allocl) {
  268. DBG("%s: p: %d, l: %d, a: %d\n",
  269. pathp, (int)strlen(p), l, allocl);
  270. }
  271. #endif
  272. p += strlen(p);
  273. }
  274. *(p++) = '/';
  275. memcpy(p, pathp, l);
  276. } else
  277. memcpy(np->full_name, pathp, l);
  278. prev_pp = &np->properties;
  279. **allnextpp = np;
  280. *allnextpp = &np->allnext;
  281. if (dad != NULL) {
  282. np->parent = dad;
  283. /* we temporarily use the next field as `last_child'*/
  284. if (dad->next == 0)
  285. dad->child = np;
  286. else
  287. dad->next->sibling = np;
  288. dad->next = np;
  289. }
  290. kref_init(&np->kref);
  291. }
  292. while(1) {
  293. u32 sz, noff;
  294. char *pname;
  295. tag = *((u32 *)(*p));
  296. if (tag == OF_DT_NOP) {
  297. *p += 4;
  298. continue;
  299. }
  300. if (tag != OF_DT_PROP)
  301. break;
  302. *p += 4;
  303. sz = *((u32 *)(*p));
  304. noff = *((u32 *)((*p) + 4));
  305. *p += 8;
  306. if (initial_boot_params->version < 0x10)
  307. *p = _ALIGN(*p, sz >= 8 ? 8 : 4);
  308. pname = find_flat_dt_string(noff);
  309. if (pname == NULL) {
  310. printk("Can't find property name in list !\n");
  311. break;
  312. }
  313. if (strcmp(pname, "name") == 0)
  314. has_name = 1;
  315. l = strlen(pname) + 1;
  316. pp = unflatten_dt_alloc(&mem, sizeof(struct property),
  317. __alignof__(struct property));
  318. if (allnextpp) {
  319. if (strcmp(pname, "linux,phandle") == 0) {
  320. np->node = *((u32 *)*p);
  321. if (np->linux_phandle == 0)
  322. np->linux_phandle = np->node;
  323. }
  324. if (strcmp(pname, "ibm,phandle") == 0)
  325. np->linux_phandle = *((u32 *)*p);
  326. pp->name = pname;
  327. pp->length = sz;
  328. pp->value = (void *)*p;
  329. *prev_pp = pp;
  330. prev_pp = &pp->next;
  331. }
  332. *p = _ALIGN((*p) + sz, 4);
  333. }
  334. /* with version 0x10 we may not have the name property, recreate
  335. * it here from the unit name if absent
  336. */
  337. if (!has_name) {
  338. char *p = pathp, *ps = pathp, *pa = NULL;
  339. int sz;
  340. while (*p) {
  341. if ((*p) == '@')
  342. pa = p;
  343. if ((*p) == '/')
  344. ps = p + 1;
  345. p++;
  346. }
  347. if (pa < ps)
  348. pa = p;
  349. sz = (pa - ps) + 1;
  350. pp = unflatten_dt_alloc(&mem, sizeof(struct property) + sz,
  351. __alignof__(struct property));
  352. if (allnextpp) {
  353. pp->name = "name";
  354. pp->length = sz;
  355. pp->value = (unsigned char *)(pp + 1);
  356. *prev_pp = pp;
  357. prev_pp = &pp->next;
  358. memcpy(pp->value, ps, sz - 1);
  359. ((char *)pp->value)[sz - 1] = 0;
  360. DBG("fixed up name for %s -> %s\n", pathp, pp->value);
  361. }
  362. }
  363. if (allnextpp) {
  364. *prev_pp = NULL;
  365. np->name = get_property(np, "name", NULL);
  366. np->type = get_property(np, "device_type", NULL);
  367. if (!np->name)
  368. np->name = "<NULL>";
  369. if (!np->type)
  370. np->type = "<NULL>";
  371. }
  372. while (tag == OF_DT_BEGIN_NODE) {
  373. mem = unflatten_dt_node(mem, p, np, allnextpp, fpsize);
  374. tag = *((u32 *)(*p));
  375. }
  376. if (tag != OF_DT_END_NODE) {
  377. printk("Weird tag at end of node: %x\n", tag);
  378. return mem;
  379. }
  380. *p += 4;
  381. return mem;
  382. }
  383. static int __init early_parse_mem(char *p)
  384. {
  385. if (!p)
  386. return 1;
  387. memory_limit = PAGE_ALIGN(memparse(p, &p));
  388. DBG("memory limit = 0x%lx\n", memory_limit);
  389. return 0;
  390. }
  391. early_param("mem", early_parse_mem);
  392. /*
  393. * The device tree may be allocated below our memory limit, or inside the
  394. * crash kernel region for kdump. If so, move it out now.
  395. */
  396. static void move_device_tree(void)
  397. {
  398. unsigned long start, size;
  399. void *p;
  400. DBG("-> move_device_tree\n");
  401. start = __pa(initial_boot_params);
  402. size = initial_boot_params->totalsize;
  403. if ((memory_limit && (start + size) > memory_limit) ||
  404. overlaps_crashkernel(start, size)) {
  405. p = __va(lmb_alloc_base(size, PAGE_SIZE, lmb.rmo_size));
  406. memcpy(p, initial_boot_params, size);
  407. initial_boot_params = (struct boot_param_header *)p;
  408. DBG("Moved device tree to 0x%p\n", p);
  409. }
  410. DBG("<- move_device_tree\n");
  411. }
  412. /**
  413. * unflattens the device-tree passed by the firmware, creating the
  414. * tree of struct device_node. It also fills the "name" and "type"
  415. * pointers of the nodes so the normal device-tree walking functions
  416. * can be used (this used to be done by finish_device_tree)
  417. */
  418. void __init unflatten_device_tree(void)
  419. {
  420. unsigned long start, mem, size;
  421. struct device_node **allnextp = &allnodes;
  422. DBG(" -> unflatten_device_tree()\n");
  423. /* First pass, scan for size */
  424. start = ((unsigned long)initial_boot_params) +
  425. initial_boot_params->off_dt_struct;
  426. size = unflatten_dt_node(0, &start, NULL, NULL, 0);
  427. size = (size | 3) + 1;
  428. DBG(" size is %lx, allocating...\n", size);
  429. /* Allocate memory for the expanded device tree */
  430. mem = lmb_alloc(size + 4, __alignof__(struct device_node));
  431. mem = (unsigned long) __va(mem);
  432. ((u32 *)mem)[size / 4] = 0xdeadbeef;
  433. DBG(" unflattening %lx...\n", mem);
  434. /* Second pass, do actual unflattening */
  435. start = ((unsigned long)initial_boot_params) +
  436. initial_boot_params->off_dt_struct;
  437. unflatten_dt_node(mem, &start, NULL, &allnextp, 0);
  438. if (*((u32 *)start) != OF_DT_END)
  439. printk(KERN_WARNING "Weird tag at end of tree: %08x\n", *((u32 *)start));
  440. if (((u32 *)mem)[size / 4] != 0xdeadbeef)
  441. printk(KERN_WARNING "End of tree marker overwritten: %08x\n",
  442. ((u32 *)mem)[size / 4] );
  443. *allnextp = NULL;
  444. /* Get pointer to OF "/chosen" node for use everywhere */
  445. of_chosen = of_find_node_by_path("/chosen");
  446. if (of_chosen == NULL)
  447. of_chosen = of_find_node_by_path("/chosen@0");
  448. DBG(" <- unflatten_device_tree()\n");
  449. }
  450. /*
  451. * ibm,pa-features is a per-cpu property that contains a string of
  452. * attribute descriptors, each of which has a 2 byte header plus up
  453. * to 254 bytes worth of processor attribute bits. First header
  454. * byte specifies the number of bytes following the header.
  455. * Second header byte is an "attribute-specifier" type, of which
  456. * zero is the only currently-defined value.
  457. * Implementation: Pass in the byte and bit offset for the feature
  458. * that we are interested in. The function will return -1 if the
  459. * pa-features property is missing, or a 1/0 to indicate if the feature
  460. * is supported/not supported. Note that the bit numbers are
  461. * big-endian to match the definition in PAPR.
  462. */
  463. static struct ibm_pa_feature {
  464. unsigned long cpu_features; /* CPU_FTR_xxx bit */
  465. unsigned int cpu_user_ftrs; /* PPC_FEATURE_xxx bit */
  466. unsigned char pabyte; /* byte number in ibm,pa-features */
  467. unsigned char pabit; /* bit number (big-endian) */
  468. unsigned char invert; /* if 1, pa bit set => clear feature */
  469. } ibm_pa_features[] __initdata = {
  470. {0, PPC_FEATURE_HAS_MMU, 0, 0, 0},
  471. {0, PPC_FEATURE_HAS_FPU, 0, 1, 0},
  472. {CPU_FTR_SLB, 0, 0, 2, 0},
  473. {CPU_FTR_CTRL, 0, 0, 3, 0},
  474. {CPU_FTR_NOEXECUTE, 0, 0, 6, 0},
  475. {CPU_FTR_NODSISRALIGN, 0, 1, 1, 1},
  476. #if 0
  477. /* put this back once we know how to test if firmware does 64k IO */
  478. {CPU_FTR_CI_LARGE_PAGE, 0, 1, 2, 0},
  479. #endif
  480. {CPU_FTR_REAL_LE, PPC_FEATURE_TRUE_LE, 5, 0, 0},
  481. };
  482. static void __init scan_features(unsigned long node, unsigned char *ftrs,
  483. unsigned long tablelen,
  484. struct ibm_pa_feature *fp,
  485. unsigned long ft_size)
  486. {
  487. unsigned long i, len, bit;
  488. /* find descriptor with type == 0 */
  489. for (;;) {
  490. if (tablelen < 3)
  491. return;
  492. len = 2 + ftrs[0];
  493. if (tablelen < len)
  494. return; /* descriptor 0 not found */
  495. if (ftrs[1] == 0)
  496. break;
  497. tablelen -= len;
  498. ftrs += len;
  499. }
  500. /* loop over bits we know about */
  501. for (i = 0; i < ft_size; ++i, ++fp) {
  502. if (fp->pabyte >= ftrs[0])
  503. continue;
  504. bit = (ftrs[2 + fp->pabyte] >> (7 - fp->pabit)) & 1;
  505. if (bit ^ fp->invert) {
  506. cur_cpu_spec->cpu_features |= fp->cpu_features;
  507. cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftrs;
  508. } else {
  509. cur_cpu_spec->cpu_features &= ~fp->cpu_features;
  510. cur_cpu_spec->cpu_user_features &= ~fp->cpu_user_ftrs;
  511. }
  512. }
  513. }
  514. static void __init check_cpu_pa_features(unsigned long node)
  515. {
  516. unsigned char *pa_ftrs;
  517. unsigned long tablelen;
  518. pa_ftrs = of_get_flat_dt_prop(node, "ibm,pa-features", &tablelen);
  519. if (pa_ftrs == NULL)
  520. return;
  521. scan_features(node, pa_ftrs, tablelen,
  522. ibm_pa_features, ARRAY_SIZE(ibm_pa_features));
  523. }
  524. static struct feature_property {
  525. const char *name;
  526. u32 min_value;
  527. unsigned long cpu_feature;
  528. unsigned long cpu_user_ftr;
  529. } feature_properties[] __initdata = {
  530. #ifdef CONFIG_ALTIVEC
  531. {"altivec", 0, CPU_FTR_ALTIVEC, PPC_FEATURE_HAS_ALTIVEC},
  532. {"ibm,vmx", 1, CPU_FTR_ALTIVEC, PPC_FEATURE_HAS_ALTIVEC},
  533. #endif /* CONFIG_ALTIVEC */
  534. #ifdef CONFIG_PPC64
  535. {"ibm,dfp", 1, 0, PPC_FEATURE_HAS_DFP},
  536. {"ibm,purr", 1, CPU_FTR_PURR, 0},
  537. {"ibm,spurr", 1, CPU_FTR_SPURR, 0},
  538. #endif /* CONFIG_PPC64 */
  539. };
  540. static void __init check_cpu_feature_properties(unsigned long node)
  541. {
  542. unsigned long i;
  543. struct feature_property *fp = feature_properties;
  544. const u32 *prop;
  545. for (i = 0; i < ARRAY_SIZE(feature_properties); ++i, ++fp) {
  546. prop = of_get_flat_dt_prop(node, fp->name, NULL);
  547. if (prop && *prop >= fp->min_value) {
  548. cur_cpu_spec->cpu_features |= fp->cpu_feature;
  549. cur_cpu_spec->cpu_user_features |= fp->cpu_user_ftr;
  550. }
  551. }
  552. }
  553. static int __init early_init_dt_scan_cpus(unsigned long node,
  554. const char *uname, int depth,
  555. void *data)
  556. {
  557. static int logical_cpuid = 0;
  558. char *type = of_get_flat_dt_prop(node, "device_type", NULL);
  559. const u32 *prop;
  560. const u32 *intserv;
  561. int i, nthreads;
  562. unsigned long len;
  563. int found = 0;
  564. /* We are scanning "cpu" nodes only */
  565. if (type == NULL || strcmp(type, "cpu") != 0)
  566. return 0;
  567. /* Get physical cpuid */
  568. intserv = of_get_flat_dt_prop(node, "ibm,ppc-interrupt-server#s", &len);
  569. if (intserv) {
  570. nthreads = len / sizeof(int);
  571. } else {
  572. intserv = of_get_flat_dt_prop(node, "reg", NULL);
  573. nthreads = 1;
  574. }
  575. /*
  576. * Now see if any of these threads match our boot cpu.
  577. * NOTE: This must match the parsing done in smp_setup_cpu_maps.
  578. */
  579. for (i = 0; i < nthreads; i++) {
  580. /*
  581. * version 2 of the kexec param format adds the phys cpuid of
  582. * booted proc.
  583. */
  584. if (initial_boot_params && initial_boot_params->version >= 2) {
  585. if (intserv[i] ==
  586. initial_boot_params->boot_cpuid_phys) {
  587. found = 1;
  588. break;
  589. }
  590. } else {
  591. /*
  592. * Check if it's the boot-cpu, set it's hw index now,
  593. * unfortunately this format did not support booting
  594. * off secondary threads.
  595. */
  596. if (of_get_flat_dt_prop(node,
  597. "linux,boot-cpu", NULL) != NULL) {
  598. found = 1;
  599. break;
  600. }
  601. }
  602. #ifdef CONFIG_SMP
  603. /* logical cpu id is always 0 on UP kernels */
  604. logical_cpuid++;
  605. #endif
  606. }
  607. if (found) {
  608. DBG("boot cpu: logical %d physical %d\n", logical_cpuid,
  609. intserv[i]);
  610. boot_cpuid = logical_cpuid;
  611. set_hard_smp_processor_id(boot_cpuid, intserv[i]);
  612. /*
  613. * PAPR defines "logical" PVR values for cpus that
  614. * meet various levels of the architecture:
  615. * 0x0f000001 Architecture version 2.04
  616. * 0x0f000002 Architecture version 2.05
  617. * If the cpu-version property in the cpu node contains
  618. * such a value, we call identify_cpu again with the
  619. * logical PVR value in order to use the cpu feature
  620. * bits appropriate for the architecture level.
  621. *
  622. * A POWER6 partition in "POWER6 architected" mode
  623. * uses the 0x0f000002 PVR value; in POWER5+ mode
  624. * it uses 0x0f000001.
  625. */
  626. prop = of_get_flat_dt_prop(node, "cpu-version", NULL);
  627. if (prop && (*prop & 0xff000000) == 0x0f000000)
  628. identify_cpu(0, *prop);
  629. }
  630. check_cpu_feature_properties(node);
  631. check_cpu_pa_features(node);
  632. #ifdef CONFIG_PPC_PSERIES
  633. if (nthreads > 1)
  634. cur_cpu_spec->cpu_features |= CPU_FTR_SMT;
  635. else
  636. cur_cpu_spec->cpu_features &= ~CPU_FTR_SMT;
  637. #endif
  638. return 0;
  639. }
  640. static int __init early_init_dt_scan_chosen(unsigned long node,
  641. const char *uname, int depth, void *data)
  642. {
  643. unsigned long *lprop;
  644. unsigned long l;
  645. char *p;
  646. DBG("search \"chosen\", depth: %d, uname: %s\n", depth, uname);
  647. if (depth != 1 ||
  648. (strcmp(uname, "chosen") != 0 && strcmp(uname, "chosen@0") != 0))
  649. return 0;
  650. #ifdef CONFIG_PPC64
  651. /* check if iommu is forced on or off */
  652. if (of_get_flat_dt_prop(node, "linux,iommu-off", NULL) != NULL)
  653. iommu_is_off = 1;
  654. if (of_get_flat_dt_prop(node, "linux,iommu-force-on", NULL) != NULL)
  655. iommu_force_on = 1;
  656. #endif
  657. /* mem=x on the command line is the preferred mechanism */
  658. lprop = of_get_flat_dt_prop(node, "linux,memory-limit", NULL);
  659. if (lprop)
  660. memory_limit = *lprop;
  661. #ifdef CONFIG_PPC64
  662. lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-start", NULL);
  663. if (lprop)
  664. tce_alloc_start = *lprop;
  665. lprop = of_get_flat_dt_prop(node, "linux,tce-alloc-end", NULL);
  666. if (lprop)
  667. tce_alloc_end = *lprop;
  668. #endif
  669. #ifdef CONFIG_KEXEC
  670. lprop = (u64*)of_get_flat_dt_prop(node, "linux,crashkernel-base", NULL);
  671. if (lprop)
  672. crashk_res.start = *lprop;
  673. lprop = (u64*)of_get_flat_dt_prop(node, "linux,crashkernel-size", NULL);
  674. if (lprop)
  675. crashk_res.end = crashk_res.start + *lprop - 1;
  676. #endif
  677. /* Retreive command line */
  678. p = of_get_flat_dt_prop(node, "bootargs", &l);
  679. if (p != NULL && l > 0)
  680. strlcpy(cmd_line, p, min((int)l, COMMAND_LINE_SIZE));
  681. #ifdef CONFIG_CMDLINE
  682. if (p == NULL || l == 0 || (l == 1 && (*p) == 0))
  683. strlcpy(cmd_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE);
  684. #endif /* CONFIG_CMDLINE */
  685. DBG("Command line is: %s\n", cmd_line);
  686. /* break now */
  687. return 1;
  688. }
  689. static int __init early_init_dt_scan_root(unsigned long node,
  690. const char *uname, int depth, void *data)
  691. {
  692. u32 *prop;
  693. if (depth != 0)
  694. return 0;
  695. prop = of_get_flat_dt_prop(node, "#size-cells", NULL);
  696. dt_root_size_cells = (prop == NULL) ? 1 : *prop;
  697. DBG("dt_root_size_cells = %x\n", dt_root_size_cells);
  698. prop = of_get_flat_dt_prop(node, "#address-cells", NULL);
  699. dt_root_addr_cells = (prop == NULL) ? 2 : *prop;
  700. DBG("dt_root_addr_cells = %x\n", dt_root_addr_cells);
  701. /* break now */
  702. return 1;
  703. }
  704. static unsigned long __init dt_mem_next_cell(int s, cell_t **cellp)
  705. {
  706. cell_t *p = *cellp;
  707. *cellp = p + s;
  708. return of_read_ulong(p, s);
  709. }
  710. #ifdef CONFIG_PPC_PSERIES
  711. /*
  712. * Interpret the ibm,dynamic-memory property in the
  713. * /ibm,dynamic-reconfiguration-memory node.
  714. * This contains a list of memory blocks along with NUMA affinity
  715. * information.
  716. */
  717. static int __init early_init_dt_scan_drconf_memory(unsigned long node)
  718. {
  719. cell_t *dm, *ls;
  720. unsigned long l, n;
  721. unsigned long base, size, lmb_size, flags;
  722. ls = (cell_t *)of_get_flat_dt_prop(node, "ibm,lmb-size", &l);
  723. if (ls == NULL || l < dt_root_size_cells * sizeof(cell_t))
  724. return 0;
  725. lmb_size = dt_mem_next_cell(dt_root_size_cells, &ls);
  726. dm = (cell_t *)of_get_flat_dt_prop(node, "ibm,dynamic-memory", &l);
  727. if (dm == NULL || l < sizeof(cell_t))
  728. return 0;
  729. n = *dm++; /* number of entries */
  730. if (l < (n * (dt_root_addr_cells + 4) + 1) * sizeof(cell_t))
  731. return 0;
  732. for (; n != 0; --n) {
  733. base = dt_mem_next_cell(dt_root_addr_cells, &dm);
  734. flags = dm[3];
  735. /* skip DRC index, pad, assoc. list index, flags */
  736. dm += 4;
  737. /* skip this block if the reserved bit is set in flags (0x80)
  738. or if the block is not assigned to this partition (0x8) */
  739. if ((flags & 0x80) || !(flags & 0x8))
  740. continue;
  741. size = lmb_size;
  742. if (iommu_is_off) {
  743. if (base >= 0x80000000ul)
  744. continue;
  745. if ((base + size) > 0x80000000ul)
  746. size = 0x80000000ul - base;
  747. }
  748. lmb_add(base, size);
  749. }
  750. lmb_dump_all();
  751. return 0;
  752. }
  753. #else
  754. #define early_init_dt_scan_drconf_memory(node) 0
  755. #endif /* CONFIG_PPC_PSERIES */
  756. static int __init early_init_dt_scan_memory(unsigned long node,
  757. const char *uname, int depth, void *data)
  758. {
  759. char *type = of_get_flat_dt_prop(node, "device_type", NULL);
  760. cell_t *reg, *endp;
  761. unsigned long l;
  762. /* Look for the ibm,dynamic-reconfiguration-memory node */
  763. if (depth == 1 &&
  764. strcmp(uname, "ibm,dynamic-reconfiguration-memory") == 0)
  765. return early_init_dt_scan_drconf_memory(node);
  766. /* We are scanning "memory" nodes only */
  767. if (type == NULL) {
  768. /*
  769. * The longtrail doesn't have a device_type on the
  770. * /memory node, so look for the node called /memory@0.
  771. */
  772. if (depth != 1 || strcmp(uname, "memory@0") != 0)
  773. return 0;
  774. } else if (strcmp(type, "memory") != 0)
  775. return 0;
  776. reg = (cell_t *)of_get_flat_dt_prop(node, "linux,usable-memory", &l);
  777. if (reg == NULL)
  778. reg = (cell_t *)of_get_flat_dt_prop(node, "reg", &l);
  779. if (reg == NULL)
  780. return 0;
  781. endp = reg + (l / sizeof(cell_t));
  782. DBG("memory scan node %s, reg size %ld, data: %x %x %x %x,\n",
  783. uname, l, reg[0], reg[1], reg[2], reg[3]);
  784. while ((endp - reg) >= (dt_root_addr_cells + dt_root_size_cells)) {
  785. unsigned long base, size;
  786. base = dt_mem_next_cell(dt_root_addr_cells, &reg);
  787. size = dt_mem_next_cell(dt_root_size_cells, &reg);
  788. if (size == 0)
  789. continue;
  790. DBG(" - %lx , %lx\n", base, size);
  791. #ifdef CONFIG_PPC64
  792. if (iommu_is_off) {
  793. if (base >= 0x80000000ul)
  794. continue;
  795. if ((base + size) > 0x80000000ul)
  796. size = 0x80000000ul - base;
  797. }
  798. #endif
  799. lmb_add(base, size);
  800. }
  801. return 0;
  802. }
  803. static void __init early_reserve_mem(void)
  804. {
  805. u64 base, size;
  806. u64 *reserve_map;
  807. unsigned long self_base;
  808. unsigned long self_size;
  809. reserve_map = (u64 *)(((unsigned long)initial_boot_params) +
  810. initial_boot_params->off_mem_rsvmap);
  811. /* before we do anything, lets reserve the dt blob */
  812. self_base = __pa((unsigned long)initial_boot_params);
  813. self_size = initial_boot_params->totalsize;
  814. lmb_reserve(self_base, self_size);
  815. #ifdef CONFIG_PPC32
  816. /*
  817. * Handle the case where we might be booting from an old kexec
  818. * image that setup the mem_rsvmap as pairs of 32-bit values
  819. */
  820. if (*reserve_map > 0xffffffffull) {
  821. u32 base_32, size_32;
  822. u32 *reserve_map_32 = (u32 *)reserve_map;
  823. while (1) {
  824. base_32 = *(reserve_map_32++);
  825. size_32 = *(reserve_map_32++);
  826. if (size_32 == 0)
  827. break;
  828. /* skip if the reservation is for the blob */
  829. if (base_32 == self_base && size_32 == self_size)
  830. continue;
  831. DBG("reserving: %x -> %x\n", base_32, size_32);
  832. lmb_reserve(base_32, size_32);
  833. }
  834. return;
  835. }
  836. #endif
  837. while (1) {
  838. base = *(reserve_map++);
  839. size = *(reserve_map++);
  840. if (size == 0)
  841. break;
  842. /* skip if the reservation is for the blob */
  843. if (base == self_base && size == self_size)
  844. continue;
  845. DBG("reserving: %llx -> %llx\n", base, size);
  846. lmb_reserve(base, size);
  847. }
  848. #if 0
  849. DBG("memory reserved, lmbs :\n");
  850. lmb_dump_all();
  851. #endif
  852. }
  853. void __init early_init_devtree(void *params)
  854. {
  855. DBG(" -> early_init_devtree()\n");
  856. /* Setup flat device-tree pointer */
  857. initial_boot_params = params;
  858. #ifdef CONFIG_PPC_RTAS
  859. /* Some machines might need RTAS info for debugging, grab it now. */
  860. of_scan_flat_dt(early_init_dt_scan_rtas, NULL);
  861. #endif
  862. /* Retrieve various informations from the /chosen node of the
  863. * device-tree, including the platform type, initrd location and
  864. * size, TCE reserve, and more ...
  865. */
  866. of_scan_flat_dt(early_init_dt_scan_chosen, NULL);
  867. /* Scan memory nodes and rebuild LMBs */
  868. lmb_init();
  869. of_scan_flat_dt(early_init_dt_scan_root, NULL);
  870. of_scan_flat_dt(early_init_dt_scan_memory, NULL);
  871. /* Save command line for /proc/cmdline and then parse parameters */
  872. strlcpy(saved_command_line, cmd_line, COMMAND_LINE_SIZE);
  873. parse_early_param();
  874. /* Reserve LMB regions used by kernel, initrd, dt, etc... */
  875. lmb_reserve(PHYSICAL_START, __pa(klimit) - PHYSICAL_START);
  876. reserve_kdump_trampoline();
  877. reserve_crashkernel();
  878. early_reserve_mem();
  879. lmb_enforce_memory_limit(memory_limit);
  880. lmb_analyze();
  881. DBG("Phys. mem: %lx\n", lmb_phys_mem_size());
  882. /* We may need to relocate the flat tree, do it now.
  883. * FIXME .. and the initrd too? */
  884. move_device_tree();
  885. DBG("Scanning CPUs ...\n");
  886. /* Retreive CPU related informations from the flat tree
  887. * (altivec support, boot CPU ID, ...)
  888. */
  889. of_scan_flat_dt(early_init_dt_scan_cpus, NULL);
  890. DBG(" <- early_init_devtree()\n");
  891. }
  892. #undef printk
  893. int
  894. prom_n_addr_cells(struct device_node* np)
  895. {
  896. const int *ip;
  897. do {
  898. if (np->parent)
  899. np = np->parent;
  900. ip = get_property(np, "#address-cells", NULL);
  901. if (ip != NULL)
  902. return *ip;
  903. } while (np->parent);
  904. /* No #address-cells property for the root node, default to 1 */
  905. return 1;
  906. }
  907. EXPORT_SYMBOL(prom_n_addr_cells);
  908. int
  909. prom_n_size_cells(struct device_node* np)
  910. {
  911. const int* ip;
  912. do {
  913. if (np->parent)
  914. np = np->parent;
  915. ip = get_property(np, "#size-cells", NULL);
  916. if (ip != NULL)
  917. return *ip;
  918. } while (np->parent);
  919. /* No #size-cells property for the root node, default to 1 */
  920. return 1;
  921. }
  922. EXPORT_SYMBOL(prom_n_size_cells);
  923. /**
  924. * Construct and return a list of the device_nodes with a given name.
  925. */
  926. struct device_node *find_devices(const char *name)
  927. {
  928. struct device_node *head, **prevp, *np;
  929. prevp = &head;
  930. for (np = allnodes; np != 0; np = np->allnext) {
  931. if (np->name != 0 && strcasecmp(np->name, name) == 0) {
  932. *prevp = np;
  933. prevp = &np->next;
  934. }
  935. }
  936. *prevp = NULL;
  937. return head;
  938. }
  939. EXPORT_SYMBOL(find_devices);
  940. /**
  941. * Construct and return a list of the device_nodes with a given type.
  942. */
  943. struct device_node *find_type_devices(const char *type)
  944. {
  945. struct device_node *head, **prevp, *np;
  946. prevp = &head;
  947. for (np = allnodes; np != 0; np = np->allnext) {
  948. if (np->type != 0 && strcasecmp(np->type, type) == 0) {
  949. *prevp = np;
  950. prevp = &np->next;
  951. }
  952. }
  953. *prevp = NULL;
  954. return head;
  955. }
  956. EXPORT_SYMBOL(find_type_devices);
  957. /**
  958. * Returns all nodes linked together
  959. */
  960. struct device_node *find_all_nodes(void)
  961. {
  962. struct device_node *head, **prevp, *np;
  963. prevp = &head;
  964. for (np = allnodes; np != 0; np = np->allnext) {
  965. *prevp = np;
  966. prevp = &np->next;
  967. }
  968. *prevp = NULL;
  969. return head;
  970. }
  971. EXPORT_SYMBOL(find_all_nodes);
  972. /** Checks if the given "compat" string matches one of the strings in
  973. * the device's "compatible" property
  974. */
  975. int device_is_compatible(const struct device_node *device, const char *compat)
  976. {
  977. const char* cp;
  978. int cplen, l;
  979. cp = get_property(device, "compatible", &cplen);
  980. if (cp == NULL)
  981. return 0;
  982. while (cplen > 0) {
  983. if (strncasecmp(cp, compat, strlen(compat)) == 0)
  984. return 1;
  985. l = strlen(cp) + 1;
  986. cp += l;
  987. cplen -= l;
  988. }
  989. return 0;
  990. }
  991. EXPORT_SYMBOL(device_is_compatible);
  992. /**
  993. * Indicates whether the root node has a given value in its
  994. * compatible property.
  995. */
  996. int machine_is_compatible(const char *compat)
  997. {
  998. struct device_node *root;
  999. int rc = 0;
  1000. root = of_find_node_by_path("/");
  1001. if (root) {
  1002. rc = device_is_compatible(root, compat);
  1003. of_node_put(root);
  1004. }
  1005. return rc;
  1006. }
  1007. EXPORT_SYMBOL(machine_is_compatible);
  1008. /**
  1009. * Construct and return a list of the device_nodes with a given type
  1010. * and compatible property.
  1011. */
  1012. struct device_node *find_compatible_devices(const char *type,
  1013. const char *compat)
  1014. {
  1015. struct device_node *head, **prevp, *np;
  1016. prevp = &head;
  1017. for (np = allnodes; np != 0; np = np->allnext) {
  1018. if (type != NULL
  1019. && !(np->type != 0 && strcasecmp(np->type, type) == 0))
  1020. continue;
  1021. if (device_is_compatible(np, compat)) {
  1022. *prevp = np;
  1023. prevp = &np->next;
  1024. }
  1025. }
  1026. *prevp = NULL;
  1027. return head;
  1028. }
  1029. EXPORT_SYMBOL(find_compatible_devices);
  1030. /**
  1031. * Find the device_node with a given full_name.
  1032. */
  1033. struct device_node *find_path_device(const char *path)
  1034. {
  1035. struct device_node *np;
  1036. for (np = allnodes; np != 0; np = np->allnext)
  1037. if (np->full_name != 0 && strcasecmp(np->full_name, path) == 0)
  1038. return np;
  1039. return NULL;
  1040. }
  1041. EXPORT_SYMBOL(find_path_device);
  1042. /*******
  1043. *
  1044. * New implementation of the OF "find" APIs, return a refcounted
  1045. * object, call of_node_put() when done. The device tree and list
  1046. * are protected by a rw_lock.
  1047. *
  1048. * Note that property management will need some locking as well,
  1049. * this isn't dealt with yet.
  1050. *
  1051. *******/
  1052. /**
  1053. * of_find_node_by_name - Find a node by its "name" property
  1054. * @from: The node to start searching from or NULL, the node
  1055. * you pass will not be searched, only the next one
  1056. * will; typically, you pass what the previous call
  1057. * returned. of_node_put() will be called on it
  1058. * @name: The name string to match against
  1059. *
  1060. * Returns a node pointer with refcount incremented, use
  1061. * of_node_put() on it when done.
  1062. */
  1063. struct device_node *of_find_node_by_name(struct device_node *from,
  1064. const char *name)
  1065. {
  1066. struct device_node *np;
  1067. read_lock(&devtree_lock);
  1068. np = from ? from->allnext : allnodes;
  1069. for (; np != NULL; np = np->allnext)
  1070. if (np->name != NULL && strcasecmp(np->name, name) == 0
  1071. && of_node_get(np))
  1072. break;
  1073. of_node_put(from);
  1074. read_unlock(&devtree_lock);
  1075. return np;
  1076. }
  1077. EXPORT_SYMBOL(of_find_node_by_name);
  1078. /**
  1079. * of_find_node_by_type - Find a node by its "device_type" property
  1080. * @from: The node to start searching from or NULL, the node
  1081. * you pass will not be searched, only the next one
  1082. * will; typically, you pass what the previous call
  1083. * returned. of_node_put() will be called on it
  1084. * @name: The type string to match against
  1085. *
  1086. * Returns a node pointer with refcount incremented, use
  1087. * of_node_put() on it when done.
  1088. */
  1089. struct device_node *of_find_node_by_type(struct device_node *from,
  1090. const char *type)
  1091. {
  1092. struct device_node *np;
  1093. read_lock(&devtree_lock);
  1094. np = from ? from->allnext : allnodes;
  1095. for (; np != 0; np = np->allnext)
  1096. if (np->type != 0 && strcasecmp(np->type, type) == 0
  1097. && of_node_get(np))
  1098. break;
  1099. of_node_put(from);
  1100. read_unlock(&devtree_lock);
  1101. return np;
  1102. }
  1103. EXPORT_SYMBOL(of_find_node_by_type);
  1104. /**
  1105. * of_find_compatible_node - Find a node based on type and one of the
  1106. * tokens in its "compatible" property
  1107. * @from: The node to start searching from or NULL, the node
  1108. * you pass will not be searched, only the next one
  1109. * will; typically, you pass what the previous call
  1110. * returned. of_node_put() will be called on it
  1111. * @type: The type string to match "device_type" or NULL to ignore
  1112. * @compatible: The string to match to one of the tokens in the device
  1113. * "compatible" list.
  1114. *
  1115. * Returns a node pointer with refcount incremented, use
  1116. * of_node_put() on it when done.
  1117. */
  1118. struct device_node *of_find_compatible_node(struct device_node *from,
  1119. const char *type, const char *compatible)
  1120. {
  1121. struct device_node *np;
  1122. read_lock(&devtree_lock);
  1123. np = from ? from->allnext : allnodes;
  1124. for (; np != 0; np = np->allnext) {
  1125. if (type != NULL
  1126. && !(np->type != 0 && strcasecmp(np->type, type) == 0))
  1127. continue;
  1128. if (device_is_compatible(np, compatible) && of_node_get(np))
  1129. break;
  1130. }
  1131. of_node_put(from);
  1132. read_unlock(&devtree_lock);
  1133. return np;
  1134. }
  1135. EXPORT_SYMBOL(of_find_compatible_node);
  1136. /**
  1137. * of_find_node_by_path - Find a node matching a full OF path
  1138. * @path: The full path to match
  1139. *
  1140. * Returns a node pointer with refcount incremented, use
  1141. * of_node_put() on it when done.
  1142. */
  1143. struct device_node *of_find_node_by_path(const char *path)
  1144. {
  1145. struct device_node *np = allnodes;
  1146. read_lock(&devtree_lock);
  1147. for (; np != 0; np = np->allnext) {
  1148. if (np->full_name != 0 && strcasecmp(np->full_name, path) == 0
  1149. && of_node_get(np))
  1150. break;
  1151. }
  1152. read_unlock(&devtree_lock);
  1153. return np;
  1154. }
  1155. EXPORT_SYMBOL(of_find_node_by_path);
  1156. /**
  1157. * of_find_node_by_phandle - Find a node given a phandle
  1158. * @handle: phandle of the node to find
  1159. *
  1160. * Returns a node pointer with refcount incremented, use
  1161. * of_node_put() on it when done.
  1162. */
  1163. struct device_node *of_find_node_by_phandle(phandle handle)
  1164. {
  1165. struct device_node *np;
  1166. read_lock(&devtree_lock);
  1167. for (np = allnodes; np != 0; np = np->allnext)
  1168. if (np->linux_phandle == handle)
  1169. break;
  1170. of_node_get(np);
  1171. read_unlock(&devtree_lock);
  1172. return np;
  1173. }
  1174. EXPORT_SYMBOL(of_find_node_by_phandle);
  1175. /**
  1176. * of_find_all_nodes - Get next node in global list
  1177. * @prev: Previous node or NULL to start iteration
  1178. * of_node_put() will be called on it
  1179. *
  1180. * Returns a node pointer with refcount incremented, use
  1181. * of_node_put() on it when done.
  1182. */
  1183. struct device_node *of_find_all_nodes(struct device_node *prev)
  1184. {
  1185. struct device_node *np;
  1186. read_lock(&devtree_lock);
  1187. np = prev ? prev->allnext : allnodes;
  1188. for (; np != 0; np = np->allnext)
  1189. if (of_node_get(np))
  1190. break;
  1191. of_node_put(prev);
  1192. read_unlock(&devtree_lock);
  1193. return np;
  1194. }
  1195. EXPORT_SYMBOL(of_find_all_nodes);
  1196. /**
  1197. * of_get_parent - Get a node's parent if any
  1198. * @node: Node to get parent
  1199. *
  1200. * Returns a node pointer with refcount incremented, use
  1201. * of_node_put() on it when done.
  1202. */
  1203. struct device_node *of_get_parent(const struct device_node *node)
  1204. {
  1205. struct device_node *np;
  1206. if (!node)
  1207. return NULL;
  1208. read_lock(&devtree_lock);
  1209. np = of_node_get(node->parent);
  1210. read_unlock(&devtree_lock);
  1211. return np;
  1212. }
  1213. EXPORT_SYMBOL(of_get_parent);
  1214. /**
  1215. * of_get_next_child - Iterate a node childs
  1216. * @node: parent node
  1217. * @prev: previous child of the parent node, or NULL to get first
  1218. *
  1219. * Returns a node pointer with refcount incremented, use
  1220. * of_node_put() on it when done.
  1221. */
  1222. struct device_node *of_get_next_child(const struct device_node *node,
  1223. struct device_node *prev)
  1224. {
  1225. struct device_node *next;
  1226. read_lock(&devtree_lock);
  1227. next = prev ? prev->sibling : node->child;
  1228. for (; next != 0; next = next->sibling)
  1229. if (of_node_get(next))
  1230. break;
  1231. of_node_put(prev);
  1232. read_unlock(&devtree_lock);
  1233. return next;
  1234. }
  1235. EXPORT_SYMBOL(of_get_next_child);
  1236. /**
  1237. * of_node_get - Increment refcount of a node
  1238. * @node: Node to inc refcount, NULL is supported to
  1239. * simplify writing of callers
  1240. *
  1241. * Returns node.
  1242. */
  1243. struct device_node *of_node_get(struct device_node *node)
  1244. {
  1245. if (node)
  1246. kref_get(&node->kref);
  1247. return node;
  1248. }
  1249. EXPORT_SYMBOL(of_node_get);
  1250. static inline struct device_node * kref_to_device_node(struct kref *kref)
  1251. {
  1252. return container_of(kref, struct device_node, kref);
  1253. }
  1254. /**
  1255. * of_node_release - release a dynamically allocated node
  1256. * @kref: kref element of the node to be released
  1257. *
  1258. * In of_node_put() this function is passed to kref_put()
  1259. * as the destructor.
  1260. */
  1261. static void of_node_release(struct kref *kref)
  1262. {
  1263. struct device_node *node = kref_to_device_node(kref);
  1264. struct property *prop = node->properties;
  1265. if (!OF_IS_DYNAMIC(node))
  1266. return;
  1267. while (prop) {
  1268. struct property *next = prop->next;
  1269. kfree(prop->name);
  1270. kfree(prop->value);
  1271. kfree(prop);
  1272. prop = next;
  1273. if (!prop) {
  1274. prop = node->deadprops;
  1275. node->deadprops = NULL;
  1276. }
  1277. }
  1278. kfree(node->full_name);
  1279. kfree(node->data);
  1280. kfree(node);
  1281. }
  1282. /**
  1283. * of_node_put - Decrement refcount of a node
  1284. * @node: Node to dec refcount, NULL is supported to
  1285. * simplify writing of callers
  1286. *
  1287. */
  1288. void of_node_put(struct device_node *node)
  1289. {
  1290. if (node)
  1291. kref_put(&node->kref, of_node_release);
  1292. }
  1293. EXPORT_SYMBOL(of_node_put);
  1294. /*
  1295. * Plug a device node into the tree and global list.
  1296. */
  1297. void of_attach_node(struct device_node *np)
  1298. {
  1299. write_lock(&devtree_lock);
  1300. np->sibling = np->parent->child;
  1301. np->allnext = allnodes;
  1302. np->parent->child = np;
  1303. allnodes = np;
  1304. write_unlock(&devtree_lock);
  1305. }
  1306. /*
  1307. * "Unplug" a node from the device tree. The caller must hold
  1308. * a reference to the node. The memory associated with the node
  1309. * is not freed until its refcount goes to zero.
  1310. */
  1311. void of_detach_node(const struct device_node *np)
  1312. {
  1313. struct device_node *parent;
  1314. write_lock(&devtree_lock);
  1315. parent = np->parent;
  1316. if (allnodes == np)
  1317. allnodes = np->allnext;
  1318. else {
  1319. struct device_node *prev;
  1320. for (prev = allnodes;
  1321. prev->allnext != np;
  1322. prev = prev->allnext)
  1323. ;
  1324. prev->allnext = np->allnext;
  1325. }
  1326. if (parent->child == np)
  1327. parent->child = np->sibling;
  1328. else {
  1329. struct device_node *prevsib;
  1330. for (prevsib = np->parent->child;
  1331. prevsib->sibling != np;
  1332. prevsib = prevsib->sibling)
  1333. ;
  1334. prevsib->sibling = np->sibling;
  1335. }
  1336. write_unlock(&devtree_lock);
  1337. }
  1338. #ifdef CONFIG_PPC_PSERIES
  1339. /*
  1340. * Fix up the uninitialized fields in a new device node:
  1341. * name, type and pci-specific fields
  1342. */
  1343. static int of_finish_dynamic_node(struct device_node *node)
  1344. {
  1345. struct device_node *parent = of_get_parent(node);
  1346. int err = 0;
  1347. const phandle *ibm_phandle;
  1348. node->name = get_property(node, "name", NULL);
  1349. node->type = get_property(node, "device_type", NULL);
  1350. if (!parent) {
  1351. err = -ENODEV;
  1352. goto out;
  1353. }
  1354. /* We don't support that function on PowerMac, at least
  1355. * not yet
  1356. */
  1357. if (machine_is(powermac))
  1358. return -ENODEV;
  1359. /* fix up new node's linux_phandle field */
  1360. if ((ibm_phandle = get_property(node, "ibm,phandle", NULL)))
  1361. node->linux_phandle = *ibm_phandle;
  1362. out:
  1363. of_node_put(parent);
  1364. return err;
  1365. }
  1366. static int prom_reconfig_notifier(struct notifier_block *nb,
  1367. unsigned long action, void *node)
  1368. {
  1369. int err;
  1370. switch (action) {
  1371. case PSERIES_RECONFIG_ADD:
  1372. err = of_finish_dynamic_node(node);
  1373. if (err < 0) {
  1374. printk(KERN_ERR "finish_node returned %d\n", err);
  1375. err = NOTIFY_BAD;
  1376. }
  1377. break;
  1378. default:
  1379. err = NOTIFY_DONE;
  1380. break;
  1381. }
  1382. return err;
  1383. }
  1384. static struct notifier_block prom_reconfig_nb = {
  1385. .notifier_call = prom_reconfig_notifier,
  1386. .priority = 10, /* This one needs to run first */
  1387. };
  1388. static int __init prom_reconfig_setup(void)
  1389. {
  1390. return pSeries_reconfig_notifier_register(&prom_reconfig_nb);
  1391. }
  1392. __initcall(prom_reconfig_setup);
  1393. #endif
  1394. struct property *of_find_property(const struct device_node *np,
  1395. const char *name,
  1396. int *lenp)
  1397. {
  1398. struct property *pp;
  1399. read_lock(&devtree_lock);
  1400. for (pp = np->properties; pp != 0; pp = pp->next)
  1401. if (strcmp(pp->name, name) == 0) {
  1402. if (lenp != 0)
  1403. *lenp = pp->length;
  1404. break;
  1405. }
  1406. read_unlock(&devtree_lock);
  1407. return pp;
  1408. }
  1409. /*
  1410. * Find a property with a given name for a given node
  1411. * and return the value.
  1412. */
  1413. const void *get_property(const struct device_node *np, const char *name,
  1414. int *lenp)
  1415. {
  1416. struct property *pp = of_find_property(np,name,lenp);
  1417. return pp ? pp->value : NULL;
  1418. }
  1419. EXPORT_SYMBOL(get_property);
  1420. /*
  1421. * Add a property to a node
  1422. */
  1423. int prom_add_property(struct device_node* np, struct property* prop)
  1424. {
  1425. struct property **next;
  1426. prop->next = NULL;
  1427. write_lock(&devtree_lock);
  1428. next = &np->properties;
  1429. while (*next) {
  1430. if (strcmp(prop->name, (*next)->name) == 0) {
  1431. /* duplicate ! don't insert it */
  1432. write_unlock(&devtree_lock);
  1433. return -1;
  1434. }
  1435. next = &(*next)->next;
  1436. }
  1437. *next = prop;
  1438. write_unlock(&devtree_lock);
  1439. #ifdef CONFIG_PROC_DEVICETREE
  1440. /* try to add to proc as well if it was initialized */
  1441. if (np->pde)
  1442. proc_device_tree_add_prop(np->pde, prop);
  1443. #endif /* CONFIG_PROC_DEVICETREE */
  1444. return 0;
  1445. }
  1446. /*
  1447. * Remove a property from a node. Note that we don't actually
  1448. * remove it, since we have given out who-knows-how-many pointers
  1449. * to the data using get-property. Instead we just move the property
  1450. * to the "dead properties" list, so it won't be found any more.
  1451. */
  1452. int prom_remove_property(struct device_node *np, struct property *prop)
  1453. {
  1454. struct property **next;
  1455. int found = 0;
  1456. write_lock(&devtree_lock);
  1457. next = &np->properties;
  1458. while (*next) {
  1459. if (*next == prop) {
  1460. /* found the node */
  1461. *next = prop->next;
  1462. prop->next = np->deadprops;
  1463. np->deadprops = prop;
  1464. found = 1;
  1465. break;
  1466. }
  1467. next = &(*next)->next;
  1468. }
  1469. write_unlock(&devtree_lock);
  1470. if (!found)
  1471. return -ENODEV;
  1472. #ifdef CONFIG_PROC_DEVICETREE
  1473. /* try to remove the proc node as well */
  1474. if (np->pde)
  1475. proc_device_tree_remove_prop(np->pde, prop);
  1476. #endif /* CONFIG_PROC_DEVICETREE */
  1477. return 0;
  1478. }
  1479. /*
  1480. * Update a property in a node. Note that we don't actually
  1481. * remove it, since we have given out who-knows-how-many pointers
  1482. * to the data using get-property. Instead we just move the property
  1483. * to the "dead properties" list, and add the new property to the
  1484. * property list
  1485. */
  1486. int prom_update_property(struct device_node *np,
  1487. struct property *newprop,
  1488. struct property *oldprop)
  1489. {
  1490. struct property **next;
  1491. int found = 0;
  1492. write_lock(&devtree_lock);
  1493. next = &np->properties;
  1494. while (*next) {
  1495. if (*next == oldprop) {
  1496. /* found the node */
  1497. newprop->next = oldprop->next;
  1498. *next = newprop;
  1499. oldprop->next = np->deadprops;
  1500. np->deadprops = oldprop;
  1501. found = 1;
  1502. break;
  1503. }
  1504. next = &(*next)->next;
  1505. }
  1506. write_unlock(&devtree_lock);
  1507. if (!found)
  1508. return -ENODEV;
  1509. #ifdef CONFIG_PROC_DEVICETREE
  1510. /* try to add to proc as well if it was initialized */
  1511. if (np->pde)
  1512. proc_device_tree_update_prop(np->pde, newprop, oldprop);
  1513. #endif /* CONFIG_PROC_DEVICETREE */
  1514. return 0;
  1515. }
  1516. /* Find the device node for a given logical cpu number, also returns the cpu
  1517. * local thread number (index in ibm,interrupt-server#s) if relevant and
  1518. * asked for (non NULL)
  1519. */
  1520. struct device_node *of_get_cpu_node(int cpu, unsigned int *thread)
  1521. {
  1522. int hardid;
  1523. struct device_node *np;
  1524. hardid = get_hard_smp_processor_id(cpu);
  1525. for_each_node_by_type(np, "cpu") {
  1526. const u32 *intserv;
  1527. unsigned int plen, t;
  1528. /* Check for ibm,ppc-interrupt-server#s. If it doesn't exist
  1529. * fallback to "reg" property and assume no threads
  1530. */
  1531. intserv = get_property(np, "ibm,ppc-interrupt-server#s",
  1532. &plen);
  1533. if (intserv == NULL) {
  1534. const u32 *reg = get_property(np, "reg", NULL);
  1535. if (reg == NULL)
  1536. continue;
  1537. if (*reg == hardid) {
  1538. if (thread)
  1539. *thread = 0;
  1540. return np;
  1541. }
  1542. } else {
  1543. plen /= sizeof(u32);
  1544. for (t = 0; t < plen; t++) {
  1545. if (hardid == intserv[t]) {
  1546. if (thread)
  1547. *thread = t;
  1548. return np;
  1549. }
  1550. }
  1551. }
  1552. }
  1553. return NULL;
  1554. }
  1555. EXPORT_SYMBOL(of_get_cpu_node);
  1556. #ifdef DEBUG
  1557. static struct debugfs_blob_wrapper flat_dt_blob;
  1558. static int __init export_flat_device_tree(void)
  1559. {
  1560. struct dentry *d;
  1561. d = debugfs_create_dir("powerpc", NULL);
  1562. if (!d)
  1563. return 1;
  1564. flat_dt_blob.data = initial_boot_params;
  1565. flat_dt_blob.size = initial_boot_params->totalsize;
  1566. d = debugfs_create_blob("flat-device-tree", S_IFREG | S_IRUSR,
  1567. d, &flat_dt_blob);
  1568. if (!d)
  1569. return 1;
  1570. return 0;
  1571. }
  1572. __initcall(export_flat_device_tree);
  1573. #endif