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
8 #include <linux/init.h>
9 #include <asm/openprom.h>
10 #include <asm/oplib.h>
11 #include <asm/types.h>
12 #include <asm/sbus.h>
13 #include <asm/system.h>
14
15 struct linux_prom_ranges promlib_obio_ranges[PROMREG_MAX];
16 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,struct linux_prom_ranges * rangep,int nranges)20 prom_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
37 void
prom_adjust_ranges(struct linux_prom_ranges * ranges1,int nranges1,struct linux_prom_ranges * ranges2,int nranges2)38 prom_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. */
60 void
prom_apply_obio_ranges(struct linux_prom_registers * regs,int nregs)61 prom_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 }
66
prom_ranges_init(void)67 void __init prom_ranges_init(void)
68 {
69 int node, obio_node;
70 int success;
71
72 num_obio_ranges = 0;
73
74 /* Check for obio and sbus ranges. */
75 node = prom_getchild(prom_root_node);
76 obio_node = prom_searchsiblings(node, "obio");
77
78 if(obio_node) {
79 success = prom_getproperty(obio_node, "ranges",
80 (char *) promlib_obio_ranges,
81 sizeof(promlib_obio_ranges));
82 if(success != -1)
83 num_obio_ranges = (success/sizeof(struct linux_prom_ranges));
84 }
85
86 if(num_obio_ranges)
87 prom_printf("PROMLIB: obio_ranges %d\n", num_obio_ranges);
88
89 return;
90 }
91
92 void
prom_apply_generic_ranges(int node,int parent,struct linux_prom_registers * regs,int nregs)93 prom_apply_generic_ranges (int node, int parent, struct linux_prom_registers *regs, int nregs)
94 {
95 int success;
96 int num_ranges;
97 struct linux_prom_ranges ranges[PROMREG_MAX];
98
99 success = prom_getproperty(node, "ranges",
100 (char *) ranges,
101 sizeof (ranges));
102 if (success != -1) {
103 num_ranges = (success/sizeof(struct linux_prom_ranges));
104 if (parent) {
105 struct linux_prom_ranges parent_ranges[PROMREG_MAX];
106 int num_parent_ranges;
107
108 success = prom_getproperty(parent, "ranges",
109 (char *) parent_ranges,
110 sizeof (parent_ranges));
111 if (success != -1) {
112 num_parent_ranges = (success/sizeof(struct linux_prom_ranges));
113 prom_adjust_ranges (ranges, num_ranges, parent_ranges, num_parent_ranges);
114 }
115 }
116 prom_adjust_regs(regs, nregs, ranges, num_ranges);
117 }
118 }
119