Merge branch 'topic/fix/hda' into for-linus
[linux-2.6] / 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 <asm/openprom.h>
10 #include <asm/oplib.h>
11 #include <asm/types.h>
12 #include <asm/system.h>
13
14 struct linux_prom_ranges promlib_obio_ranges[PROMREG_MAX];
15 int num_obio_ranges;
16
17 /* Adjust register values based upon the ranges parameters. */
18 static void
19 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 void
37 prom_adjust_ranges(struct linux_prom_ranges *ranges1, int nranges1,
38                    struct linux_prom_ranges *ranges2, int nranges2)
39 {
40         int rng1c, rng2c;
41
42         for(rng1c=0; rng1c < nranges1; rng1c++) {
43                 for(rng2c=0; rng2c < nranges2; rng2c++)
44                         if(ranges1[rng1c].ot_parent_space == ranges2[rng2c].ot_child_space &&
45                            ranges1[rng1c].ot_parent_base >= ranges2[rng2c].ot_child_base &&
46                            ranges2[rng2c].ot_child_base + ranges2[rng2c].or_size - ranges1[rng1c].ot_parent_base > 0U)
47                         break;
48                 if(rng2c == nranges2) /* oops */
49                         prom_printf("adjust_ranges: Could not find matching bus type...\n");
50                 else if (ranges1[rng1c].ot_parent_base + ranges1[rng1c].or_size > ranges2[rng2c].ot_child_base + ranges2[rng2c].or_size)
51                         ranges1[rng1c].or_size =
52                                 ranges2[rng2c].ot_child_base + ranges2[rng2c].or_size - ranges1[rng1c].ot_parent_base;
53                 ranges1[rng1c].ot_parent_space = ranges2[rng2c].ot_parent_space;
54                 ranges1[rng1c].ot_parent_base += ranges2[rng2c].ot_parent_base;
55         }
56 }
57
58 /* Apply probed obio ranges to registers passed, if no ranges return. */
59 void
60 prom_apply_obio_ranges(struct linux_prom_registers *regs, int nregs)
61 {
62         if(num_obio_ranges)
63                 prom_adjust_regs(regs, nregs, promlib_obio_ranges, num_obio_ranges);
64 }
65
66 void __init prom_ranges_init(void)
67 {
68         int node, obio_node;
69         int success;
70
71         num_obio_ranges = 0;
72
73         /* Check for obio and sbus ranges. */
74         node = prom_getchild(prom_root_node);
75         obio_node = prom_searchsiblings(node, "obio");
76
77         if(obio_node) {
78                 success = prom_getproperty(obio_node, "ranges",
79                                            (char *) promlib_obio_ranges,
80                                            sizeof(promlib_obio_ranges));
81                 if(success != -1)
82                         num_obio_ranges = (success/sizeof(struct linux_prom_ranges));
83         }
84
85         if(num_obio_ranges)
86                 prom_printf("PROMLIB: obio_ranges %d\n", num_obio_ranges);
87
88         return;
89 }
90
91 void
92 prom_apply_generic_ranges (int node, int parent, 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 }