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