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