ranges.c 3.7 KB

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