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

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: ranges.c,v 1.14.2.1 2001/12/19 00:16:21 davem Exp $
  2.  * ranges.c: Handle ranges in newer proms for obio/sbus.
  3.  *
  4.  * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
  5.  * Copyright (C) 1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
  6.  */
  7. #include <linux/init.h>
  8. #include <asm/openprom.h>
  9. #include <asm/oplib.h>
  10. #include <asm/types.h>
  11. #include <asm/sbus.h>
  12. #include <asm/system.h>
  13. struct linux_prom_ranges promlib_obio_ranges[PROMREG_MAX];
  14. int num_obio_ranges;
  15. /* Adjust register values based upon the ranges parameters. */
  16. static void
  17. prom_adjust_regs(struct linux_prom_registers *regp, int nregs,
  18.  struct linux_prom_ranges *rangep, int nranges)
  19. {
  20. int regc, rngc;
  21. for (regc = 0; regc < nregs; regc++) {
  22. for (rngc = 0; rngc < nranges; rngc++)
  23. if (regp[regc].which_io == rangep[rngc].ot_child_space)
  24. break; /* Fount it */
  25. if (rngc == nranges) /* oops */
  26. prom_printf("adjust_regs: Could not find range with matching bus type...n");
  27. regp[regc].which_io = rangep[rngc].ot_parent_space;
  28. regp[regc].phys_addr -= rangep[rngc].ot_child_base;
  29. regp[regc].phys_addr += rangep[rngc].ot_parent_base;
  30. }
  31. }
  32. static void
  33. prom_adjust_ranges(struct linux_prom_ranges *ranges1, int nranges1,
  34.    struct linux_prom_ranges *ranges2, int nranges2)
  35. {
  36. int rng1c, rng2c;
  37. for(rng1c=0; rng1c < nranges1; rng1c++) {
  38. for(rng2c=0; rng2c < nranges2; rng2c++)
  39. if(ranges1[rng1c].ot_parent_space == ranges2[rng2c].ot_child_space &&
  40.    ranges1[rng1c].ot_parent_base >= ranges2[rng2c].ot_child_base &&
  41.    ranges2[rng2c].ot_child_base + ranges2[rng2c].or_size - ranges1[rng1c].ot_parent_base > 0U)
  42. break;
  43. if(rng2c == nranges2) /* oops */
  44. prom_printf("adjust_ranges: Could not find matching bus type...n");
  45. else if (ranges1[rng1c].ot_parent_base + ranges1[rng1c].or_size > ranges2[rng2c].ot_child_base + ranges2[rng2c].or_size)
  46. ranges1[rng1c].or_size =
  47. ranges2[rng2c].ot_child_base + ranges2[rng2c].or_size - ranges1[rng1c].ot_parent_base;
  48. ranges1[rng1c].ot_parent_space = ranges2[rng2c].ot_parent_space;
  49. ranges1[rng1c].ot_parent_base += ranges2[rng2c].ot_parent_base;
  50. }
  51. }
  52. /* Apply probed obio ranges to registers passed, if no ranges return. */
  53. void
  54. prom_apply_obio_ranges(struct linux_prom_registers *regs, int nregs)
  55. {
  56. if(num_obio_ranges)
  57. prom_adjust_regs(regs, nregs, promlib_obio_ranges, num_obio_ranges);
  58. }
  59. void __init prom_ranges_init(void)
  60. {
  61. int node, obio_node;
  62. int success;
  63. num_obio_ranges = 0;
  64. /* Check for obio and sbus ranges. */
  65. node = prom_getchild(prom_root_node);
  66. obio_node = prom_searchsiblings(node, "obio");
  67. if(obio_node) {
  68. success = prom_getproperty(obio_node, "ranges",
  69.    (char *) promlib_obio_ranges,
  70.    sizeof(promlib_obio_ranges));
  71. if(success != -1)
  72. num_obio_ranges = (success/sizeof(struct linux_prom_ranges));
  73. }
  74. if(num_obio_ranges)
  75. prom_printf("PROMLIB: obio_ranges %dn", num_obio_ranges);
  76. return;
  77. }
  78. void
  79. prom_apply_generic_ranges (int node, int parent, struct linux_prom_registers *regs, int nregs)
  80. {
  81. int success;
  82. int num_ranges;
  83. struct linux_prom_ranges ranges[PROMREG_MAX];
  84. success = prom_getproperty(node, "ranges",
  85.    (char *) ranges,
  86.    sizeof (ranges));
  87. if (success != -1) {
  88. num_ranges = (success/sizeof(struct linux_prom_ranges));
  89. if (parent) {
  90. struct linux_prom_ranges parent_ranges[PROMREG_MAX];
  91. int num_parent_ranges;
  92. success = prom_getproperty(parent, "ranges",
  93.        (char *) parent_ranges,
  94.        sizeof (parent_ranges));
  95. if (success != -1) {
  96. num_parent_ranges = (success/sizeof(struct linux_prom_ranges));
  97. prom_adjust_ranges (ranges, num_ranges, parent_ranges, num_parent_ranges);
  98. }
  99. }
  100. prom_adjust_regs(regs, nregs, ranges, num_ranges);
  101. }
  102. }