Home | History | Annotate | Line # | Download | only in oea
ofwoea_machdep.c revision 1.32
      1  1.32  macallan /* $NetBSD: ofwoea_machdep.c,v 1.32 2013/04/11 17:13:15 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.32  macallan __KERNEL_RCSID(0, "$NetBSD: ofwoea_machdep.c,v 1.32 2013/04/11 17:13:15 macallan Exp $");
     34   1.2   garbled 
     35  1.10   garbled #include "opt_ppcarch.h"
     36   1.2   garbled #include "opt_compat_netbsd.h"
     37  1.19  kiyohara #include "opt_ddb.h"
     38   1.2   garbled #include "opt_kgdb.h"
     39   1.2   garbled #include "opt_ipkdb.h"
     40  1.17       apb #include "opt_modular.h"
     41   1.2   garbled 
     42  1.32  macallan #include "wsdisplay.h"
     43  1.32  macallan 
     44   1.2   garbled #include <sys/param.h>
     45   1.2   garbled #include <sys/buf.h>
     46   1.2   garbled #include <sys/boot_flag.h>
     47   1.2   garbled #include <sys/extent.h>
     48   1.2   garbled #include <sys/kernel.h>
     49   1.2   garbled #include <sys/ksyms.h>
     50   1.2   garbled #include <uvm/uvm_extern.h>
     51   1.2   garbled 
     52   1.2   garbled #include <dev/ofw/openfirm.h>
     53  1.32  macallan #include <dev/wscons/wsconsio.h>
     54  1.32  macallan #include <dev/wscons/wsdisplayvar.h>
     55  1.32  macallan #include <dev/rasops/rasops.h>
     56  1.32  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     57   1.2   garbled #include <machine/pmap.h>
     58   1.2   garbled #include <machine/powerpc.h>
     59   1.2   garbled #include <machine/trap.h>
     60   1.5   garbled #include <machine/vmparam.h>
     61   1.6   garbled #include <machine/autoconf.h>
     62  1.24    dyoung #include <sys/bus.h>
     63   1.2   garbled #include <powerpc/oea/bat.h>
     64  1.32  macallan #include <powerpc/oea/ofw_rasconsvar.h>
     65  1.10   garbled #include <powerpc/oea/cpufeat.h>
     66   1.2   garbled #include <powerpc/ofw_cons.h>
     67   1.2   garbled #include <powerpc/spr.h>
     68  1.22      matt #include <powerpc/pic/picvar.h>
     69   1.2   garbled 
     70   1.2   garbled #include "opt_oea.h"
     71   1.2   garbled 
     72   1.2   garbled #include "ksyms.h"
     73   1.2   garbled 
     74   1.2   garbled #ifdef DDB
     75   1.2   garbled #include <machine/db_machdep.h>
     76   1.2   garbled #include <ddb/db_extern.h>
     77   1.2   garbled #endif
     78   1.2   garbled 
     79   1.2   garbled #ifdef KGDB
     80   1.2   garbled #include <sys/kgdb.h>
     81   1.2   garbled #endif
     82   1.2   garbled 
     83   1.2   garbled #ifdef IPKDB
     84   1.2   garbled #include <ipkdb/ipkdb.h>
     85   1.2   garbled #endif
     86   1.2   garbled 
     87   1.2   garbled #include "opt_ofwoea.h"
     88   1.2   garbled 
     89  1.11   garbled #ifdef ofppc
     90  1.11   garbled extern struct model_data modeldata;
     91  1.11   garbled #endif
     92  1.11   garbled 
     93   1.2   garbled #ifdef OFWOEA_DEBUG
     94   1.2   garbled #define DPRINTF printf
     95   1.2   garbled #else
     96   1.3   garbled #define DPRINTF while (0) printf
     97   1.2   garbled #endif
     98   1.2   garbled 
     99   1.2   garbled typedef struct _rangemap {
    100   1.2   garbled 	u_int32_t addr;
    101   1.2   garbled 	u_int32_t size;
    102   1.2   garbled 	int type;
    103   1.2   garbled } rangemap_t;
    104   1.2   garbled 
    105   1.2   garbled struct ofw_translations {
    106   1.2   garbled 	vaddr_t va;
    107   1.2   garbled 	int len;
    108   1.2   garbled #if defined (PMAC_G5)
    109   1.2   garbled 	register64_t pa;
    110   1.2   garbled #else
    111   1.2   garbled 	register_t pa;
    112   1.2   garbled #endif
    113   1.2   garbled 	int mode;
    114   1.2   garbled }__attribute__((packed));
    115   1.2   garbled 
    116   1.2   garbled struct pmap ofw_pmap;
    117   1.2   garbled struct ofw_translations ofmap[32];
    118   1.2   garbled char bootpath[256];
    119   1.6   garbled char model_name[64];
    120  1.15        ad #if NKSYMS || defined(DDB) || defined(MODULAR)
    121   1.2   garbled void *startsym, *endsym;
    122   1.2   garbled #endif
    123   1.2   garbled #ifdef TIMEBASE_FREQ
    124   1.2   garbled u_int timebase_freq = TIMEBASE_FREQ;
    125   1.2   garbled #else
    126   1.2   garbled u_int timebase_freq = 0;
    127   1.2   garbled #endif
    128   1.2   garbled 
    129  1.25  macallan extern int ofwmsr;
    130   1.2   garbled extern int chosen;
    131   1.2   garbled extern uint32_t ticks_per_sec;
    132   1.2   garbled extern uint32_t ns_per_tick;
    133   1.2   garbled extern uint32_t ticks_per_intr;
    134   1.2   garbled 
    135   1.2   garbled static int save_ofmap(struct ofw_translations *, int);
    136   1.2   garbled static void restore_ofmap(struct ofw_translations *, int);
    137   1.2   garbled static void set_timebase(void);
    138   1.2   garbled 
    139  1.13   garbled extern void cpu_spinstart(u_int);
    140  1.31  kiyohara extern volatile u_int cpu_spinstart_ack;
    141  1.13   garbled 
    142   1.2   garbled void
    143   1.2   garbled ofwoea_initppc(u_int startkernel, u_int endkernel, char *args)
    144   1.2   garbled {
    145  1.11   garbled 	int ofmaplen, node, l;
    146   1.2   garbled 	register_t scratch;
    147   1.2   garbled 
    148  1.13   garbled #if defined(MULTIPROCESSOR) && defined(ofppc)
    149  1.13   garbled 	char cpupath[32];
    150  1.13   garbled 	int i;
    151  1.13   garbled #endif
    152  1.13   garbled 
    153   1.2   garbled 	/* initialze bats */
    154  1.10   garbled 	if ((oeacpufeat & OEACPU_NOBAT) == 0)
    155  1.10   garbled 		ofwoea_batinit();
    156   1.2   garbled 
    157  1.15        ad #if NKSYMS || defined(DDB) || defined(MODULAR)
    158   1.2   garbled 	/* get info of kernel symbol table from bootloader */
    159   1.2   garbled 	memcpy(&startsym, args + strlen(args) + 1, sizeof(startsym));
    160   1.2   garbled 	memcpy(&endsym, args + strlen(args) + 1 + sizeof(startsym),
    161   1.2   garbled 	    sizeof(endsym));
    162   1.2   garbled 	if (startsym == NULL || endsym == NULL)
    163   1.2   garbled 	    startsym = endsym = NULL;
    164   1.2   garbled #endif
    165   1.2   garbled 
    166   1.6   garbled 	/* get model name and perform model-specific actions */
    167   1.6   garbled 	memset(model_name, 0, sizeof(model_name));
    168   1.6   garbled 	node = OF_finddevice("/");
    169  1.30      jmmv 	if (node != -1) {
    170  1.11   garbled 		l = OF_getprop(node, "model", model_name, sizeof(model_name));
    171  1.11   garbled 		if (l == -1)
    172  1.11   garbled 			OF_getprop(node, "name", model_name,
    173  1.11   garbled 			    sizeof(model_name));
    174   1.6   garbled 		model_init();
    175   1.6   garbled 	}
    176  1.27  macallan 
    177  1.20  kiyohara 	/* Initialize bus_space */
    178  1.20  kiyohara 	ofwoea_bus_space_init();
    179   1.6   garbled 
    180   1.2   garbled 	ofwoea_consinit();
    181   1.2   garbled 
    182  1.13   garbled #if defined(MULTIPROCESSOR) && defined(ofppc)
    183  1.13   garbled 	for (i=1; i < CPU_MAXNUM; i++) {
    184  1.13   garbled 		sprintf(cpupath, "/cpus/@%x", i);
    185  1.13   garbled 		node = OF_finddevice(cpupath);
    186  1.13   garbled 		if (node <= 0)
    187  1.13   garbled 			continue;
    188  1.13   garbled 		aprint_verbose("Starting up CPU %d %s\n", i, cpupath);
    189  1.13   garbled 		OF_start_cpu(node, (u_int)cpu_spinstart, i);
    190  1.13   garbled 		for (l=0; l < 100000000; l++) {
    191  1.13   garbled 			if (cpu_spinstart_ack == i) {
    192  1.13   garbled 				aprint_verbose("CPU %d spun up.\n", i);
    193  1.13   garbled 				break;
    194  1.13   garbled 			}
    195  1.13   garbled 			__asm volatile ("sync");
    196  1.13   garbled 		}
    197  1.13   garbled 	}
    198  1.13   garbled #endif
    199  1.13   garbled 
    200  1.23      matt #if defined (PPC_OEA64_BRIDGE) && defined (PPC_OEA)
    201  1.23      matt 	if (oeacpufeat & OEACPU_64_BRIDGE)
    202  1.23      matt 		pmap_setup64bridge();
    203  1.23      matt 	else
    204  1.23      matt 		pmap_setup32();
    205  1.23      matt #endif
    206  1.23      matt 
    207   1.2   garbled 	oea_init(pic_ext_intr);
    208   1.2   garbled 
    209   1.2   garbled 	ofmaplen = save_ofmap(NULL, 0);
    210   1.2   garbled 	if (ofmaplen > 0)
    211   1.2   garbled 		save_ofmap(ofmap, ofmaplen);
    212   1.2   garbled 
    213  1.25  macallan /*
    214  1.25  macallan  * XXX
    215  1.25  macallan  * we need to do this here instead of earlier on in ofwinit() for some reason
    216  1.25  macallan  * At least some versions of Apple OF 2.0.1 hang if we do this earlier
    217  1.25  macallan  */
    218  1.25  macallan 	ofwmsr &= ~PSL_IP;
    219  1.25  macallan 
    220   1.2   garbled 	/* Parse the args string */
    221   1.2   garbled 	if (args) {
    222   1.2   garbled 		strcpy(bootpath, args);
    223   1.2   garbled 		args = bootpath;
    224   1.2   garbled 		while (*++args && *args != ' ');
    225   1.2   garbled 		if (*args) {
    226   1.2   garbled 			*args++ = 0;
    227   1.2   garbled 			while (*args)
    228   1.2   garbled 				BOOT_FLAG(*args++, boothowto);
    229   1.2   garbled 		}
    230   1.2   garbled 	}
    231   1.2   garbled 
    232   1.2   garbled 	uvm_setpagesize();
    233  1.10   garbled 
    234   1.2   garbled 	pmap_bootstrap(startkernel, endkernel);
    235   1.2   garbled 
    236  1.13   garbled /* as far as I can tell, the pmap_setup_seg0 stuff is horribly broken */
    237   1.2   garbled #if defined(PPC_OEA64) || defined (PPC_OEA64_BRIDGE)
    238   1.2   garbled #if defined (PMAC_G5)
    239   1.2   garbled 	/* Mapin 1st 256MB segment 1:1, also map in mem needed to access OFW*/
    240  1.32  macallan 	if (oeacpufeat & OEACPU_64_BRIDGE) {
    241  1.32  macallan 		vaddr_t va;
    242  1.32  macallan 		paddr_t pa;
    243  1.32  macallan 		int i;
    244  1.32  macallan 
    245  1.32  macallan 		pmap_setup_segment0_map(0, 0x0);
    246  1.32  macallan 
    247  1.32  macallan 		/* Map OFW code+data */
    248  1.32  macallan 
    249  1.32  macallan 		for (i = 0; i < ofmaplen / sizeof(struct ofw_translations); i++) {
    250  1.32  macallan 			if (ofmap[i].va < 0xff800000)
    251  1.32  macallan 				continue;
    252  1.32  macallan 
    253  1.32  macallan 			for (va = ofmap[i].va, pa = ofmap[i].pa;
    254  1.32  macallan 			    va < ofmap[i].va + ofmap[i].len;
    255  1.32  macallan 			    va += PAGE_SIZE, pa += PAGE_SIZE) {
    256  1.32  macallan 				pmap_enter(pmap_kernel(), va, pa, VM_PROT_ALL,
    257  1.32  macallan 				    VM_PROT_ALL | PMAP_WIRED);
    258  1.32  macallan 			}
    259  1.32  macallan 		}
    260  1.32  macallan 
    261  1.32  macallan #if NWSDISPLAY > 0
    262  1.32  macallan 		/* Map video frame buffer */
    263  1.32  macallan 
    264  1.32  macallan 		struct rasops_info *ri = &rascons_console_screen.scr_ri;
    265  1.32  macallan 
    266  1.32  macallan 		if (ri->ri_bits != NULL) {
    267  1.32  macallan 			for (va = (vaddr_t) ri->ri_bits;
    268  1.32  macallan 			    va < round_page((vaddr_t) ri->ri_bits +
    269  1.32  macallan 				ri->ri_height * ri->ri_stride);
    270  1.32  macallan 			    va += PAGE_SIZE) {
    271  1.32  macallan 				pmap_enter(pmap_kernel(), va, va,
    272  1.32  macallan 				    VM_PROT_READ | VM_PROT_WRITE,
    273  1.32  macallan 				    PMAP_NOCACHE | PMAP_WIRED);
    274  1.32  macallan 			}
    275  1.32  macallan 		}
    276  1.32  macallan #endif
    277  1.32  macallan 	}
    278   1.2   garbled #elif defined (MAMBO)
    279   1.2   garbled 	/* Mapin 1st 256MB segment 1:1, also map in mem needed to access OFW*/
    280  1.10   garbled 	if (oeacpufeat & OEACPU_64_BRIDGE)
    281  1.10   garbled 		pmap_setup_segment0_map(0, 0xf4000000, 0xf4000000, 0x1000, 0x0);
    282   1.2   garbled #endif /* PMAC_G5 */
    283  1.10   garbled #endif /* PPC_OEA64 || PPC_OEA64_BRIDGE */
    284   1.2   garbled 
    285   1.2   garbled 	/* Now enable translation (and machine checks/recoverable interrupts) */
    286   1.2   garbled 	__asm __volatile ("sync; mfmsr %0; ori %0,%0,%1; mtmsr %0; isync"
    287   1.2   garbled 	    : "=r"(scratch)
    288   1.2   garbled 	    : "K"(PSL_IR|PSL_DR|PSL_ME|PSL_RI));
    289   1.2   garbled 
    290   1.2   garbled 	restore_ofmap(ofmap, ofmaplen);
    291   1.2   garbled 
    292  1.15        ad #if NKSYMS || defined(DDB) || defined(MODULAR)
    293  1.16    martin 	ksyms_addsyms_elf((int)((u_int)endsym - (u_int)startsym), startsym, endsym);
    294   1.2   garbled #endif
    295   1.2   garbled 
    296   1.2   garbled 	/* CPU clock stuff */
    297   1.2   garbled 	set_timebase();
    298  1.26       phx 
    299  1.26       phx #ifdef DDB
    300  1.26       phx 	if (boothowto & RB_KDB)
    301  1.26       phx 		Debugger();
    302  1.26       phx #endif
    303   1.2   garbled }
    304   1.2   garbled 
    305   1.2   garbled void
    306   1.2   garbled set_timebase(void)
    307   1.2   garbled {
    308   1.2   garbled 	int qhandle, phandle, msr, scratch;
    309   1.2   garbled 	char type[32];
    310   1.2   garbled 
    311   1.2   garbled 	if (timebase_freq != 0) {
    312   1.2   garbled 		ticks_per_sec = timebase_freq;
    313   1.2   garbled 		goto found;
    314   1.2   garbled 	}
    315   1.2   garbled 
    316   1.2   garbled 	for (qhandle = OF_peer(0); qhandle; qhandle = phandle) {
    317   1.2   garbled 		if (OF_getprop(qhandle, "device_type", type, sizeof type) > 0
    318   1.2   garbled 		    && strcmp(type, "cpu") == 0
    319   1.2   garbled 		    && OF_getprop(qhandle, "timebase-frequency",
    320   1.2   garbled 			&ticks_per_sec, sizeof ticks_per_sec) > 0) {
    321   1.2   garbled 			goto found;
    322   1.2   garbled 		}
    323   1.2   garbled 		if ((phandle = OF_child(qhandle)))
    324   1.2   garbled 			continue;
    325   1.2   garbled 		while (qhandle) {
    326   1.2   garbled 			if ((phandle = OF_peer(qhandle)))
    327   1.2   garbled 				break;
    328   1.2   garbled 			qhandle = OF_parent(qhandle);
    329   1.2   garbled 		}
    330   1.2   garbled 	}
    331   1.2   garbled 	panic("no cpu node");
    332   1.2   garbled 
    333   1.2   garbled found:
    334   1.2   garbled 	__asm volatile ("mfmsr %0; andi. %1,%0,%2; mtmsr %1"
    335   1.2   garbled 		: "=r"(msr), "=r"(scratch) : "K"((u_short)~PSL_EE));
    336   1.2   garbled 	ns_per_tick = 1000000000 / ticks_per_sec;
    337   1.2   garbled 	ticks_per_intr = ticks_per_sec / hz;
    338   1.2   garbled 	cpu_timebase = ticks_per_sec;
    339   1.2   garbled 	curcpu()->ci_lasttb = mftbl();
    340   1.2   garbled 	mtspr(SPR_DEC, ticks_per_intr);
    341   1.2   garbled 	mtmsr(msr);
    342   1.2   garbled }
    343   1.2   garbled 
    344   1.2   garbled static int
    345   1.2   garbled save_ofmap(struct ofw_translations *map, int maxlen)
    346   1.2   garbled {
    347   1.2   garbled 	int mmui, mmu, len;
    348   1.2   garbled 
    349   1.2   garbled 	OF_getprop(chosen, "mmu", &mmui, sizeof mmui);
    350   1.2   garbled 	mmu = OF_instance_to_package(mmui);
    351   1.2   garbled 
    352   1.2   garbled 	if (map) {
    353   1.2   garbled 		memset(map, 0, maxlen); /* to be safe */
    354   1.2   garbled 		len = OF_getprop(mmu, "translations", map, maxlen);
    355   1.2   garbled 	} else
    356   1.2   garbled 		len = OF_getproplen(mmu, "translations");
    357   1.2   garbled 
    358   1.2   garbled 	if (len < 0)
    359   1.2   garbled 		len = 0;
    360   1.2   garbled 	return len;
    361   1.2   garbled }
    362   1.2   garbled 
    363  1.13   garbled 
    364  1.13   garbled /* The PMAC_G5 code here needs to be replaced by code that looks for the
    365  1.13   garbled    size_cells and does the right thing automatically.
    366  1.13   garbled */
    367   1.2   garbled void
    368   1.2   garbled restore_ofmap(struct ofw_translations *map, int len)
    369   1.2   garbled {
    370   1.2   garbled 	int n = len / sizeof(struct ofw_translations);
    371   1.2   garbled 	int i;
    372   1.2   garbled 
    373   1.2   garbled 	pmap_pinit(&ofw_pmap);
    374   1.2   garbled 
    375  1.32  macallan 	ofw_pmap.pm_sr[0] = KERNELN_SEGMENT(0)|SR_PRKEY;
    376  1.32  macallan 	ofw_pmap.pm_sr[KERNEL_SR] = KERNEL_SEGMENT|SR_SUKEY|SR_PRKEY;
    377   1.2   garbled 
    378   1.2   garbled #ifdef KERNEL2_SR
    379  1.32  macallan 	ofw_pmap.pm_sr[KERNEL2_SR] = KERNEL2_SEGMENT|SR_SUKEY|SR_PRKEY;
    380   1.2   garbled #endif
    381   1.2   garbled 
    382   1.2   garbled 	for (i = 0; i < n; i++) {
    383   1.2   garbled #if defined (PMAC_G5)
    384   1.2   garbled 		register64_t pa = map[i].pa;
    385   1.2   garbled #else
    386   1.2   garbled 		register_t pa = map[i].pa;
    387   1.2   garbled #endif
    388   1.2   garbled 		vaddr_t va = map[i].va;
    389   1.2   garbled 		size_t length = map[i].len;
    390   1.2   garbled 
    391   1.2   garbled 		if (va < 0xf0000000) /* XXX */
    392   1.2   garbled 			continue;
    393   1.2   garbled 
    394   1.2   garbled 		while (length > 0) {
    395   1.2   garbled 			pmap_enter(&ofw_pmap, va, (paddr_t)pa, VM_PROT_ALL,
    396   1.2   garbled 			    VM_PROT_ALL|PMAP_WIRED);
    397   1.2   garbled 			pa += PAGE_SIZE;
    398   1.2   garbled 			va += PAGE_SIZE;
    399   1.2   garbled 			length -= PAGE_SIZE;
    400   1.2   garbled 		}
    401   1.2   garbled 	}
    402   1.2   garbled 	pmap_update(&ofw_pmap);
    403  1.19  kiyohara }
    404   1.2   garbled 
    405   1.2   garbled 
    406   1.2   garbled 
    407   1.2   garbled /*
    408  1.18       phx  * Scan the device tree for ranges, and return them as bitmap 0..15
    409   1.2   garbled  */
    410  1.27  macallan #ifndef macppc
    411   1.2   garbled static u_int16_t
    412   1.2   garbled ranges_bitmap(int node, u_int16_t bitmap)
    413   1.2   garbled {
    414   1.4   garbled 	int child, mlen, acells, scells, reclen, i, j;
    415   1.4   garbled 	u_int32_t addr, len, map[160];
    416   1.2   garbled 
    417   1.2   garbled 	for (child = OF_child(node); child; child = OF_peer(child)) {
    418   1.2   garbled 		mlen = OF_getprop(child, "ranges", map, sizeof(map));
    419   1.2   garbled 		if (mlen == -1)
    420   1.2   garbled 			goto noranges;
    421   1.4   garbled 
    422   1.4   garbled 		j = OF_getprop(child, "#address-cells", &acells,
    423   1.2   garbled 		    sizeof(acells));
    424   1.4   garbled 		if (j == -1)
    425   1.2   garbled 			goto noranges;
    426   1.4   garbled 
    427   1.4   garbled 		j = OF_getprop(child, "#size-cells", &scells,
    428   1.2   garbled 		    sizeof(scells));
    429   1.4   garbled 		if (j == -1)
    430   1.2   garbled 			goto noranges;
    431   1.2   garbled 
    432  1.18       phx #ifdef ofppc
    433  1.18       phx 		reclen = acells + modeldata.ranges_offset + scells;
    434  1.18       phx #else
    435   1.2   garbled 		reclen = acells + 1 + scells;
    436  1.18       phx #endif
    437   1.2   garbled 
    438   1.4   garbled 		for (i=0; i < (mlen/4)/reclen; i++) {
    439   1.4   garbled 			addr = map[reclen * i + acells];
    440   1.2   garbled 			len = map[reclen * i + reclen - 1];
    441   1.2   garbled 			for (j = 0; j < len / 0x10000000; j++)
    442   1.2   garbled 				bitmap |= 1 << ((addr+j*0x10000000) >>28);
    443   1.2   garbled 			bitmap |= 1 << (addr >> 28);
    444   1.2   garbled 		}
    445   1.2   garbled noranges:
    446   1.2   garbled 		bitmap |= ranges_bitmap(child, bitmap);
    447   1.2   garbled 		continue;
    448   1.2   garbled 	}
    449   1.2   garbled 	return bitmap;
    450   1.2   garbled }
    451  1.27  macallan #endif /* !macppc */
    452   1.2   garbled 
    453   1.2   garbled void
    454   1.2   garbled ofwoea_batinit(void)
    455   1.2   garbled {
    456  1.10   garbled #if defined (PPC_OEA)
    457  1.27  macallan 
    458  1.27  macallan #ifdef macppc
    459  1.27  macallan 	/*
    460  1.27  macallan 	 * cover PCI and register space but not the firmware ROM
    461  1.27  macallan 	 */
    462  1.28      matt 	oea_batinit(0x80000000, BAT_BL_1G,
    463  1.27  macallan 		    0xf0000000, BAT_BL_128M,
    464  1.27  macallan 		    0xf8000000, BAT_BL_64M,
    465  1.29  macallan 		    0xfe000000, BAT_BL_8M,	/* Grackle IO */
    466  1.27  macallan 		    0);
    467  1.27  macallan #else
    468  1.28      matt 	uint16_t bitmap;
    469   1.2   garbled 	int node, i;
    470   1.2   garbled 
    471   1.2   garbled 	node = OF_finddevice("/");
    472  1.27  macallan 
    473   1.2   garbled 	bitmap = ranges_bitmap(node, 0);
    474   1.2   garbled 	oea_batinit(0);
    475  1.19  kiyohara 
    476   1.5   garbled 	for (i=1; i < 0x10; i++) {
    477   1.5   garbled 		/* skip the three vital SR regions */
    478   1.5   garbled 		if (i == USER_SR || i == KERNEL_SR || i == KERNEL2_SR)
    479   1.5   garbled 			continue;
    480   1.4   garbled 		if (bitmap & (1 << i)) {
    481   1.2   garbled 			oea_iobat_add(0x10000000 * i, BAT_BL_256M);
    482   1.4   garbled 			DPRINTF("Batmapped 256M at 0x%x\n", 0x10000000 * i);
    483   1.4   garbled 		}
    484   1.5   garbled 	}
    485  1.27  macallan #endif
    486  1.10   garbled #endif /* OEA */
    487   1.2   garbled }
    488   1.2   garbled 
    489   1.2   garbled 
    490   1.2   garbled /* we define these partially, as we will fill the rest in later */
    491   1.2   garbled struct powerpc_bus_space genppc_isa_io_space_tag = {
    492   1.2   garbled 	.pbs_flags = _BUS_SPACE_LITTLE_ENDIAN|_BUS_SPACE_IO_TYPE,
    493   1.2   garbled 	.pbs_base = 0x00000000,
    494   1.2   garbled };
    495   1.2   garbled 
    496   1.2   garbled struct powerpc_bus_space genppc_isa_mem_space_tag = {
    497   1.2   garbled 	.pbs_flags = _BUS_SPACE_LITTLE_ENDIAN|_BUS_SPACE_MEM_TYPE,
    498   1.2   garbled 	.pbs_base = 0x00000000,
    499   1.2   garbled };
    500   1.2   garbled 
    501   1.2   garbled /* This gives us a maximum of 6 PCI busses, assuming both io/mem on each.
    502   1.2   garbled  * Increase if necc.
    503   1.2   garbled  */
    504   1.2   garbled static char ex_storage[EXSTORAGE_MAX][EXTENT_FIXED_STORAGE_SIZE(EXTMAP_RANGES)]
    505   1.2   garbled 	__attribute__((aligned(8)));
    506   1.2   garbled 
    507   1.2   garbled 
    508   1.2   garbled static void
    509   1.2   garbled find_ranges(int base, rangemap_t *regions, int *cur, int type)
    510   1.2   garbled {
    511   1.2   garbled 	int node, i, len, reclen;
    512  1.32  macallan 	u_int32_t parent_acells, acells, scells, map[160];
    513   1.2   garbled 	char tmp[32];
    514   1.2   garbled 
    515   1.2   garbled 	node = base;
    516   1.2   garbled 	if (OF_getprop(node, "device_type", tmp, sizeof(tmp)) == -1)
    517   1.2   garbled 		goto rec;
    518   1.2   garbled 	if ((type == RANGE_TYPE_PCI || type == RANGE_TYPE_FIRSTPCI) &&
    519   1.2   garbled 	    strcmp("pci", tmp) != 0)
    520   1.2   garbled 		goto rec;
    521   1.2   garbled 	if (type == RANGE_TYPE_ISA && strcmp("isa", tmp) != 0)
    522   1.2   garbled 		goto rec;
    523   1.2   garbled 	len = OF_getprop(node, "ranges", map, sizeof(map));
    524   1.2   garbled 	if (len == -1)
    525   1.2   garbled 		goto rec;
    526  1.32  macallan 	if (OF_getprop(OF_parent(node), "#address-cells", &parent_acells,
    527  1.32  macallan 	    sizeof(parent_acells)) != sizeof(parent_acells))
    528  1.32  macallan 		parent_acells = 1;
    529   1.2   garbled 	if (OF_getprop(node, "#address-cells", &acells,
    530   1.2   garbled 	    sizeof(acells)) != sizeof(acells))
    531  1.32  macallan 		acells = 3;
    532   1.2   garbled 	if (OF_getprop(node, "#size-cells", &scells,
    533   1.2   garbled 	    sizeof(scells)) != sizeof(scells))
    534  1.32  macallan 		scells = 2;
    535  1.11   garbled #ifdef ofppc
    536  1.11   garbled 	if (modeldata.ranges_offset == 0)
    537  1.11   garbled 		scells -= 1;
    538  1.11   garbled #endif
    539   1.2   garbled 	if (type == RANGE_TYPE_ISA)
    540   1.2   garbled 		reclen = 6;
    541   1.2   garbled 	else
    542  1.32  macallan 		reclen = parent_acells + acells + scells;
    543   1.3   garbled 	/*
    544   1.3   garbled 	 * There exist ISA buses with empty ranges properties.  This is
    545   1.3   garbled 	 * known to occur on the Pegasos II machine, and likely others.
    546   1.3   garbled 	 * According to them, that means that the isa bus is a fake bus, and
    547   1.3   garbled 	 * the real maps are the PCI maps of the preceeding bus.  To deal
    548   1.3   garbled 	 * with this, we will set cur to -1 and return.
    549   1.3   garbled 	 */
    550   1.3   garbled 	if (type == RANGE_TYPE_ISA && strcmp("isa", tmp) == 0 && len == 0) {
    551   1.3   garbled 		*cur = -1;
    552   1.3   garbled 		DPRINTF("Found empty range in isa bus\n");
    553   1.3   garbled 		return;
    554   1.3   garbled 	}
    555   1.3   garbled 
    556   1.3   garbled 	DPRINTF("found a map reclen=%d cur=%d len=%d\n", reclen, *cur, len);
    557   1.2   garbled 	switch (type) {
    558   1.2   garbled 		case RANGE_TYPE_PCI:
    559   1.2   garbled 		case RANGE_TYPE_FIRSTPCI:
    560   1.2   garbled 			for (i=0; i < len/(4*reclen); i++) {
    561   1.3   garbled 				DPRINTF("FOUND PCI RANGE\n");
    562   1.8   garbled 				regions[*cur].size =
    563  1.32  macallan 				    map[i*reclen + parent_acells + acells + scells - 1];
    564   1.8   garbled 				/* skip ranges of size==0 */
    565   1.8   garbled 				if (regions[*cur].size == 0)
    566   1.8   garbled 					continue;
    567  1.32  macallan 				regions[*cur].type = (map[i*reclen] >> 24) & 0x3;
    568  1.32  macallan 				regions[*cur].addr = map[i*reclen + parent_acells + acells - 1];
    569   1.2   garbled 				(*cur)++;
    570   1.2   garbled 			}
    571   1.2   garbled 			break;
    572   1.2   garbled 		case RANGE_TYPE_ISA:
    573   1.2   garbled 			for (i=0; i < len/(4*reclen); i++) {
    574   1.2   garbled 				if (map[i*reclen] == 1)
    575   1.2   garbled 					regions[*cur].type = RANGE_IO;
    576   1.2   garbled 				else
    577   1.2   garbled 					regions[*cur].type = RANGE_MEM;
    578   1.3   garbled 				DPRINTF("FOUND ISA RANGE TYPE=%d\n",
    579   1.3   garbled 					regions[*cur].type);
    580   1.2   garbled 				regions[*cur].size =
    581   1.2   garbled 				    map[i*reclen + acells + scells];
    582   1.2   garbled 				(*cur)++;
    583   1.2   garbled 			}
    584   1.2   garbled 			break;
    585   1.2   garbled 	}
    586   1.3   garbled 	DPRINTF("returning with CUR=%d\n", *cur);
    587   1.2   garbled 	return;
    588   1.2   garbled rec:
    589   1.3   garbled 	for (node = OF_child(base); node; node = OF_peer(node)) {
    590   1.3   garbled 		DPRINTF("RECURSE 1 STEP\n");
    591   1.2   garbled 		find_ranges(node, regions, cur, type);
    592   1.3   garbled 		if (*cur == -1)
    593   1.3   garbled 			return;
    594   1.3   garbled 	}
    595   1.2   garbled }
    596   1.2   garbled 
    597   1.2   garbled static int
    598   1.2   garbled find_lowest_range(rangemap_t *ranges, int nrof, int type)
    599   1.2   garbled {
    600   1.2   garbled 	int i, low = 0;
    601   1.2   garbled 	u_int32_t addr = 0xffffffff;
    602   1.2   garbled 
    603   1.2   garbled 	for (i=0; i < nrof; i++) {
    604   1.2   garbled 		if (ranges[i].type == type && ranges[i].addr != 0 &&
    605   1.2   garbled 		    ranges[i].addr < addr) {
    606   1.2   garbled 			low = i;
    607   1.2   garbled 			addr = ranges[i].addr;
    608   1.2   garbled 		}
    609   1.2   garbled 	}
    610   1.2   garbled 	if (addr == 0xffffffff)
    611   1.2   garbled 		return -1;
    612   1.2   garbled 	return low;
    613   1.2   garbled }
    614   1.2   garbled 
    615   1.2   garbled /*
    616   1.2   garbled  * Find a region of memory, and create a bus_space_tag for it.
    617   1.2   garbled  * Notes:
    618   1.2   garbled  * For ISA node is ignored.
    619   1.2   garbled  * node is the starting node.  if -1, we start at / and map everything.
    620   1.2   garbled  */
    621   1.2   garbled 
    622   1.2   garbled int
    623   1.2   garbled ofwoea_map_space(int rangetype, int iomem, int node,
    624   1.2   garbled     struct powerpc_bus_space *tag, const char *name)
    625   1.2   garbled {
    626   1.2   garbled 	int i, cur, range, nrofholes, error;
    627   1.2   garbled 	static int exmap=0;
    628   1.2   garbled 	u_int32_t addr;
    629   1.2   garbled 	rangemap_t region, holes[32], list[32];
    630   1.2   garbled 
    631   1.2   garbled 	memset(list, 0, sizeof(list));
    632  1.32  macallan 	memset(&region, 0, sizeof(region));
    633   1.2   garbled 	cur = 0;
    634   1.2   garbled 	if (rangetype == RANGE_TYPE_ISA || node == -1)
    635   1.2   garbled 		node = OF_finddevice("/");
    636   1.2   garbled 	if (rangetype == RANGE_TYPE_ISA) {
    637   1.2   garbled 		u_int32_t size = 0;
    638   1.2   garbled 		rangemap_t regions[32];
    639   1.2   garbled 
    640   1.3   garbled 		DPRINTF("LOOKING FOR FIRSTPCI\n");
    641   1.2   garbled 		find_ranges(node, list, &cur, RANGE_TYPE_FIRSTPCI);
    642   1.2   garbled 		range = 0;
    643   1.3   garbled 		DPRINTF("LOOKING FOR ISA\n");
    644   1.2   garbled 		find_ranges(node, regions, &range, RANGE_TYPE_ISA);
    645   1.2   garbled 		if (range == 0 || cur == 0)
    646   1.2   garbled 			return -1; /* no isa stuff found */
    647   1.3   garbled 		/*
    648   1.3   garbled 		 * This may be confusing to some.  The ISA ranges property
    649   1.3   garbled 		 * is supposed to be a set of IO ranges for the ISA bus, but
    650   1.3   garbled 		 * generally, it's just a set of pci devfunc lists that tell
    651   1.3   garbled 		 * you to go look at the parent PCI device for the actual
    652   1.3   garbled 		 * ranges.
    653   1.3   garbled 		 */
    654   1.3   garbled 		if (range == -1) {
    655   1.3   garbled 			/* we found a rangeless isa bus */
    656  1.20  kiyohara 			if (iomem == RANGE_IO)
    657  1.20  kiyohara 				size = 0x10000;
    658  1.20  kiyohara 			else
    659  1.20  kiyohara 				size = 0x1000000;
    660   1.3   garbled 		}
    661   1.3   garbled 		DPRINTF("found isa stuff\n");
    662   1.2   garbled 		for (i=0; i < range; i++)
    663   1.2   garbled 			if (regions[i].type == iomem)
    664   1.2   garbled 				size = regions[i].size;
    665   1.2   garbled 		if (iomem == RANGE_IO) {
    666   1.2   garbled 			/* the first io range is the one */
    667   1.2   garbled 			for (i=0; i < cur; i++)
    668   1.2   garbled 				if (list[i].type == RANGE_IO && size) {
    669   1.3   garbled 					DPRINTF("found IO\n");
    670   1.2   garbled 					tag->pbs_offset = list[i].addr;
    671   1.2   garbled 					tag->pbs_limit = size;
    672  1.20  kiyohara 					error = bus_space_init(tag, name,
    673  1.20  kiyohara 					    ex_storage[exmap],
    674  1.20  kiyohara 					    sizeof(ex_storage[exmap]));
    675  1.20  kiyohara 					exmap++;
    676   1.2   garbled 					return error;
    677   1.2   garbled 				}
    678   1.2   garbled 		} else {
    679   1.2   garbled 			for (i=0; i < cur; i++)
    680   1.2   garbled 				if (list[i].type == RANGE_MEM &&
    681   1.2   garbled 				    list[i].size == size) {
    682   1.3   garbled 					DPRINTF("found mem\n");
    683   1.2   garbled 					tag->pbs_offset = list[i].addr;
    684   1.2   garbled 					tag->pbs_limit = size;
    685  1.20  kiyohara 					error = bus_space_init(tag, name,
    686  1.20  kiyohara 					    ex_storage[exmap],
    687  1.20  kiyohara 					    sizeof(ex_storage[exmap]));
    688  1.20  kiyohara 					exmap++;
    689   1.2   garbled 					return error;
    690   1.2   garbled 				}
    691   1.2   garbled 		}
    692   1.2   garbled 		return -1; /* NO ISA FOUND */
    693   1.2   garbled 	}
    694   1.2   garbled 	find_ranges(node, list, &cur, rangetype);
    695   1.2   garbled 
    696   1.2   garbled 	DPRINTF("cur == %d\n", cur);
    697   1.2   garbled 	/* now list should contain a list of memory regions */
    698   1.2   garbled 	for (i=0; i < cur; i++)
    699   1.2   garbled 		DPRINTF("addr=0x%x size=0x%x type=%d\n", list[i].addr,
    700   1.2   garbled 		    list[i].size, list[i].type);
    701   1.2   garbled 
    702   1.2   garbled 	addr=0;
    703   1.2   garbled 	range = find_lowest_range(list, cur, iomem);
    704   1.2   garbled 	i = 0;
    705   1.2   garbled 	nrofholes = 0;
    706   1.2   garbled 	while (range != -1) {
    707   1.2   garbled 		DPRINTF("range==%d\n", range);
    708   1.2   garbled 		DPRINTF("i==%d\n", i);
    709   1.2   garbled 		if (i == 0) {
    710   1.2   garbled 			memcpy(&region, &list[range], sizeof(rangemap_t));
    711   1.2   garbled 			list[range].addr = 0;
    712   1.2   garbled 			i++;
    713   1.2   garbled 			range = find_lowest_range(list, cur, iomem);
    714   1.2   garbled 			continue;
    715   1.2   garbled 		}
    716   1.2   garbled 		if (region.addr + region.size < list[range].addr) {
    717   1.2   garbled 			/* allocate a hole */
    718  1.11   garbled 			holes[nrofholes].type = iomem;
    719   1.2   garbled 			holes[nrofholes].addr = region.size + region.addr;
    720   1.2   garbled 			holes[nrofholes].size = list[range].addr -
    721   1.2   garbled 			    holes[nrofholes].addr - 1;
    722   1.2   garbled 			nrofholes++;
    723   1.2   garbled 		}
    724   1.2   garbled 		region.size = list[range].size + list[range].addr -
    725   1.2   garbled 		    region.addr;
    726   1.2   garbled 		list[range].addr = 0;
    727   1.2   garbled 		range = find_lowest_range(list, cur, iomem);
    728   1.2   garbled 	}
    729   1.2   garbled 	DPRINTF("RANGE iomem=%d FOUND\n", iomem);
    730   1.2   garbled 	DPRINTF("addr=0x%x size=0x%x type=%d\n", region.addr,
    731   1.2   garbled 		    region.size, region.type);
    732   1.2   garbled 	DPRINTF("HOLES FOUND\n");
    733   1.2   garbled 	for (i=0; i < nrofholes; i++)
    734   1.2   garbled 		DPRINTF("addr=0x%x size=0x%x type=%d\n", holes[i].addr,
    735   1.2   garbled 		    holes[i].size, holes[i].type);
    736   1.2   garbled 	/* AT THIS POINT WE MAP IT */
    737   1.2   garbled 
    738   1.2   garbled 	if (rangetype == RANGE_TYPE_PCI) {
    739   1.2   garbled 		if (exmap == EXSTORAGE_MAX)
    740   1.2   garbled 			panic("Not enough ex_storage space. "
    741   1.2   garbled 			    "Increase EXSTORAGE_MAX");
    742   1.2   garbled 
    743   1.2   garbled 		/* XXX doing this in here might be wrong */
    744   1.2   garbled 		if (iomem == 1) {
    745   1.2   garbled 			/* we map an IO region */
    746   1.2   garbled 			tag->pbs_offset = region.addr;
    747   1.2   garbled 			tag->pbs_base = 0;
    748   1.2   garbled 			tag->pbs_limit = region.size;
    749   1.2   garbled 		} else {
    750   1.2   garbled 			/* ... or a memory region */
    751   1.2   garbled 			tag->pbs_offset = 0;
    752   1.2   garbled 			tag->pbs_base = region.addr;
    753   1.2   garbled 			tag->pbs_limit = region.size + region.addr;
    754  1.19  kiyohara 		}
    755   1.2   garbled 
    756   1.2   garbled 		error = bus_space_init(tag, name, ex_storage[exmap],
    757   1.2   garbled 		    sizeof(ex_storage[exmap]));
    758   1.2   garbled 		exmap++;
    759   1.2   garbled 		if (error)
    760   1.2   garbled 			panic("ofwoea_bus_space_init: can't init tag %s", name);
    761   1.2   garbled 		for (i=0; i < nrofholes; i++) {
    762  1.11   garbled 			if (holes[i].type == RANGE_IO) {
    763  1.11   garbled 				error = extent_alloc_region(tag->pbs_extent,
    764  1.11   garbled 				    holes[i].addr - tag->pbs_offset,
    765  1.11   garbled 				    holes[i].size, EX_NOWAIT);
    766  1.11   garbled 			} else {
    767  1.11   garbled 				error = extent_alloc_region(tag->pbs_extent,
    768  1.11   garbled 				    holes[i].addr, holes[i].size, EX_NOWAIT);
    769  1.11   garbled 			}
    770   1.2   garbled 			if (error)
    771   1.2   garbled 				panic("ofwoea_bus_space_init: can't block out"
    772   1.2   garbled 				    " reserved space 0x%x-0x%x: error=%d",
    773   1.2   garbled 				    holes[i].addr, holes[i].addr+holes[i].size,
    774   1.2   garbled 				    error);
    775   1.2   garbled 		}
    776   1.2   garbled 		return error;
    777   1.2   garbled 	}
    778   1.2   garbled 	return -1;
    779   1.2   garbled }
    780   1.2   garbled 
    781   1.2   garbled void
    782   1.2   garbled ofwoea_bus_space_init(void)
    783   1.2   garbled {
    784   1.2   garbled 	int error;
    785   1.2   garbled 
    786   1.2   garbled 	error = ofwoea_map_space(RANGE_TYPE_ISA, RANGE_IO, -1,
    787   1.2   garbled 	    &genppc_isa_io_space_tag, "isa-ioport");
    788   1.2   garbled 	if (error > 0)
    789   1.2   garbled 		panic("Could not map ISA IO");
    790   1.3   garbled 
    791   1.2   garbled 	error = ofwoea_map_space(RANGE_TYPE_ISA, RANGE_MEM, -1,
    792   1.2   garbled 	    &genppc_isa_mem_space_tag, "isa-iomem");
    793   1.2   garbled 	if (error > 0)
    794   1.2   garbled 		panic("Could not map ISA MEM");
    795   1.2   garbled }
    796