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