Commit | Line | Data |
---|---|---|
88278ca2 | 1 | /* |
1da177e4 LT |
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> | |
1da177e4 LT |
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 | } |