arch/sparc/prom/ranges.c

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