1 /* $Id: ranges.c,v 1.15 2001/12/19 00:29:51 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 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 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 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 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 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