1 1.64 macallan /* $NetBSD: ofwoea_machdep.c,v 1.64 2024/05/28 11:06:07 macallan Exp $ */ 2 1.2 garbled 3 1.2 garbled /*- 4 1.2 garbled * Copyright (c) 2007 The NetBSD Foundation, Inc. 5 1.2 garbled * All rights reserved. 6 1.2 garbled * 7 1.2 garbled * This code is derived from software contributed to The NetBSD Foundation 8 1.2 garbled * by Tim Rightnour 9 1.2 garbled * 10 1.2 garbled * Redistribution and use in source and binary forms, with or without 11 1.2 garbled * modification, are permitted provided that the following conditions 12 1.2 garbled * are met: 13 1.2 garbled * 1. Redistributions of source code must retain the above copyright 14 1.2 garbled * notice, this list of conditions and the following disclaimer. 15 1.2 garbled * 2. Redistributions in binary form must reproduce the above copyright 16 1.2 garbled * notice, this list of conditions and the following disclaimer in the 17 1.2 garbled * documentation and/or other materials provided with the distribution. 18 1.2 garbled * 19 1.2 garbled * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.2 garbled * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.2 garbled * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.2 garbled * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.2 garbled * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.2 garbled * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.2 garbled * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.2 garbled * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.2 garbled * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.2 garbled * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.2 garbled * POSSIBILITY OF SUCH DAMAGE. 30 1.2 garbled */ 31 1.2 garbled 32 1.2 garbled #include <sys/cdefs.h> 33 1.64 macallan __KERNEL_RCSID(0, "$NetBSD: ofwoea_machdep.c,v 1.64 2024/05/28 11:06:07 macallan Exp $"); 34 1.2 garbled 35 1.48 rin #include "ksyms.h" 36 1.48 rin #include "wsdisplay.h" 37 1.48 rin 38 1.48 rin #ifdef _KERNEL_OPT 39 1.48 rin #include "opt_ddb.h" 40 1.2 garbled #include "opt_kgdb.h" 41 1.17 apb #include "opt_modular.h" 42 1.49 rin #include "opt_multiprocessor.h" 43 1.48 rin #include "opt_oea.h" 44 1.48 rin #include "opt_ofwoea.h" 45 1.48 rin #include "opt_ppcarch.h" 46 1.48 rin #endif 47 1.32 macallan 48 1.2 garbled #include <sys/param.h> 49 1.2 garbled #include <sys/buf.h> 50 1.2 garbled #include <sys/boot_flag.h> 51 1.2 garbled #include <sys/extent.h> 52 1.2 garbled #include <sys/kernel.h> 53 1.2 garbled #include <sys/ksyms.h> 54 1.2 garbled #include <uvm/uvm_extern.h> 55 1.2 garbled 56 1.2 garbled #include <dev/ofw/openfirm.h> 57 1.32 macallan #include <dev/wscons/wsconsio.h> 58 1.32 macallan #include <dev/wscons/wsdisplayvar.h> 59 1.32 macallan #include <dev/rasops/rasops.h> 60 1.32 macallan #include <dev/wscons/wsdisplay_vconsvar.h> 61 1.2 garbled #include <machine/pmap.h> 62 1.2 garbled #include <machine/powerpc.h> 63 1.2 garbled #include <machine/trap.h> 64 1.5 garbled #include <machine/vmparam.h> 65 1.6 garbled #include <machine/autoconf.h> 66 1.24 dyoung #include <sys/bus.h> 67 1.2 garbled #include <powerpc/oea/bat.h> 68 1.32 macallan #include <powerpc/oea/ofw_rasconsvar.h> 69 1.10 garbled #include <powerpc/oea/cpufeat.h> 70 1.37 macallan #include <powerpc/include/oea/spr.h> 71 1.2 garbled #include <powerpc/ofw_cons.h> 72 1.52 thorpej #include <powerpc/ofw_machdep.h> 73 1.2 garbled #include <powerpc/spr.h> 74 1.22 matt #include <powerpc/pic/picvar.h> 75 1.2 garbled 76 1.2 garbled #ifdef DDB 77 1.2 garbled #include <machine/db_machdep.h> 78 1.2 garbled #include <ddb/db_extern.h> 79 1.2 garbled #endif 80 1.2 garbled 81 1.2 garbled #ifdef KGDB 82 1.2 garbled #include <sys/kgdb.h> 83 1.2 garbled #endif 84 1.2 garbled 85 1.11 garbled #ifdef ofppc 86 1.11 garbled extern struct model_data modeldata; 87 1.11 garbled #endif 88 1.11 garbled 89 1.2 garbled #ifdef OFWOEA_DEBUG 90 1.2 garbled #define DPRINTF printf 91 1.2 garbled #else 92 1.3 garbled #define DPRINTF while (0) printf 93 1.2 garbled #endif 94 1.2 garbled 95 1.2 garbled typedef struct _rangemap { 96 1.2 garbled u_int32_t addr; 97 1.2 garbled u_int32_t size; 98 1.2 garbled int type; 99 1.2 garbled } rangemap_t; 100 1.2 garbled 101 1.52 thorpej struct OF_translation ofw_translations[OFW_MAX_TRANSLATIONS]; 102 1.2 garbled 103 1.54 thorpej /* 104 1.54 thorpej * Data structures holding OpenFirmware's translations when running 105 1.54 thorpej * in virtual-mode. 106 1.54 thorpej * 107 1.54 thorpej * When we call into OpenFirmware, we point the calling CPU's 108 1.54 thorpej * cpu_info::ci_battable at ofw_battable[]. For now, this table 109 1.54 thorpej * is empty, which will ensure that any DSI exceptions that occur 110 1.54 thorpej * during the firmware call will not erroneously load kernel BAT 111 1.54 thorpej * mappings that could clobber the firmware's translations. 112 1.54 thorpej */ 113 1.2 garbled struct pmap ofw_pmap; 114 1.54 thorpej struct bat ofw_battable[BAT_VA2IDX(0xffffffff)+1]; 115 1.54 thorpej 116 1.64 macallan char bootpath[256] = ""; 117 1.6 garbled char model_name[64]; 118 1.15 ad #if NKSYMS || defined(DDB) || defined(MODULAR) 119 1.2 garbled void *startsym, *endsym; 120 1.2 garbled #endif 121 1.37 macallan 122 1.37 macallan #if PPC_OEA601 123 1.37 macallan #define TIMEBASE_FREQ (1000000000) /* RTC register */ 124 1.37 macallan #endif 125 1.37 macallan 126 1.2 garbled #ifdef TIMEBASE_FREQ 127 1.2 garbled u_int timebase_freq = TIMEBASE_FREQ; 128 1.2 garbled #else 129 1.2 garbled u_int timebase_freq = 0; 130 1.2 garbled #endif 131 1.2 garbled 132 1.50 rin int ofw_quiesce; 133 1.50 rin 134 1.25 macallan extern int ofwmsr; 135 1.2 garbled extern uint32_t ticks_per_sec; 136 1.2 garbled extern uint32_t ns_per_tick; 137 1.2 garbled extern uint32_t ticks_per_intr; 138 1.2 garbled 139 1.58 thorpej static void get_timebase_frequency(void); 140 1.58 thorpej static void init_decrementer(void); 141 1.58 thorpej 142 1.52 thorpej static void restore_ofmap(void); 143 1.2 garbled 144 1.2 garbled void 145 1.2 garbled ofwoea_initppc(u_int startkernel, u_int endkernel, char *args) 146 1.2 garbled { 147 1.2 garbled register_t scratch; 148 1.2 garbled 149 1.15 ad #if NKSYMS || defined(DDB) || defined(MODULAR) 150 1.2 garbled /* get info of kernel symbol table from bootloader */ 151 1.2 garbled memcpy(&startsym, args + strlen(args) + 1, sizeof(startsym)); 152 1.2 garbled memcpy(&endsym, args + strlen(args) + 1 + sizeof(startsym), 153 1.2 garbled sizeof(endsym)); 154 1.2 garbled if (startsym == NULL || endsym == NULL) 155 1.2 garbled startsym = endsym = NULL; 156 1.2 garbled #endif 157 1.2 garbled 158 1.2 garbled /* Parse the args string */ 159 1.2 garbled if (args) { 160 1.2 garbled strcpy(bootpath, args); 161 1.2 garbled args = bootpath; 162 1.2 garbled while (*++args && *args != ' '); 163 1.2 garbled if (*args) { 164 1.2 garbled *args++ = 0; 165 1.2 garbled while (*args) 166 1.2 garbled BOOT_FLAG(*args++, boothowto); 167 1.2 garbled } 168 1.64 macallan } 169 1.64 macallan 170 1.64 macallan /* if bootpath is still empty, get it from /chosen */ 171 1.64 macallan if (bootpath[0] == 0) { 172 1.44 macallan int chs = OF_finddevice("/chosen"); 173 1.44 macallan int len; 174 1.44 macallan 175 1.44 macallan len = OF_getprop(chs, "bootpath", bootpath, sizeof(bootpath) - 1); 176 1.44 macallan if (len > -1) 177 1.44 macallan bootpath[len] = 0; 178 1.2 garbled } 179 1.2 garbled 180 1.58 thorpej /* Get the timebase frequency from the firmware. */ 181 1.58 thorpej get_timebase_frequency(); 182 1.58 thorpej 183 1.59 thorpej /* Probe for the console device; it's initialized later. */ 184 1.59 thorpej ofwoea_cnprobe(); 185 1.57 thorpej 186 1.57 thorpej if (ofw_quiesce) 187 1.57 thorpej OF_quiesce(); 188 1.57 thorpej 189 1.55 thorpej oea_init(pic_ext_intr); 190 1.55 thorpej 191 1.55 thorpej /* 192 1.55 thorpej * Now that we've installed our own exception vectors, 193 1.55 thorpej * ensure that exceptions that happen while running 194 1.55 thorpej * firmware code fall into ours. 195 1.55 thorpej */ 196 1.55 thorpej ofwmsr &= ~PSL_IP; 197 1.55 thorpej 198 1.59 thorpej /* Initialize bus_space */ 199 1.59 thorpej ofwoea_bus_space_init(); 200 1.59 thorpej 201 1.59 thorpej /* Initialize the console device. */ 202 1.59 thorpej ofwoea_consinit(); 203 1.59 thorpej 204 1.39 cherry uvm_md_init(); 205 1.10 garbled 206 1.2 garbled pmap_bootstrap(startkernel, endkernel); 207 1.2 garbled 208 1.13 garbled /* as far as I can tell, the pmap_setup_seg0 stuff is horribly broken */ 209 1.2 garbled #if defined(PPC_OEA64) || defined (PPC_OEA64_BRIDGE) 210 1.2 garbled #if defined (PMAC_G5) 211 1.2 garbled /* Mapin 1st 256MB segment 1:1, also map in mem needed to access OFW*/ 212 1.32 macallan if (oeacpufeat & OEACPU_64_BRIDGE) { 213 1.32 macallan vaddr_t va; 214 1.32 macallan paddr_t pa; 215 1.53 thorpej vsize_t size; 216 1.32 macallan int i; 217 1.32 macallan 218 1.33 macallan pmap_setup_segment0_map(0, msgbuf_paddr, msgbuf_paddr, 219 1.33 macallan round_page(MSGBUFSIZE), 0x0); 220 1.32 macallan 221 1.32 macallan /* Map OFW code+data */ 222 1.32 macallan 223 1.53 thorpej for (i = 0; i < __arraycount(ofw_translations); i++) { 224 1.53 thorpej va = ofw_translations[i].virt; 225 1.53 thorpej size = ofw_translations[i].size; 226 1.53 thorpej pa = ofw_translations[i].phys; 227 1.53 thorpej /* XXX mode */ 228 1.53 thorpej 229 1.53 thorpej if (size == 0) { 230 1.53 thorpej /* No more, all done! */ 231 1.53 thorpej break; 232 1.53 thorpej } 233 1.53 thorpej 234 1.53 thorpej if (va < 0xff800000) 235 1.32 macallan continue; 236 1.32 macallan 237 1.53 thorpej 238 1.53 thorpej for (; va < (ofw_translations[i].virt + size); 239 1.32 macallan va += PAGE_SIZE, pa += PAGE_SIZE) { 240 1.32 macallan pmap_enter(pmap_kernel(), va, pa, VM_PROT_ALL, 241 1.32 macallan VM_PROT_ALL | PMAP_WIRED); 242 1.32 macallan } 243 1.32 macallan } 244 1.32 macallan 245 1.32 macallan #if NWSDISPLAY > 0 246 1.32 macallan /* Map video frame buffer */ 247 1.32 macallan 248 1.32 macallan struct rasops_info *ri = &rascons_console_screen.scr_ri; 249 1.32 macallan 250 1.32 macallan if (ri->ri_bits != NULL) { 251 1.32 macallan for (va = (vaddr_t) ri->ri_bits; 252 1.32 macallan va < round_page((vaddr_t) ri->ri_bits + 253 1.32 macallan ri->ri_height * ri->ri_stride); 254 1.32 macallan va += PAGE_SIZE) { 255 1.32 macallan pmap_enter(pmap_kernel(), va, va, 256 1.32 macallan VM_PROT_READ | VM_PROT_WRITE, 257 1.32 macallan PMAP_NOCACHE | PMAP_WIRED); 258 1.32 macallan } 259 1.32 macallan } 260 1.32 macallan #endif 261 1.32 macallan } 262 1.2 garbled #elif defined (MAMBO) 263 1.2 garbled /* Mapin 1st 256MB segment 1:1, also map in mem needed to access OFW*/ 264 1.10 garbled if (oeacpufeat & OEACPU_64_BRIDGE) 265 1.10 garbled pmap_setup_segment0_map(0, 0xf4000000, 0xf4000000, 0x1000, 0x0); 266 1.2 garbled #endif /* PMAC_G5 */ 267 1.10 garbled #endif /* PPC_OEA64 || PPC_OEA64_BRIDGE */ 268 1.2 garbled 269 1.2 garbled /* Now enable translation (and machine checks/recoverable interrupts) */ 270 1.2 garbled __asm __volatile ("sync; mfmsr %0; ori %0,%0,%1; mtmsr %0; isync" 271 1.2 garbled : "=r"(scratch) 272 1.2 garbled : "K"(PSL_IR|PSL_DR|PSL_ME|PSL_RI)); 273 1.2 garbled 274 1.52 thorpej restore_ofmap(); 275 1.2 garbled 276 1.63 andvar #if NWSDISPLAY > 0 277 1.43 macallan rascons_finalize(); 278 1.63 andvar #endif 279 1.43 macallan 280 1.15 ad #if NKSYMS || defined(DDB) || defined(MODULAR) 281 1.36 matt ksyms_addsyms_elf((int)((uintptr_t)endsym - (uintptr_t)startsym), startsym, endsym); 282 1.2 garbled #endif 283 1.2 garbled 284 1.58 thorpej /* Kick off the clock. */ 285 1.58 thorpej init_decrementer(); 286 1.26 phx 287 1.26 phx #ifdef DDB 288 1.26 phx if (boothowto & RB_KDB) 289 1.26 phx Debugger(); 290 1.26 phx #endif 291 1.2 garbled } 292 1.2 garbled 293 1.58 thorpej static void 294 1.58 thorpej get_timebase_frequency(void) 295 1.2 garbled { 296 1.58 thorpej int qhandle, phandle, node; 297 1.2 garbled char type[32]; 298 1.2 garbled 299 1.2 garbled if (timebase_freq != 0) { 300 1.2 garbled ticks_per_sec = timebase_freq; 301 1.58 thorpej return; 302 1.2 garbled } 303 1.2 garbled 304 1.41 macallan node = OF_finddevice("/cpus/@0"); 305 1.42 mrg if (node != -1 && 306 1.42 mrg OF_getprop(node, "timebase-frequency", &ticks_per_sec, 307 1.42 mrg sizeof ticks_per_sec) > 0) { 308 1.58 thorpej return; 309 1.41 macallan } 310 1.41 macallan 311 1.41 macallan node = OF_finddevice("/"); 312 1.41 macallan for (qhandle = node; qhandle; qhandle = phandle) { 313 1.2 garbled if (OF_getprop(qhandle, "device_type", type, sizeof type) > 0 314 1.2 garbled && strcmp(type, "cpu") == 0 315 1.2 garbled && OF_getprop(qhandle, "timebase-frequency", 316 1.2 garbled &ticks_per_sec, sizeof ticks_per_sec) > 0) { 317 1.58 thorpej return; 318 1.2 garbled } 319 1.2 garbled if ((phandle = OF_child(qhandle))) 320 1.2 garbled continue; 321 1.2 garbled while (qhandle) { 322 1.2 garbled if ((phandle = OF_peer(qhandle))) 323 1.2 garbled break; 324 1.2 garbled qhandle = OF_parent(qhandle); 325 1.2 garbled } 326 1.2 garbled } 327 1.2 garbled panic("no cpu node"); 328 1.58 thorpej } 329 1.58 thorpej 330 1.58 thorpej static void 331 1.58 thorpej init_decrementer(void) 332 1.58 thorpej { 333 1.58 thorpej int scratch, msr; 334 1.58 thorpej 335 1.58 thorpej KASSERT(ticks_per_sec != 0); 336 1.2 garbled 337 1.2 garbled __asm volatile ("mfmsr %0; andi. %1,%0,%2; mtmsr %1" 338 1.2 garbled : "=r"(msr), "=r"(scratch) : "K"((u_short)~PSL_EE)); 339 1.2 garbled ns_per_tick = 1000000000 / ticks_per_sec; 340 1.2 garbled ticks_per_intr = ticks_per_sec / hz; 341 1.2 garbled cpu_timebase = ticks_per_sec; 342 1.37 macallan 343 1.37 macallan #ifdef PPC_OEA601 344 1.37 macallan if ((mfpvr() >> 16) == MPC601) 345 1.58 thorpej curcpu()->ci_lasttb = rtc_nanosecs(); 346 1.37 macallan else 347 1.37 macallan #endif 348 1.58 thorpej curcpu()->ci_lasttb = mftbl(); 349 1.37 macallan 350 1.2 garbled mtspr(SPR_DEC, ticks_per_intr); 351 1.2 garbled mtmsr(msr); 352 1.2 garbled } 353 1.2 garbled 354 1.2 garbled void 355 1.52 thorpej restore_ofmap(void) 356 1.2 garbled { 357 1.52 thorpej vaddr_t va, size; 358 1.52 thorpej paddr_t pa; 359 1.2 garbled int i; 360 1.2 garbled 361 1.2 garbled pmap_pinit(&ofw_pmap); 362 1.2 garbled 363 1.36 matt #ifndef _LP64 364 1.32 macallan ofw_pmap.pm_sr[0] = KERNELN_SEGMENT(0)|SR_PRKEY; 365 1.32 macallan ofw_pmap.pm_sr[KERNEL_SR] = KERNEL_SEGMENT|SR_SUKEY|SR_PRKEY; 366 1.2 garbled 367 1.2 garbled #ifdef KERNEL2_SR 368 1.32 macallan ofw_pmap.pm_sr[KERNEL2_SR] = KERNEL2_SEGMENT|SR_SUKEY|SR_PRKEY; 369 1.2 garbled #endif 370 1.36 matt #endif 371 1.2 garbled 372 1.52 thorpej for (i = 0; i < __arraycount(ofw_translations); i++) { 373 1.52 thorpej va = ofw_translations[i].virt; 374 1.52 thorpej size = ofw_translations[i].size; 375 1.52 thorpej pa = ofw_translations[i].phys; 376 1.52 thorpej /* XXX mode */ 377 1.52 thorpej 378 1.52 thorpej if (size == 0) { 379 1.52 thorpej /* No more, all done! */ 380 1.52 thorpej break; 381 1.52 thorpej } 382 1.2 garbled 383 1.52 thorpej if (va < 0xf0000000) /* XXX */ 384 1.2 garbled continue; 385 1.2 garbled 386 1.60 macallan /* 387 1.61 macallan * XXX macallan@ 388 1.61 macallan * My beige G3 throws a DSI trap if we try to map the last page 389 1.61 macallan * of the 32bit address space. On old world macs the firmware 390 1.61 macallan * ROM occupies 4MB at 0xffc00000, triggering it when we 391 1.61 macallan * restore OF translations. This just works around a bug 392 1.61 macallan * elsewhere in pmap and should go away once fixed there. 393 1.60 macallan */ 394 1.60 macallan if (pa == 0xffc00000 && size == 0x400000) 395 1.60 macallan size = 0x3ff000; 396 1.60 macallan 397 1.52 thorpej while (size > 0) { 398 1.52 thorpej pmap_enter(&ofw_pmap, va, pa, VM_PROT_ALL, 399 1.2 garbled VM_PROT_ALL|PMAP_WIRED); 400 1.2 garbled pa += PAGE_SIZE; 401 1.2 garbled va += PAGE_SIZE; 402 1.52 thorpej size -= PAGE_SIZE; 403 1.2 garbled } 404 1.2 garbled } 405 1.2 garbled pmap_update(&ofw_pmap); 406 1.19 kiyohara } 407 1.2 garbled 408 1.2 garbled /* we define these partially, as we will fill the rest in later */ 409 1.2 garbled struct powerpc_bus_space genppc_isa_io_space_tag = { 410 1.2 garbled .pbs_flags = _BUS_SPACE_LITTLE_ENDIAN|_BUS_SPACE_IO_TYPE, 411 1.2 garbled .pbs_base = 0x00000000, 412 1.2 garbled }; 413 1.2 garbled 414 1.2 garbled struct powerpc_bus_space genppc_isa_mem_space_tag = { 415 1.2 garbled .pbs_flags = _BUS_SPACE_LITTLE_ENDIAN|_BUS_SPACE_MEM_TYPE, 416 1.2 garbled .pbs_base = 0x00000000, 417 1.2 garbled }; 418 1.2 garbled 419 1.2 garbled /* This gives us a maximum of 6 PCI busses, assuming both io/mem on each. 420 1.2 garbled * Increase if necc. 421 1.2 garbled */ 422 1.2 garbled static char ex_storage[EXSTORAGE_MAX][EXTENT_FIXED_STORAGE_SIZE(EXTMAP_RANGES)] 423 1.2 garbled __attribute__((aligned(8))); 424 1.2 garbled 425 1.2 garbled 426 1.2 garbled static void 427 1.2 garbled find_ranges(int base, rangemap_t *regions, int *cur, int type) 428 1.2 garbled { 429 1.2 garbled int node, i, len, reclen; 430 1.32 macallan u_int32_t parent_acells, acells, scells, map[160]; 431 1.2 garbled char tmp[32]; 432 1.2 garbled 433 1.2 garbled node = base; 434 1.2 garbled if (OF_getprop(node, "device_type", tmp, sizeof(tmp)) == -1) 435 1.2 garbled goto rec; 436 1.2 garbled if ((type == RANGE_TYPE_PCI || type == RANGE_TYPE_FIRSTPCI) && 437 1.2 garbled strcmp("pci", tmp) != 0) 438 1.2 garbled goto rec; 439 1.2 garbled if (type == RANGE_TYPE_ISA && strcmp("isa", tmp) != 0) 440 1.2 garbled goto rec; 441 1.40 macallan if (type == RANGE_TYPE_MACIO && strcmp("memory-controller", tmp) == 0) { 442 1.40 macallan len = OF_getprop(node, "reg", map, sizeof(map)); 443 1.40 macallan acells = 1; 444 1.40 macallan scells = 1; 445 1.40 macallan } else { 446 1.40 macallan len = OF_getprop(node, "ranges", map, sizeof(map)); 447 1.40 macallan } 448 1.2 garbled if (len == -1) 449 1.2 garbled goto rec; 450 1.32 macallan if (OF_getprop(OF_parent(node), "#address-cells", &parent_acells, 451 1.32 macallan sizeof(parent_acells)) != sizeof(parent_acells)) 452 1.32 macallan parent_acells = 1; 453 1.2 garbled if (OF_getprop(node, "#address-cells", &acells, 454 1.2 garbled sizeof(acells)) != sizeof(acells)) 455 1.32 macallan acells = 3; 456 1.2 garbled if (OF_getprop(node, "#size-cells", &scells, 457 1.2 garbled sizeof(scells)) != sizeof(scells)) 458 1.32 macallan scells = 2; 459 1.11 garbled #ifdef ofppc 460 1.11 garbled if (modeldata.ranges_offset == 0) 461 1.11 garbled scells -= 1; 462 1.11 garbled #endif 463 1.2 garbled if (type == RANGE_TYPE_ISA) 464 1.2 garbled reclen = 6; 465 1.2 garbled else 466 1.32 macallan reclen = parent_acells + acells + scells; 467 1.3 garbled /* 468 1.3 garbled * There exist ISA buses with empty ranges properties. This is 469 1.3 garbled * known to occur on the Pegasos II machine, and likely others. 470 1.3 garbled * According to them, that means that the isa bus is a fake bus, and 471 1.62 msaitoh * the real maps are the PCI maps of the preceding bus. To deal 472 1.3 garbled * with this, we will set cur to -1 and return. 473 1.3 garbled */ 474 1.3 garbled if (type == RANGE_TYPE_ISA && strcmp("isa", tmp) == 0 && len == 0) { 475 1.3 garbled *cur = -1; 476 1.3 garbled DPRINTF("Found empty range in isa bus\n"); 477 1.3 garbled return; 478 1.3 garbled } 479 1.3 garbled 480 1.3 garbled DPRINTF("found a map reclen=%d cur=%d len=%d\n", reclen, *cur, len); 481 1.2 garbled switch (type) { 482 1.2 garbled case RANGE_TYPE_PCI: 483 1.2 garbled case RANGE_TYPE_FIRSTPCI: 484 1.2 garbled for (i=0; i < len/(4*reclen); i++) { 485 1.3 garbled DPRINTF("FOUND PCI RANGE\n"); 486 1.8 garbled regions[*cur].size = 487 1.32 macallan map[i*reclen + parent_acells + acells + scells - 1]; 488 1.8 garbled /* skip ranges of size==0 */ 489 1.8 garbled if (regions[*cur].size == 0) 490 1.8 garbled continue; 491 1.32 macallan regions[*cur].type = (map[i*reclen] >> 24) & 0x3; 492 1.32 macallan regions[*cur].addr = map[i*reclen + parent_acells + acells - 1]; 493 1.2 garbled (*cur)++; 494 1.2 garbled } 495 1.2 garbled break; 496 1.2 garbled case RANGE_TYPE_ISA: 497 1.2 garbled for (i=0; i < len/(4*reclen); i++) { 498 1.2 garbled if (map[i*reclen] == 1) 499 1.2 garbled regions[*cur].type = RANGE_IO; 500 1.2 garbled else 501 1.2 garbled regions[*cur].type = RANGE_MEM; 502 1.3 garbled DPRINTF("FOUND ISA RANGE TYPE=%d\n", 503 1.3 garbled regions[*cur].type); 504 1.2 garbled regions[*cur].size = 505 1.2 garbled map[i*reclen + acells + scells]; 506 1.2 garbled (*cur)++; 507 1.2 garbled } 508 1.2 garbled break; 509 1.40 macallan case RANGE_TYPE_MACIO: 510 1.40 macallan regions[*cur].type = RANGE_MEM; 511 1.41 macallan if (len == 8) { 512 1.41 macallan regions[*cur].size = map[1]; 513 1.41 macallan regions[*cur].addr = map[0]; 514 1.41 macallan } else { 515 1.41 macallan regions[*cur].size = map[2]; 516 1.41 macallan regions[*cur].addr = map[1]; 517 1.41 macallan } 518 1.40 macallan (*cur)++; 519 1.40 macallan break; 520 1.2 garbled } 521 1.3 garbled DPRINTF("returning with CUR=%d\n", *cur); 522 1.2 garbled return; 523 1.2 garbled rec: 524 1.3 garbled for (node = OF_child(base); node; node = OF_peer(node)) { 525 1.3 garbled DPRINTF("RECURSE 1 STEP\n"); 526 1.2 garbled find_ranges(node, regions, cur, type); 527 1.3 garbled if (*cur == -1) 528 1.3 garbled return; 529 1.3 garbled } 530 1.2 garbled } 531 1.2 garbled 532 1.2 garbled static int 533 1.2 garbled find_lowest_range(rangemap_t *ranges, int nrof, int type) 534 1.2 garbled { 535 1.2 garbled int i, low = 0; 536 1.2 garbled u_int32_t addr = 0xffffffff; 537 1.2 garbled 538 1.2 garbled for (i=0; i < nrof; i++) { 539 1.2 garbled if (ranges[i].type == type && ranges[i].addr != 0 && 540 1.2 garbled ranges[i].addr < addr) { 541 1.2 garbled low = i; 542 1.2 garbled addr = ranges[i].addr; 543 1.2 garbled } 544 1.2 garbled } 545 1.2 garbled if (addr == 0xffffffff) 546 1.2 garbled return -1; 547 1.2 garbled return low; 548 1.2 garbled } 549 1.2 garbled 550 1.2 garbled /* 551 1.2 garbled * Find a region of memory, and create a bus_space_tag for it. 552 1.2 garbled * Notes: 553 1.2 garbled * For ISA node is ignored. 554 1.2 garbled * node is the starting node. if -1, we start at / and map everything. 555 1.2 garbled */ 556 1.2 garbled 557 1.2 garbled int 558 1.2 garbled ofwoea_map_space(int rangetype, int iomem, int node, 559 1.2 garbled struct powerpc_bus_space *tag, const char *name) 560 1.2 garbled { 561 1.2 garbled int i, cur, range, nrofholes, error; 562 1.2 garbled static int exmap=0; 563 1.2 garbled rangemap_t region, holes[32], list[32]; 564 1.2 garbled 565 1.2 garbled memset(list, 0, sizeof(list)); 566 1.32 macallan memset(®ion, 0, sizeof(region)); 567 1.2 garbled cur = 0; 568 1.2 garbled if (rangetype == RANGE_TYPE_ISA || node == -1) 569 1.2 garbled node = OF_finddevice("/"); 570 1.2 garbled if (rangetype == RANGE_TYPE_ISA) { 571 1.2 garbled u_int32_t size = 0; 572 1.2 garbled rangemap_t regions[32]; 573 1.2 garbled 574 1.3 garbled DPRINTF("LOOKING FOR FIRSTPCI\n"); 575 1.2 garbled find_ranges(node, list, &cur, RANGE_TYPE_FIRSTPCI); 576 1.2 garbled range = 0; 577 1.3 garbled DPRINTF("LOOKING FOR ISA\n"); 578 1.2 garbled find_ranges(node, regions, &range, RANGE_TYPE_ISA); 579 1.2 garbled if (range == 0 || cur == 0) 580 1.2 garbled return -1; /* no isa stuff found */ 581 1.3 garbled /* 582 1.3 garbled * This may be confusing to some. The ISA ranges property 583 1.3 garbled * is supposed to be a set of IO ranges for the ISA bus, but 584 1.3 garbled * generally, it's just a set of pci devfunc lists that tell 585 1.3 garbled * you to go look at the parent PCI device for the actual 586 1.3 garbled * ranges. 587 1.3 garbled */ 588 1.3 garbled if (range == -1) { 589 1.3 garbled /* we found a rangeless isa bus */ 590 1.20 kiyohara if (iomem == RANGE_IO) 591 1.20 kiyohara size = 0x10000; 592 1.20 kiyohara else 593 1.20 kiyohara size = 0x1000000; 594 1.3 garbled } 595 1.3 garbled DPRINTF("found isa stuff\n"); 596 1.2 garbled for (i=0; i < range; i++) 597 1.2 garbled if (regions[i].type == iomem) 598 1.2 garbled size = regions[i].size; 599 1.2 garbled if (iomem == RANGE_IO) { 600 1.2 garbled /* the first io range is the one */ 601 1.2 garbled for (i=0; i < cur; i++) 602 1.2 garbled if (list[i].type == RANGE_IO && size) { 603 1.3 garbled DPRINTF("found IO\n"); 604 1.2 garbled tag->pbs_offset = list[i].addr; 605 1.2 garbled tag->pbs_limit = size; 606 1.20 kiyohara error = bus_space_init(tag, name, 607 1.20 kiyohara ex_storage[exmap], 608 1.20 kiyohara sizeof(ex_storage[exmap])); 609 1.20 kiyohara exmap++; 610 1.2 garbled return error; 611 1.2 garbled } 612 1.2 garbled } else { 613 1.2 garbled for (i=0; i < cur; i++) 614 1.2 garbled if (list[i].type == RANGE_MEM && 615 1.2 garbled list[i].size == size) { 616 1.3 garbled DPRINTF("found mem\n"); 617 1.2 garbled tag->pbs_offset = list[i].addr; 618 1.2 garbled tag->pbs_limit = size; 619 1.20 kiyohara error = bus_space_init(tag, name, 620 1.20 kiyohara ex_storage[exmap], 621 1.20 kiyohara sizeof(ex_storage[exmap])); 622 1.20 kiyohara exmap++; 623 1.2 garbled return error; 624 1.2 garbled } 625 1.2 garbled } 626 1.2 garbled return -1; /* NO ISA FOUND */ 627 1.2 garbled } 628 1.2 garbled find_ranges(node, list, &cur, rangetype); 629 1.2 garbled 630 1.2 garbled DPRINTF("cur == %d\n", cur); 631 1.2 garbled /* now list should contain a list of memory regions */ 632 1.2 garbled for (i=0; i < cur; i++) 633 1.2 garbled DPRINTF("addr=0x%x size=0x%x type=%d\n", list[i].addr, 634 1.2 garbled list[i].size, list[i].type); 635 1.2 garbled 636 1.2 garbled range = find_lowest_range(list, cur, iomem); 637 1.2 garbled i = 0; 638 1.2 garbled nrofholes = 0; 639 1.2 garbled while (range != -1) { 640 1.2 garbled DPRINTF("range==%d\n", range); 641 1.2 garbled DPRINTF("i==%d\n", i); 642 1.2 garbled if (i == 0) { 643 1.2 garbled memcpy(®ion, &list[range], sizeof(rangemap_t)); 644 1.2 garbled list[range].addr = 0; 645 1.2 garbled i++; 646 1.2 garbled range = find_lowest_range(list, cur, iomem); 647 1.2 garbled continue; 648 1.2 garbled } 649 1.2 garbled if (region.addr + region.size < list[range].addr) { 650 1.2 garbled /* allocate a hole */ 651 1.11 garbled holes[nrofholes].type = iomem; 652 1.2 garbled holes[nrofholes].addr = region.size + region.addr; 653 1.2 garbled holes[nrofholes].size = list[range].addr - 654 1.2 garbled holes[nrofholes].addr - 1; 655 1.2 garbled nrofholes++; 656 1.2 garbled } 657 1.2 garbled region.size = list[range].size + list[range].addr - 658 1.2 garbled region.addr; 659 1.2 garbled list[range].addr = 0; 660 1.2 garbled range = find_lowest_range(list, cur, iomem); 661 1.2 garbled } 662 1.2 garbled DPRINTF("RANGE iomem=%d FOUND\n", iomem); 663 1.2 garbled DPRINTF("addr=0x%x size=0x%x type=%d\n", region.addr, 664 1.2 garbled region.size, region.type); 665 1.2 garbled DPRINTF("HOLES FOUND\n"); 666 1.2 garbled for (i=0; i < nrofholes; i++) 667 1.2 garbled DPRINTF("addr=0x%x size=0x%x type=%d\n", holes[i].addr, 668 1.2 garbled holes[i].size, holes[i].type); 669 1.2 garbled /* AT THIS POINT WE MAP IT */ 670 1.2 garbled 671 1.40 macallan if ((rangetype == RANGE_TYPE_PCI) || (rangetype == RANGE_TYPE_MACIO)) { 672 1.2 garbled if (exmap == EXSTORAGE_MAX) 673 1.2 garbled panic("Not enough ex_storage space. " 674 1.2 garbled "Increase EXSTORAGE_MAX"); 675 1.2 garbled 676 1.2 garbled /* XXX doing this in here might be wrong */ 677 1.2 garbled if (iomem == 1) { 678 1.2 garbled /* we map an IO region */ 679 1.2 garbled tag->pbs_offset = region.addr; 680 1.2 garbled tag->pbs_base = 0; 681 1.2 garbled tag->pbs_limit = region.size; 682 1.2 garbled } else { 683 1.2 garbled /* ... or a memory region */ 684 1.2 garbled tag->pbs_offset = 0; 685 1.2 garbled tag->pbs_base = region.addr; 686 1.2 garbled tag->pbs_limit = region.size + region.addr; 687 1.19 kiyohara } 688 1.2 garbled 689 1.2 garbled error = bus_space_init(tag, name, ex_storage[exmap], 690 1.2 garbled sizeof(ex_storage[exmap])); 691 1.2 garbled exmap++; 692 1.2 garbled if (error) 693 1.2 garbled panic("ofwoea_bus_space_init: can't init tag %s", name); 694 1.2 garbled for (i=0; i < nrofholes; i++) { 695 1.11 garbled if (holes[i].type == RANGE_IO) { 696 1.11 garbled error = extent_alloc_region(tag->pbs_extent, 697 1.11 garbled holes[i].addr - tag->pbs_offset, 698 1.11 garbled holes[i].size, EX_NOWAIT); 699 1.11 garbled } else { 700 1.11 garbled error = extent_alloc_region(tag->pbs_extent, 701 1.11 garbled holes[i].addr, holes[i].size, EX_NOWAIT); 702 1.11 garbled } 703 1.2 garbled if (error) 704 1.2 garbled panic("ofwoea_bus_space_init: can't block out" 705 1.2 garbled " reserved space 0x%x-0x%x: error=%d", 706 1.2 garbled holes[i].addr, holes[i].addr+holes[i].size, 707 1.2 garbled error); 708 1.2 garbled } 709 1.2 garbled return error; 710 1.2 garbled } 711 1.2 garbled return -1; 712 1.2 garbled } 713 1.2 garbled 714 1.2 garbled void 715 1.2 garbled ofwoea_bus_space_init(void) 716 1.2 garbled { 717 1.2 garbled int error; 718 1.2 garbled 719 1.2 garbled error = ofwoea_map_space(RANGE_TYPE_ISA, RANGE_IO, -1, 720 1.2 garbled &genppc_isa_io_space_tag, "isa-ioport"); 721 1.2 garbled if (error > 0) 722 1.2 garbled panic("Could not map ISA IO"); 723 1.3 garbled 724 1.2 garbled error = ofwoea_map_space(RANGE_TYPE_ISA, RANGE_MEM, -1, 725 1.2 garbled &genppc_isa_mem_space_tag, "isa-iomem"); 726 1.2 garbled if (error > 0) 727 1.2 garbled panic("Could not map ISA MEM"); 728 1.2 garbled } 729