proc_devtree.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:3k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * proc_devtree.c - handles /proc/device-tree
  3.  *
  4.  * Copyright 1997 Paul Mackerras
  5.  */
  6. #include <linux/errno.h>
  7. #include <linux/sched.h>
  8. #include <linux/proc_fs.h>
  9. #include <linux/stat.h>
  10. #include <linux/string.h>
  11. #include <asm/prom.h>
  12. #include <asm/uaccess.h>
  13. static struct proc_dir_entry *proc_device_tree;
  14. /*
  15.  * Supply data on a read from /proc/device-tree/node/property.
  16.  */
  17. static int property_read_proc(char *page, char **start, off_t off,
  18.       int count, int *eof, void *data)
  19. {
  20. struct property *pp = data;
  21. int n;
  22. if (off >= pp->length) {
  23. *eof = 1;
  24. return 0;
  25. }
  26. n = pp->length - off;
  27. if (n > count)
  28. n = count;
  29. else
  30. *eof = 1;
  31. memcpy(page, pp->value + off, n);
  32. *start = page;
  33. return n;
  34. }
  35. /*
  36.  * For a node with a name like "gc@10", we make symlinks called "gc"
  37.  * and "@10" to it.
  38.  */
  39. /*
  40.  * Process a node, adding entries for its children and its properties.
  41.  */
  42. static void add_node(struct device_node *np, struct proc_dir_entry *de)
  43. {
  44. struct property *pp;
  45. struct proc_dir_entry *ent;
  46. struct device_node *child, *sib;
  47. const char *p, *at;
  48. int l;
  49. struct proc_dir_entry *list, **lastp, *al;
  50. lastp = &list;
  51. for (pp = np->properties; pp != 0; pp = pp->next) {
  52. /*
  53.  * Unfortunately proc_register puts each new entry
  54.  * at the beginning of the list.  So we rearrange them.
  55.  */
  56. ent = create_proc_read_entry(pp->name, S_IRUGO, de,
  57.      property_read_proc, pp);
  58. if (ent == 0)
  59. break;
  60. ent->size = pp->length;
  61. *lastp = ent;
  62. lastp = &ent->next;
  63. }
  64. for (child = np->child; child != 0; child = child->sibling) {
  65. p = strrchr(child->full_name, '/');
  66. if (p == 0)
  67. p = child->full_name;
  68. else
  69. ++p;
  70. /* chop off '@0' if the name ends with that */
  71. l = strlen(p);
  72. if (l > 2 && p[l-2] == '@' && p[l-1] == '0')
  73. l -= 2;
  74. ent = proc_mkdir(p, de);
  75. if (ent == 0)
  76. break;
  77. *lastp = ent;
  78. lastp = &ent->next;
  79. add_node(child, ent);
  80. /*
  81.  * If we left the address part on the name, consider
  82.  * adding symlinks from the name and address parts.
  83.  */
  84. if (p[l] != 0 || (at = strchr(p, '@')) == 0)
  85. continue;
  86. /*
  87.  * If this is the first node with a given name property,
  88.  * add a symlink with the name property as its name.
  89.  */
  90. for (sib = np->child; sib != child; sib = sib->sibling)
  91. if (sib->name && strcmp(sib->name, child->name) == 0)
  92. break;
  93. if (sib == child && strncmp(p, child->name, l) != 0) {
  94. al = proc_symlink(child->name, de, ent->name);
  95. if (al == 0)
  96. break;
  97. *lastp = al;
  98. lastp = &al->next;
  99. }
  100. /*
  101.  * Add another directory with the @address part as its name.
  102.  */
  103. al = proc_symlink(at, de, ent->name);
  104. if (al == 0)
  105. break;
  106. *lastp = al;
  107. lastp = &al->next;
  108. }
  109. *lastp = 0;
  110. de->subdir = list;
  111. }
  112. /*
  113.  * Called on initialization to set up the /proc/device-tree subtree
  114.  */
  115. void proc_device_tree_init(void)
  116. {
  117. struct device_node *root;
  118. if ( !have_of )
  119. return;
  120. proc_device_tree = proc_mkdir("device-tree", 0);
  121. if (proc_device_tree == 0)
  122. return;
  123. root = find_path_device("/");
  124. if (root == 0) {
  125. printk(KERN_ERR "/proc/device-tree: can't find rootn");
  126. return;
  127. }
  128. add_node(root, proc_device_tree);
  129. }