prom.c 41 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743
  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. static int __init early_init_dt_scan_memory(unsigned long node,
  711. const char *uname, int depth, void *data)
  712. {
  713. char *type = of_get_flat_dt_prop(node, "device_type", NULL);
  714. cell_t *reg, *endp;
  715. unsigned long l;
  716. /* We are scanning "memory" nodes only */
  717. if (type == NULL) {
  718. /*
  719. * The longtrail doesn't have a device_type on the
  720. * /memory node, so look for the node called /memory@0.
  721. */
  722. if (depth != 1 || strcmp(uname, "memory@0") != 0)
  723. return 0;
  724. } else if (strcmp(type, "memory") != 0)
  725. return 0;
  726. reg = (cell_t *)of_get_flat_dt_prop(node, "linux,usable-memory", &l);
  727. if (reg == NULL)
  728. reg = (cell_t *)of_get_flat_dt_prop(node, "reg", &l);
  729. if (reg == NULL)
  730. return 0;
  731. endp = reg + (l / sizeof(cell_t));
  732. DBG("memory scan node %s, reg size %ld, data: %x %x %x %x,\n",
  733. uname, l, reg[0], reg[1], reg[2], reg[3]);
  734. while ((endp - reg) >= (dt_root_addr_cells + dt_root_size_cells)) {
  735. unsigned long base, size;
  736. base = dt_mem_next_cell(dt_root_addr_cells, &reg);
  737. size = dt_mem_next_cell(dt_root_size_cells, &reg);
  738. if (size == 0)
  739. continue;
  740. DBG(" - %lx , %lx\n", base, size);
  741. #ifdef CONFIG_PPC64
  742. if (iommu_is_off) {
  743. if (base >= 0x80000000ul)
  744. continue;
  745. if ((base + size) > 0x80000000ul)
  746. size = 0x80000000ul - base;
  747. }
  748. #endif
  749. lmb_add(base, size);
  750. }
  751. return 0;
  752. }
  753. static void __init early_reserve_mem(void)
  754. {
  755. u64 base, size;
  756. u64 *reserve_map;
  757. unsigned long self_base;
  758. unsigned long self_size;
  759. reserve_map = (u64 *)(((unsigned long)initial_boot_params) +
  760. initial_boot_params->off_mem_rsvmap);
  761. /* before we do anything, lets reserve the dt blob */
  762. self_base = __pa((unsigned long)initial_boot_params);
  763. self_size = initial_boot_params->totalsize;
  764. lmb_reserve(self_base, self_size);
  765. #ifdef CONFIG_PPC32
  766. /*
  767. * Handle the case where we might be booting from an old kexec
  768. * image that setup the mem_rsvmap as pairs of 32-bit values
  769. */
  770. if (*reserve_map > 0xffffffffull) {
  771. u32 base_32, size_32;
  772. u32 *reserve_map_32 = (u32 *)reserve_map;
  773. while (1) {
  774. base_32 = *(reserve_map_32++);
  775. size_32 = *(reserve_map_32++);
  776. if (size_32 == 0)
  777. break;
  778. /* skip if the reservation is for the blob */
  779. if (base_32 == self_base && size_32 == self_size)
  780. continue;
  781. DBG("reserving: %x -> %x\n", base_32, size_32);
  782. lmb_reserve(base_32, size_32);
  783. }
  784. return;
  785. }
  786. #endif
  787. while (1) {
  788. base = *(reserve_map++);
  789. size = *(reserve_map++);
  790. if (size == 0)
  791. break;
  792. /* skip if the reservation is for the blob */
  793. if (base == self_base && size == self_size)
  794. continue;
  795. DBG("reserving: %llx -> %llx\n", base, size);
  796. lmb_reserve(base, size);
  797. }
  798. #if 0
  799. DBG("memory reserved, lmbs :\n");
  800. lmb_dump_all();
  801. #endif
  802. }
  803. void __init early_init_devtree(void *params)
  804. {
  805. DBG(" -> early_init_devtree()\n");
  806. /* Setup flat device-tree pointer */
  807. initial_boot_params = params;
  808. #ifdef CONFIG_PPC_RTAS
  809. /* Some machines might need RTAS info for debugging, grab it now. */
  810. of_scan_flat_dt(early_init_dt_scan_rtas, NULL);
  811. #endif
  812. /* Retrieve various informations from the /chosen node of the
  813. * device-tree, including the platform type, initrd location and
  814. * size, TCE reserve, and more ...
  815. */
  816. of_scan_flat_dt(early_init_dt_scan_chosen, NULL);
  817. /* Scan memory nodes and rebuild LMBs */
  818. lmb_init();
  819. of_scan_flat_dt(early_init_dt_scan_root, NULL);
  820. of_scan_flat_dt(early_init_dt_scan_memory, NULL);
  821. /* Save command line for /proc/cmdline and then parse parameters */
  822. strlcpy(saved_command_line, cmd_line, COMMAND_LINE_SIZE);
  823. parse_early_param();
  824. /* Reserve LMB regions used by kernel, initrd, dt, etc... */
  825. lmb_reserve(PHYSICAL_START, __pa(klimit) - PHYSICAL_START);
  826. reserve_kdump_trampoline();
  827. reserve_crashkernel();
  828. early_reserve_mem();
  829. lmb_enforce_memory_limit(memory_limit);
  830. lmb_analyze();
  831. DBG("Phys. mem: %lx\n", lmb_phys_mem_size());
  832. /* We may need to relocate the flat tree, do it now.
  833. * FIXME .. and the initrd too? */
  834. move_device_tree();
  835. DBG("Scanning CPUs ...\n");
  836. /* Retreive CPU related informations from the flat tree
  837. * (altivec support, boot CPU ID, ...)
  838. */
  839. of_scan_flat_dt(early_init_dt_scan_cpus, NULL);
  840. DBG(" <- early_init_devtree()\n");
  841. }
  842. #undef printk
  843. int
  844. prom_n_addr_cells(struct device_node* np)
  845. {
  846. const int *ip;
  847. do {
  848. if (np->parent)
  849. np = np->parent;
  850. ip = get_property(np, "#address-cells", NULL);
  851. if (ip != NULL)
  852. return *ip;
  853. } while (np->parent);
  854. /* No #address-cells property for the root node, default to 1 */
  855. return 1;
  856. }
  857. EXPORT_SYMBOL(prom_n_addr_cells);
  858. int
  859. prom_n_size_cells(struct device_node* np)
  860. {
  861. const int* ip;
  862. do {
  863. if (np->parent)
  864. np = np->parent;
  865. ip = get_property(np, "#size-cells", NULL);
  866. if (ip != NULL)
  867. return *ip;
  868. } while (np->parent);
  869. /* No #size-cells property for the root node, default to 1 */
  870. return 1;
  871. }
  872. EXPORT_SYMBOL(prom_n_size_cells);
  873. /**
  874. * Construct and return a list of the device_nodes with a given name.
  875. */
  876. struct device_node *find_devices(const char *name)
  877. {
  878. struct device_node *head, **prevp, *np;
  879. prevp = &head;
  880. for (np = allnodes; np != 0; np = np->allnext) {
  881. if (np->name != 0 && strcasecmp(np->name, name) == 0) {
  882. *prevp = np;
  883. prevp = &np->next;
  884. }
  885. }
  886. *prevp = NULL;
  887. return head;
  888. }
  889. EXPORT_SYMBOL(find_devices);
  890. /**
  891. * Construct and return a list of the device_nodes with a given type.
  892. */
  893. struct device_node *find_type_devices(const char *type)
  894. {
  895. struct device_node *head, **prevp, *np;
  896. prevp = &head;
  897. for (np = allnodes; np != 0; np = np->allnext) {
  898. if (np->type != 0 && strcasecmp(np->type, type) == 0) {
  899. *prevp = np;
  900. prevp = &np->next;
  901. }
  902. }
  903. *prevp = NULL;
  904. return head;
  905. }
  906. EXPORT_SYMBOL(find_type_devices);
  907. /**
  908. * Returns all nodes linked together
  909. */
  910. struct device_node *find_all_nodes(void)
  911. {
  912. struct device_node *head, **prevp, *np;
  913. prevp = &head;
  914. for (np = allnodes; np != 0; np = np->allnext) {
  915. *prevp = np;
  916. prevp = &np->next;
  917. }
  918. *prevp = NULL;
  919. return head;
  920. }
  921. EXPORT_SYMBOL(find_all_nodes);
  922. /** Checks if the given "compat" string matches one of the strings in
  923. * the device's "compatible" property
  924. */
  925. int device_is_compatible(const struct device_node *device, const char *compat)
  926. {
  927. const char* cp;
  928. int cplen, l;
  929. cp = get_property(device, "compatible", &cplen);
  930. if (cp == NULL)
  931. return 0;
  932. while (cplen > 0) {
  933. if (strncasecmp(cp, compat, strlen(compat)) == 0)
  934. return 1;
  935. l = strlen(cp) + 1;
  936. cp += l;
  937. cplen -= l;
  938. }
  939. return 0;
  940. }
  941. EXPORT_SYMBOL(device_is_compatible);
  942. /**
  943. * Indicates whether the root node has a given value in its
  944. * compatible property.
  945. */
  946. int machine_is_compatible(const char *compat)
  947. {
  948. struct device_node *root;
  949. int rc = 0;
  950. root = of_find_node_by_path("/");
  951. if (root) {
  952. rc = device_is_compatible(root, compat);
  953. of_node_put(root);
  954. }
  955. return rc;
  956. }
  957. EXPORT_SYMBOL(machine_is_compatible);
  958. /**
  959. * Construct and return a list of the device_nodes with a given type
  960. * and compatible property.
  961. */
  962. struct device_node *find_compatible_devices(const char *type,
  963. const char *compat)
  964. {
  965. struct device_node *head, **prevp, *np;
  966. prevp = &head;
  967. for (np = allnodes; np != 0; np = np->allnext) {
  968. if (type != NULL
  969. && !(np->type != 0 && strcasecmp(np->type, type) == 0))
  970. continue;
  971. if (device_is_compatible(np, compat)) {
  972. *prevp = np;
  973. prevp = &np->next;
  974. }
  975. }
  976. *prevp = NULL;
  977. return head;
  978. }
  979. EXPORT_SYMBOL(find_compatible_devices);
  980. /**
  981. * Find the device_node with a given full_name.
  982. */
  983. struct device_node *find_path_device(const char *path)
  984. {
  985. struct device_node *np;
  986. for (np = allnodes; np != 0; np = np->allnext)
  987. if (np->full_name != 0 && strcasecmp(np->full_name, path) == 0)
  988. return np;
  989. return NULL;
  990. }
  991. EXPORT_SYMBOL(find_path_device);
  992. /*******
  993. *
  994. * New implementation of the OF "find" APIs, return a refcounted
  995. * object, call of_node_put() when done. The device tree and list
  996. * are protected by a rw_lock.
  997. *
  998. * Note that property management will need some locking as well,
  999. * this isn't dealt with yet.
  1000. *
  1001. *******/
  1002. /**
  1003. * of_find_node_by_name - Find a node by its "name" property
  1004. * @from: The node to start searching from or NULL, the node
  1005. * you pass will not be searched, only the next one
  1006. * will; typically, you pass what the previous call
  1007. * returned. of_node_put() will be called on it
  1008. * @name: The name string to match against
  1009. *
  1010. * Returns a node pointer with refcount incremented, use
  1011. * of_node_put() on it when done.
  1012. */
  1013. struct device_node *of_find_node_by_name(struct device_node *from,
  1014. const char *name)
  1015. {
  1016. struct device_node *np;
  1017. read_lock(&devtree_lock);
  1018. np = from ? from->allnext : allnodes;
  1019. for (; np != NULL; np = np->allnext)
  1020. if (np->name != NULL && strcasecmp(np->name, name) == 0
  1021. && of_node_get(np))
  1022. break;
  1023. if (from)
  1024. of_node_put(from);
  1025. read_unlock(&devtree_lock);
  1026. return np;
  1027. }
  1028. EXPORT_SYMBOL(of_find_node_by_name);
  1029. /**
  1030. * of_find_node_by_type - Find a node by its "device_type" property
  1031. * @from: The node to start searching from or NULL, the node
  1032. * you pass will not be searched, only the next one
  1033. * will; typically, you pass what the previous call
  1034. * returned. of_node_put() will be called on it
  1035. * @name: The type string to match against
  1036. *
  1037. * Returns a node pointer with refcount incremented, use
  1038. * of_node_put() on it when done.
  1039. */
  1040. struct device_node *of_find_node_by_type(struct device_node *from,
  1041. const char *type)
  1042. {
  1043. struct device_node *np;
  1044. read_lock(&devtree_lock);
  1045. np = from ? from->allnext : allnodes;
  1046. for (; np != 0; np = np->allnext)
  1047. if (np->type != 0 && strcasecmp(np->type, type) == 0
  1048. && of_node_get(np))
  1049. break;
  1050. if (from)
  1051. of_node_put(from);
  1052. read_unlock(&devtree_lock);
  1053. return np;
  1054. }
  1055. EXPORT_SYMBOL(of_find_node_by_type);
  1056. /**
  1057. * of_find_compatible_node - Find a node based on type and one of the
  1058. * tokens in its "compatible" property
  1059. * @from: The node to start searching from or NULL, the node
  1060. * you pass will not be searched, only the next one
  1061. * will; typically, you pass what the previous call
  1062. * returned. of_node_put() will be called on it
  1063. * @type: The type string to match "device_type" or NULL to ignore
  1064. * @compatible: The string to match to one of the tokens in the device
  1065. * "compatible" list.
  1066. *
  1067. * Returns a node pointer with refcount incremented, use
  1068. * of_node_put() on it when done.
  1069. */
  1070. struct device_node *of_find_compatible_node(struct device_node *from,
  1071. const char *type, const char *compatible)
  1072. {
  1073. struct device_node *np;
  1074. read_lock(&devtree_lock);
  1075. np = from ? from->allnext : allnodes;
  1076. for (; np != 0; np = np->allnext) {
  1077. if (type != NULL
  1078. && !(np->type != 0 && strcasecmp(np->type, type) == 0))
  1079. continue;
  1080. if (device_is_compatible(np, compatible) && of_node_get(np))
  1081. break;
  1082. }
  1083. if (from)
  1084. of_node_put(from);
  1085. read_unlock(&devtree_lock);
  1086. return np;
  1087. }
  1088. EXPORT_SYMBOL(of_find_compatible_node);
  1089. /**
  1090. * of_find_node_by_path - Find a node matching a full OF path
  1091. * @path: The full path to match
  1092. *
  1093. * Returns a node pointer with refcount incremented, use
  1094. * of_node_put() on it when done.
  1095. */
  1096. struct device_node *of_find_node_by_path(const char *path)
  1097. {
  1098. struct device_node *np = allnodes;
  1099. read_lock(&devtree_lock);
  1100. for (; np != 0; np = np->allnext) {
  1101. if (np->full_name != 0 && strcasecmp(np->full_name, path) == 0
  1102. && of_node_get(np))
  1103. break;
  1104. }
  1105. read_unlock(&devtree_lock);
  1106. return np;
  1107. }
  1108. EXPORT_SYMBOL(of_find_node_by_path);
  1109. /**
  1110. * of_find_node_by_phandle - Find a node given a phandle
  1111. * @handle: phandle of the node to find
  1112. *
  1113. * Returns a node pointer with refcount incremented, use
  1114. * of_node_put() on it when done.
  1115. */
  1116. struct device_node *of_find_node_by_phandle(phandle handle)
  1117. {
  1118. struct device_node *np;
  1119. read_lock(&devtree_lock);
  1120. for (np = allnodes; np != 0; np = np->allnext)
  1121. if (np->linux_phandle == handle)
  1122. break;
  1123. if (np)
  1124. of_node_get(np);
  1125. read_unlock(&devtree_lock);
  1126. return np;
  1127. }
  1128. EXPORT_SYMBOL(of_find_node_by_phandle);
  1129. /**
  1130. * of_find_all_nodes - Get next node in global list
  1131. * @prev: Previous node or NULL to start iteration
  1132. * of_node_put() will be called on it
  1133. *
  1134. * Returns a node pointer with refcount incremented, use
  1135. * of_node_put() on it when done.
  1136. */
  1137. struct device_node *of_find_all_nodes(struct device_node *prev)
  1138. {
  1139. struct device_node *np;
  1140. read_lock(&devtree_lock);
  1141. np = prev ? prev->allnext : allnodes;
  1142. for (; np != 0; np = np->allnext)
  1143. if (of_node_get(np))
  1144. break;
  1145. if (prev)
  1146. of_node_put(prev);
  1147. read_unlock(&devtree_lock);
  1148. return np;
  1149. }
  1150. EXPORT_SYMBOL(of_find_all_nodes);
  1151. /**
  1152. * of_get_parent - Get a node's parent if any
  1153. * @node: Node to get parent
  1154. *
  1155. * Returns a node pointer with refcount incremented, use
  1156. * of_node_put() on it when done.
  1157. */
  1158. struct device_node *of_get_parent(const struct device_node *node)
  1159. {
  1160. struct device_node *np;
  1161. if (!node)
  1162. return NULL;
  1163. read_lock(&devtree_lock);
  1164. np = of_node_get(node->parent);
  1165. read_unlock(&devtree_lock);
  1166. return np;
  1167. }
  1168. EXPORT_SYMBOL(of_get_parent);
  1169. /**
  1170. * of_get_next_child - Iterate a node childs
  1171. * @node: parent node
  1172. * @prev: previous child of the parent node, or NULL to get first
  1173. *
  1174. * Returns a node pointer with refcount incremented, use
  1175. * of_node_put() on it when done.
  1176. */
  1177. struct device_node *of_get_next_child(const struct device_node *node,
  1178. struct device_node *prev)
  1179. {
  1180. struct device_node *next;
  1181. read_lock(&devtree_lock);
  1182. next = prev ? prev->sibling : node->child;
  1183. for (; next != 0; next = next->sibling)
  1184. if (of_node_get(next))
  1185. break;
  1186. if (prev)
  1187. of_node_put(prev);
  1188. read_unlock(&devtree_lock);
  1189. return next;
  1190. }
  1191. EXPORT_SYMBOL(of_get_next_child);
  1192. /**
  1193. * of_node_get - Increment refcount of a node
  1194. * @node: Node to inc refcount, NULL is supported to
  1195. * simplify writing of callers
  1196. *
  1197. * Returns node.
  1198. */
  1199. struct device_node *of_node_get(struct device_node *node)
  1200. {
  1201. if (node)
  1202. kref_get(&node->kref);
  1203. return node;
  1204. }
  1205. EXPORT_SYMBOL(of_node_get);
  1206. static inline struct device_node * kref_to_device_node(struct kref *kref)
  1207. {
  1208. return container_of(kref, struct device_node, kref);
  1209. }
  1210. /**
  1211. * of_node_release - release a dynamically allocated node
  1212. * @kref: kref element of the node to be released
  1213. *
  1214. * In of_node_put() this function is passed to kref_put()
  1215. * as the destructor.
  1216. */
  1217. static void of_node_release(struct kref *kref)
  1218. {
  1219. struct device_node *node = kref_to_device_node(kref);
  1220. struct property *prop = node->properties;
  1221. if (!OF_IS_DYNAMIC(node))
  1222. return;
  1223. while (prop) {
  1224. struct property *next = prop->next;
  1225. kfree(prop->name);
  1226. kfree(prop->value);
  1227. kfree(prop);
  1228. prop = next;
  1229. if (!prop) {
  1230. prop = node->deadprops;
  1231. node->deadprops = NULL;
  1232. }
  1233. }
  1234. kfree(node->full_name);
  1235. kfree(node->data);
  1236. kfree(node);
  1237. }
  1238. /**
  1239. * of_node_put - Decrement refcount of a node
  1240. * @node: Node to dec refcount, NULL is supported to
  1241. * simplify writing of callers
  1242. *
  1243. */
  1244. void of_node_put(struct device_node *node)
  1245. {
  1246. if (node)
  1247. kref_put(&node->kref, of_node_release);
  1248. }
  1249. EXPORT_SYMBOL(of_node_put);
  1250. /*
  1251. * Plug a device node into the tree and global list.
  1252. */
  1253. void of_attach_node(struct device_node *np)
  1254. {
  1255. write_lock(&devtree_lock);
  1256. np->sibling = np->parent->child;
  1257. np->allnext = allnodes;
  1258. np->parent->child = np;
  1259. allnodes = np;
  1260. write_unlock(&devtree_lock);
  1261. }
  1262. /*
  1263. * "Unplug" a node from the device tree. The caller must hold
  1264. * a reference to the node. The memory associated with the node
  1265. * is not freed until its refcount goes to zero.
  1266. */
  1267. void of_detach_node(const struct device_node *np)
  1268. {
  1269. struct device_node *parent;
  1270. write_lock(&devtree_lock);
  1271. parent = np->parent;
  1272. if (allnodes == np)
  1273. allnodes = np->allnext;
  1274. else {
  1275. struct device_node *prev;
  1276. for (prev = allnodes;
  1277. prev->allnext != np;
  1278. prev = prev->allnext)
  1279. ;
  1280. prev->allnext = np->allnext;
  1281. }
  1282. if (parent->child == np)
  1283. parent->child = np->sibling;
  1284. else {
  1285. struct device_node *prevsib;
  1286. for (prevsib = np->parent->child;
  1287. prevsib->sibling != np;
  1288. prevsib = prevsib->sibling)
  1289. ;
  1290. prevsib->sibling = np->sibling;
  1291. }
  1292. write_unlock(&devtree_lock);
  1293. }
  1294. #ifdef CONFIG_PPC_PSERIES
  1295. /*
  1296. * Fix up the uninitialized fields in a new device node:
  1297. * name, type and pci-specific fields
  1298. */
  1299. static int of_finish_dynamic_node(struct device_node *node)
  1300. {
  1301. struct device_node *parent = of_get_parent(node);
  1302. int err = 0;
  1303. const phandle *ibm_phandle;
  1304. node->name = get_property(node, "name", NULL);
  1305. node->type = get_property(node, "device_type", NULL);
  1306. if (!parent) {
  1307. err = -ENODEV;
  1308. goto out;
  1309. }
  1310. /* We don't support that function on PowerMac, at least
  1311. * not yet
  1312. */
  1313. if (machine_is(powermac))
  1314. return -ENODEV;
  1315. /* fix up new node's linux_phandle field */
  1316. if ((ibm_phandle = get_property(node, "ibm,phandle", NULL)))
  1317. node->linux_phandle = *ibm_phandle;
  1318. out:
  1319. of_node_put(parent);
  1320. return err;
  1321. }
  1322. static int prom_reconfig_notifier(struct notifier_block *nb,
  1323. unsigned long action, void *node)
  1324. {
  1325. int err;
  1326. switch (action) {
  1327. case PSERIES_RECONFIG_ADD:
  1328. err = of_finish_dynamic_node(node);
  1329. if (err < 0) {
  1330. printk(KERN_ERR "finish_node returned %d\n", err);
  1331. err = NOTIFY_BAD;
  1332. }
  1333. break;
  1334. default:
  1335. err = NOTIFY_DONE;
  1336. break;
  1337. }
  1338. return err;
  1339. }
  1340. static struct notifier_block prom_reconfig_nb = {
  1341. .notifier_call = prom_reconfig_notifier,
  1342. .priority = 10, /* This one needs to run first */
  1343. };
  1344. static int __init prom_reconfig_setup(void)
  1345. {
  1346. return pSeries_reconfig_notifier_register(&prom_reconfig_nb);
  1347. }
  1348. __initcall(prom_reconfig_setup);
  1349. #endif
  1350. struct property *of_find_property(const struct device_node *np,
  1351. const char *name,
  1352. int *lenp)
  1353. {
  1354. struct property *pp;
  1355. read_lock(&devtree_lock);
  1356. for (pp = np->properties; pp != 0; pp = pp->next)
  1357. if (strcmp(pp->name, name) == 0) {
  1358. if (lenp != 0)
  1359. *lenp = pp->length;
  1360. break;
  1361. }
  1362. read_unlock(&devtree_lock);
  1363. return pp;
  1364. }
  1365. /*
  1366. * Find a property with a given name for a given node
  1367. * and return the value.
  1368. */
  1369. const void *get_property(const struct device_node *np, const char *name,
  1370. int *lenp)
  1371. {
  1372. struct property *pp = of_find_property(np,name,lenp);
  1373. return pp ? pp->value : NULL;
  1374. }
  1375. EXPORT_SYMBOL(get_property);
  1376. /*
  1377. * Add a property to a node
  1378. */
  1379. int prom_add_property(struct device_node* np, struct property* prop)
  1380. {
  1381. struct property **next;
  1382. prop->next = NULL;
  1383. write_lock(&devtree_lock);
  1384. next = &np->properties;
  1385. while (*next) {
  1386. if (strcmp(prop->name, (*next)->name) == 0) {
  1387. /* duplicate ! don't insert it */
  1388. write_unlock(&devtree_lock);
  1389. return -1;
  1390. }
  1391. next = &(*next)->next;
  1392. }
  1393. *next = prop;
  1394. write_unlock(&devtree_lock);
  1395. #ifdef CONFIG_PROC_DEVICETREE
  1396. /* try to add to proc as well if it was initialized */
  1397. if (np->pde)
  1398. proc_device_tree_add_prop(np->pde, prop);
  1399. #endif /* CONFIG_PROC_DEVICETREE */
  1400. return 0;
  1401. }
  1402. /*
  1403. * Remove a property from a node. Note that we don't actually
  1404. * remove it, since we have given out who-knows-how-many pointers
  1405. * to the data using get-property. Instead we just move the property
  1406. * to the "dead properties" list, so it won't be found any more.
  1407. */
  1408. int prom_remove_property(struct device_node *np, struct property *prop)
  1409. {
  1410. struct property **next;
  1411. int found = 0;
  1412. write_lock(&devtree_lock);
  1413. next = &np->properties;
  1414. while (*next) {
  1415. if (*next == prop) {
  1416. /* found the node */
  1417. *next = prop->next;
  1418. prop->next = np->deadprops;
  1419. np->deadprops = prop;
  1420. found = 1;
  1421. break;
  1422. }
  1423. next = &(*next)->next;
  1424. }
  1425. write_unlock(&devtree_lock);
  1426. if (!found)
  1427. return -ENODEV;
  1428. #ifdef CONFIG_PROC_DEVICETREE
  1429. /* try to remove the proc node as well */
  1430. if (np->pde)
  1431. proc_device_tree_remove_prop(np->pde, prop);
  1432. #endif /* CONFIG_PROC_DEVICETREE */
  1433. return 0;
  1434. }
  1435. /*
  1436. * Update a property in a node. Note that we don't actually
  1437. * remove it, since we have given out who-knows-how-many pointers
  1438. * to the data using get-property. Instead we just move the property
  1439. * to the "dead properties" list, and add the new property to the
  1440. * property list
  1441. */
  1442. int prom_update_property(struct device_node *np,
  1443. struct property *newprop,
  1444. struct property *oldprop)
  1445. {
  1446. struct property **next;
  1447. int found = 0;
  1448. write_lock(&devtree_lock);
  1449. next = &np->properties;
  1450. while (*next) {
  1451. if (*next == oldprop) {
  1452. /* found the node */
  1453. newprop->next = oldprop->next;
  1454. *next = newprop;
  1455. oldprop->next = np->deadprops;
  1456. np->deadprops = oldprop;
  1457. found = 1;
  1458. break;
  1459. }
  1460. next = &(*next)->next;
  1461. }
  1462. write_unlock(&devtree_lock);
  1463. if (!found)
  1464. return -ENODEV;
  1465. #ifdef CONFIG_PROC_DEVICETREE
  1466. /* try to add to proc as well if it was initialized */
  1467. if (np->pde)
  1468. proc_device_tree_update_prop(np->pde, newprop, oldprop);
  1469. #endif /* CONFIG_PROC_DEVICETREE */
  1470. return 0;
  1471. }
  1472. /* Find the device node for a given logical cpu number, also returns the cpu
  1473. * local thread number (index in ibm,interrupt-server#s) if relevant and
  1474. * asked for (non NULL)
  1475. */
  1476. struct device_node *of_get_cpu_node(int cpu, unsigned int *thread)
  1477. {
  1478. int hardid;
  1479. struct device_node *np;
  1480. hardid = get_hard_smp_processor_id(cpu);
  1481. for_each_node_by_type(np, "cpu") {
  1482. const u32 *intserv;
  1483. unsigned int plen, t;
  1484. /* Check for ibm,ppc-interrupt-server#s. If it doesn't exist
  1485. * fallback to "reg" property and assume no threads
  1486. */
  1487. intserv = get_property(np, "ibm,ppc-interrupt-server#s",
  1488. &plen);
  1489. if (intserv == NULL) {
  1490. const u32 *reg = get_property(np, "reg", NULL);
  1491. if (reg == NULL)
  1492. continue;
  1493. if (*reg == hardid) {
  1494. if (thread)
  1495. *thread = 0;
  1496. return np;
  1497. }
  1498. } else {
  1499. plen /= sizeof(u32);
  1500. for (t = 0; t < plen; t++) {
  1501. if (hardid == intserv[t]) {
  1502. if (thread)
  1503. *thread = t;
  1504. return np;
  1505. }
  1506. }
  1507. }
  1508. }
  1509. return NULL;
  1510. }
  1511. EXPORT_SYMBOL(of_get_cpu_node);
  1512. #ifdef DEBUG
  1513. static struct debugfs_blob_wrapper flat_dt_blob;
  1514. static int __init export_flat_device_tree(void)
  1515. {
  1516. struct dentry *d;
  1517. d = debugfs_create_dir("powerpc", NULL);
  1518. if (!d)
  1519. return 1;
  1520. flat_dt_blob.data = initial_boot_params;
  1521. flat_dt_blob.size = initial_boot_params->totalsize;
  1522. d = debugfs_create_blob("flat-device-tree", S_IFREG | S_IRUSR,
  1523. d, &flat_dt_blob);
  1524. if (!d)
  1525. return 1;
  1526. return 0;
  1527. }
  1528. __initcall(export_flat_device_tree);
  1529. #endif