prom.c 43 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793
  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(boot_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. EXPORT_SYMBOL(of_find_property);
  1410. /*
  1411. * Find a property with a given name for a given node
  1412. * and return the value.
  1413. */
  1414. const void *get_property(const struct device_node *np, const char *name,
  1415. int *lenp)
  1416. {
  1417. struct property *pp = of_find_property(np,name,lenp);
  1418. return pp ? pp->value : NULL;
  1419. }
  1420. EXPORT_SYMBOL(get_property);
  1421. /*
  1422. * Add a property to a node
  1423. */
  1424. int prom_add_property(struct device_node* np, struct property* prop)
  1425. {
  1426. struct property **next;
  1427. prop->next = NULL;
  1428. write_lock(&devtree_lock);
  1429. next = &np->properties;
  1430. while (*next) {
  1431. if (strcmp(prop->name, (*next)->name) == 0) {
  1432. /* duplicate ! don't insert it */
  1433. write_unlock(&devtree_lock);
  1434. return -1;
  1435. }
  1436. next = &(*next)->next;
  1437. }
  1438. *next = prop;
  1439. write_unlock(&devtree_lock);
  1440. #ifdef CONFIG_PROC_DEVICETREE
  1441. /* try to add to proc as well if it was initialized */
  1442. if (np->pde)
  1443. proc_device_tree_add_prop(np->pde, prop);
  1444. #endif /* CONFIG_PROC_DEVICETREE */
  1445. return 0;
  1446. }
  1447. /*
  1448. * Remove a property from a node. Note that we don't actually
  1449. * remove it, since we have given out who-knows-how-many pointers
  1450. * to the data using get-property. Instead we just move the property
  1451. * to the "dead properties" list, so it won't be found any more.
  1452. */
  1453. int prom_remove_property(struct device_node *np, struct property *prop)
  1454. {
  1455. struct property **next;
  1456. int found = 0;
  1457. write_lock(&devtree_lock);
  1458. next = &np->properties;
  1459. while (*next) {
  1460. if (*next == prop) {
  1461. /* found the node */
  1462. *next = prop->next;
  1463. prop->next = np->deadprops;
  1464. np->deadprops = prop;
  1465. found = 1;
  1466. break;
  1467. }
  1468. next = &(*next)->next;
  1469. }
  1470. write_unlock(&devtree_lock);
  1471. if (!found)
  1472. return -ENODEV;
  1473. #ifdef CONFIG_PROC_DEVICETREE
  1474. /* try to remove the proc node as well */
  1475. if (np->pde)
  1476. proc_device_tree_remove_prop(np->pde, prop);
  1477. #endif /* CONFIG_PROC_DEVICETREE */
  1478. return 0;
  1479. }
  1480. /*
  1481. * Update a property in a node. Note that we don't actually
  1482. * remove it, since we have given out who-knows-how-many pointers
  1483. * to the data using get-property. Instead we just move the property
  1484. * to the "dead properties" list, and add the new property to the
  1485. * property list
  1486. */
  1487. int prom_update_property(struct device_node *np,
  1488. struct property *newprop,
  1489. struct property *oldprop)
  1490. {
  1491. struct property **next;
  1492. int found = 0;
  1493. write_lock(&devtree_lock);
  1494. next = &np->properties;
  1495. while (*next) {
  1496. if (*next == oldprop) {
  1497. /* found the node */
  1498. newprop->next = oldprop->next;
  1499. *next = newprop;
  1500. oldprop->next = np->deadprops;
  1501. np->deadprops = oldprop;
  1502. found = 1;
  1503. break;
  1504. }
  1505. next = &(*next)->next;
  1506. }
  1507. write_unlock(&devtree_lock);
  1508. if (!found)
  1509. return -ENODEV;
  1510. #ifdef CONFIG_PROC_DEVICETREE
  1511. /* try to add to proc as well if it was initialized */
  1512. if (np->pde)
  1513. proc_device_tree_update_prop(np->pde, newprop, oldprop);
  1514. #endif /* CONFIG_PROC_DEVICETREE */
  1515. return 0;
  1516. }
  1517. /* Find the device node for a given logical cpu number, also returns the cpu
  1518. * local thread number (index in ibm,interrupt-server#s) if relevant and
  1519. * asked for (non NULL)
  1520. */
  1521. struct device_node *of_get_cpu_node(int cpu, unsigned int *thread)
  1522. {
  1523. int hardid;
  1524. struct device_node *np;
  1525. hardid = get_hard_smp_processor_id(cpu);
  1526. for_each_node_by_type(np, "cpu") {
  1527. const u32 *intserv;
  1528. unsigned int plen, t;
  1529. /* Check for ibm,ppc-interrupt-server#s. If it doesn't exist
  1530. * fallback to "reg" property and assume no threads
  1531. */
  1532. intserv = get_property(np, "ibm,ppc-interrupt-server#s",
  1533. &plen);
  1534. if (intserv == NULL) {
  1535. const u32 *reg = get_property(np, "reg", NULL);
  1536. if (reg == NULL)
  1537. continue;
  1538. if (*reg == hardid) {
  1539. if (thread)
  1540. *thread = 0;
  1541. return np;
  1542. }
  1543. } else {
  1544. plen /= sizeof(u32);
  1545. for (t = 0; t < plen; t++) {
  1546. if (hardid == intserv[t]) {
  1547. if (thread)
  1548. *thread = t;
  1549. return np;
  1550. }
  1551. }
  1552. }
  1553. }
  1554. return NULL;
  1555. }
  1556. EXPORT_SYMBOL(of_get_cpu_node);
  1557. #ifdef DEBUG
  1558. static struct debugfs_blob_wrapper flat_dt_blob;
  1559. static int __init export_flat_device_tree(void)
  1560. {
  1561. struct dentry *d;
  1562. d = debugfs_create_dir("powerpc", NULL);
  1563. if (!d)
  1564. return 1;
  1565. flat_dt_blob.data = initial_boot_params;
  1566. flat_dt_blob.size = initial_boot_params->totalsize;
  1567. d = debugfs_create_blob("flat-device-tree", S_IFREG | S_IRUSR,
  1568. d, &flat_dt_blob);
  1569. if (!d)
  1570. return 1;
  1571. return 0;
  1572. }
  1573. __initcall(export_flat_device_tree);
  1574. #endif