Home | History | Annotate | Line # | Download | only in altboot
brdsetup.c revision 1.6
      1  1.6       phx /* $NetBSD: brdsetup.c,v 1.6 2011/03/06 13:55:12 phx Exp $ */
      2  1.1  nisimura 
      3  1.1  nisimura /*-
      4  1.1  nisimura  * Copyright (c) 2008 The NetBSD Foundation, Inc.
      5  1.1  nisimura  * All rights reserved.
      6  1.1  nisimura  *
      7  1.1  nisimura  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  nisimura  * by Tohru Nishimura.
      9  1.1  nisimura  *
     10  1.1  nisimura  * Redistribution and use in source and binary forms, with or without
     11  1.1  nisimura  * modification, are permitted provided that the following conditions
     12  1.1  nisimura  * are met:
     13  1.1  nisimura  * 1. Redistributions of source code must retain the above copyright
     14  1.1  nisimura  *    notice, this list of conditions and the following disclaimer.
     15  1.1  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  nisimura  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  nisimura  *    documentation and/or other materials provided with the distribution.
     18  1.1  nisimura  *
     19  1.1  nisimura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1  nisimura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1  nisimura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1  nisimura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1  nisimura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1  nisimura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1  nisimura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1  nisimura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1  nisimura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1  nisimura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1  nisimura  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1  nisimura  */
     31  1.1  nisimura 
     32  1.1  nisimura #include <sys/param.h>
     33  1.1  nisimura 
     34  1.1  nisimura #include <powerpc/oea/spr.h>
     35  1.1  nisimura 
     36  1.1  nisimura #include <lib/libsa/stand.h>
     37  1.1  nisimura #include <lib/libsa/net.h>
     38  1.1  nisimura #include <lib/libkern/libkern.h>
     39  1.1  nisimura 
     40  1.1  nisimura #include <machine/bootinfo.h>
     41  1.1  nisimura 
     42  1.1  nisimura #include "globals.h"
     43  1.1  nisimura 
     44  1.1  nisimura #define BRD_DECL(xxx) \
     45  1.1  nisimura     void xxx ## setup(struct brdprop *); \
     46  1.1  nisimura     void xxx ## brdfix(struct brdprop *); \
     47  1.1  nisimura     void xxx ## pcifix(struct brdprop *); \
     48  1.1  nisimura     void xxx ## reset(void)
     49  1.1  nisimura 
     50  1.1  nisimura BRD_DECL(mot);
     51  1.1  nisimura BRD_DECL(enc);
     52  1.1  nisimura BRD_DECL(kuro);
     53  1.1  nisimura BRD_DECL(syno);
     54  1.1  nisimura BRD_DECL(qnap);
     55  1.2  nisimura BRD_DECL(iomega);
     56  1.3  nisimura BRD_DECL(dlink);
     57  1.5  nisimura BRD_DECL(nhnas);
     58  1.1  nisimura 
     59  1.1  nisimura static struct brdprop brdlist[] = {
     60  1.1  nisimura     {
     61  1.1  nisimura 	"sandpoint",
     62  1.1  nisimura 	"Sandpoint X3",
     63  1.1  nisimura 	BRD_SANDPOINTX3,
     64  1.1  nisimura 	0,
     65  1.1  nisimura 	"com", 0x3f8, 115200,
     66  1.5  nisimura 	motsetup, motbrdfix, motpcifix, NULL },
     67  1.1  nisimura     {
     68  1.1  nisimura 	"encpp1",
     69  1.1  nisimura 	"EnCore PP1",
     70  1.1  nisimura 	BRD_ENCOREPP1,
     71  1.1  nisimura 	0,
     72  1.1  nisimura 	"com", 0x3f8, 115200,
     73  1.5  nisimura 	encsetup, encbrdfix, encpcifix, NULL },
     74  1.1  nisimura     {
     75  1.1  nisimura 	"kurobox",
     76  1.1  nisimura 	"KuroBox",
     77  1.1  nisimura 	BRD_KUROBOX,
     78  1.1  nisimura 	32768000,
     79  1.1  nisimura 	"eumb", 0x4600, 57600,
     80  1.5  nisimura 	kurosetup, kurobrdfix, NULL, NULL },
     81  1.1  nisimura     {
     82  1.1  nisimura 	"synology",
     83  1.1  nisimura 	"Synology DS",
     84  1.1  nisimura 	BRD_SYNOLOGY,
     85  1.1  nisimura 	33164691,	/* from Synology/Linux source */
     86  1.1  nisimura 	/* 33168000,		XXX better precision? */
     87  1.1  nisimura 	"eumb", 0x4500, 115200,
     88  1.5  nisimura 	NULL, synobrdfix, NULL, synoreset },
     89  1.1  nisimura     {
     90  1.1  nisimura 	"qnap",
     91  1.1  nisimura 	"QNAP TS-101",
     92  1.1  nisimura 	BRD_QNAPTS101,
     93  1.1  nisimura 	0,
     94  1.1  nisimura 	"eumb", 0x4500, 115200,
     95  1.5  nisimura 	NULL, qnapbrdfix, NULL, NULL },
     96  1.1  nisimura     {
     97  1.1  nisimura 	"iomega",
     98  1.2  nisimura 	"IOMEGA StorCenter",
     99  1.1  nisimura 	BRD_STORCENTER,
    100  1.1  nisimura 	0,
    101  1.1  nisimura 	"eumb", 0x4500, 115200,
    102  1.5  nisimura 	NULL, iomegabrdfix, NULL, NULL },
    103  1.1  nisimura     {
    104  1.3  nisimura 	"dlink",
    105  1.4  nisimura 	"D-Link DSM-G600",
    106  1.4  nisimura 	BRD_DLINKDSM,
    107  1.3  nisimura 	0,
    108  1.3  nisimura 	"eumb", 0x4500, 9600,
    109  1.5  nisimura 	NULL, dlinkbrdfix, NULL, NULL },
    110  1.5  nisimura     {
    111  1.5  nisimura 	"nhnas",
    112  1.5  nisimura 	"Netronics NH230/231",
    113  1.5  nisimura 	BRD_NH230NAS,
    114  1.5  nisimura 	0,
    115  1.5  nisimura 	"eumb", 0x4500, 9600,
    116  1.5  nisimura 	NULL, nhnasbrdfix, NULL, NULL },
    117  1.3  nisimura     {
    118  1.1  nisimura 	"unknown",
    119  1.1  nisimura 	"Unknown board",
    120  1.1  nisimura 	BRD_UNKNOWN,
    121  1.1  nisimura 	0,
    122  1.1  nisimura 	"eumb", 0x4500, 115200,
    123  1.5  nisimura 	NULL, NULL, NULL, NULL }, /* must be the last */
    124  1.1  nisimura };
    125  1.1  nisimura 
    126  1.1  nisimura static struct brdprop *brdprop;
    127  1.1  nisimura static uint32_t ticks_per_sec, ns_per_tick;
    128  1.1  nisimura 
    129  1.1  nisimura static void brdfixup(void);
    130  1.1  nisimura static void setup(void);
    131  1.1  nisimura static inline uint32_t cputype(void);
    132  1.1  nisimura static inline u_quad_t mftb(void);
    133  1.1  nisimura static void init_uart(unsigned, unsigned, uint8_t);
    134  1.1  nisimura static void send_sat(char *);
    135  1.1  nisimura 
    136  1.1  nisimura const unsigned dcache_line_size = 32;		/* 32B linesize */
    137  1.1  nisimura const unsigned dcache_range_size = 4 * 1024;	/* 16KB / 4-way */
    138  1.1  nisimura 
    139  1.1  nisimura unsigned uart1base;	/* console */
    140  1.1  nisimura unsigned uart2base;	/* optional satellite processor */
    141  1.1  nisimura #define THR		0
    142  1.1  nisimura #define DLB		0
    143  1.1  nisimura #define DMB		1
    144  1.1  nisimura #define IER		1
    145  1.1  nisimura #define FCR		2
    146  1.1  nisimura #define LCR		3
    147  1.1  nisimura #define  LCR_DLAB	0x80
    148  1.1  nisimura #define  LCR_PEVEN	0x18
    149  1.1  nisimura #define  LCR_PNONE	0x00
    150  1.1  nisimura #define  LCR_8BITS	0x03
    151  1.1  nisimura #define MCR		4
    152  1.1  nisimura #define  MCR_RTS	0x02
    153  1.1  nisimura #define  MCR_DTR	0x01
    154  1.1  nisimura #define LSR		5
    155  1.1  nisimura #define  LSR_THRE	0x20
    156  1.1  nisimura #define DCR		0x11
    157  1.1  nisimura #define UART_READ(base, r)	*(volatile char *)(base + (r))
    158  1.1  nisimura #define UART_WRITE(base, r, v)	*(volatile char *)(base + (r)) = (v)
    159  1.1  nisimura 
    160  1.1  nisimura void brdsetup(void);	/* called by entry.S */
    161  1.1  nisimura 
    162  1.1  nisimura void
    163  1.1  nisimura brdsetup(void)
    164  1.1  nisimura {
    165  1.1  nisimura 	static uint8_t pci_to_memclk[] = {
    166  1.1  nisimura 		30, 30, 10, 10, 20, 10, 10, 10,
    167  1.1  nisimura 		10, 20, 20, 15, 20, 15, 20, 30,
    168  1.1  nisimura 		30, 40, 15, 40, 20, 25, 20, 40,
    169  1.1  nisimura 		25, 20, 10, 20, 15, 15, 20, 00
    170  1.1  nisimura 	};
    171  1.1  nisimura 	static uint8_t mem_to_cpuclk[] = {
    172  1.1  nisimura 		25, 30, 45, 20, 20, 00, 10, 30,
    173  1.1  nisimura 		30, 20, 45, 30, 25, 35, 30, 35,
    174  1.1  nisimura 		20, 25, 20, 30, 35, 40, 40, 20,
    175  1.1  nisimura 		30, 25, 40, 30, 30, 25, 35, 00
    176  1.1  nisimura 	};
    177  1.1  nisimura 	char *consname;
    178  1.1  nisimura 	int consport;
    179  1.1  nisimura 	uint32_t extclk;
    180  1.5  nisimura 	unsigned pchb, pcib, dev11, dev13, dev15, dev16, val;
    181  1.1  nisimura 	extern struct btinfo_memory bi_mem;
    182  1.1  nisimura 	extern struct btinfo_console bi_cons;
    183  1.1  nisimura 	extern struct btinfo_clock bi_clk;
    184  1.1  nisimura 	extern struct btinfo_prodfamily bi_fam;
    185  1.1  nisimura 
    186  1.1  nisimura 	/*
    187  1.1  nisimura 	 * CHRP specification "Map-B" BAT012 layout
    188  1.1  nisimura 	 *   BAT0 0000-0000 (256MB) SDRAM
    189  1.1  nisimura 	 *   BAT1 8000-0000 (256MB) PCI mem space
    190  1.1  nisimura 	 *   BAT2 fc00-0000 (64MB)  EUMB, PCI I/O space, misc devs, flash
    191  1.1  nisimura 	 *
    192  1.1  nisimura 	 * EUMBBAR is at fc00-0000.
    193  1.1  nisimura 	 */
    194  1.1  nisimura 	pchb = pcimaketag(0, 0, 0);
    195  1.1  nisimura 	pcicfgwrite(pchb, 0x78, 0xfc000000);
    196  1.1  nisimura 
    197  1.1  nisimura 	brdtype = BRD_UNKNOWN;
    198  1.1  nisimura 	extclk = EXT_CLK_FREQ;	/* usually 33MHz */
    199  1.1  nisimura 	busclock = 0;
    200  1.1  nisimura 
    201  1.5  nisimura 	dev11 = pcimaketag(0, 11, 0);
    202  1.5  nisimura 	dev13 = pcimaketag(0, 13, 0);
    203  1.5  nisimura 	dev15 = pcimaketag(0, 15, 0);
    204  1.5  nisimura 	dev16 = pcimaketag(0, 16, 0);
    205  1.5  nisimura 
    206  1.1  nisimura 	if (pcifinddev(0x10ad, 0x0565, &pcib) == 0) {
    207  1.5  nisimura 		/* WinBond 553 southbridge at dev 11 */
    208  1.1  nisimura 		brdtype = BRD_SANDPOINTX3;
    209  1.1  nisimura 	}
    210  1.1  nisimura 	else if (pcifinddev(0x1106, 0x0686, &pcib) == 0) {
    211  1.5  nisimura 		/* VIA 686B southbridge at dev 22 */
    212  1.1  nisimura 		brdtype = BRD_ENCOREPP1;
    213  1.1  nisimura 	}
    214  1.5  nisimura 	else if ((pcicfgread(dev11, PCI_CLASS_REG) >> 16) == PCI_CLASS_ETH) {
    215  1.5  nisimura 		/* ADMtek AN985 (tlp) or RealTek 8169S (re) at dev 11 */
    216  1.1  nisimura 		brdtype = BRD_KUROBOX;
    217  1.1  nisimura 	}
    218  1.5  nisimura 	else if (PCI_VENDOR(pcicfgread(dev15, PCI_ID_REG)) == 0x11ab) {
    219  1.5  nisimura 		/* SKnet/Marvell (sk) at dev 15 */
    220  1.1  nisimura 		brdtype = BRD_SYNOLOGY;
    221  1.1  nisimura 	}
    222  1.5  nisimura 	else if (PCI_VENDOR(pcicfgread(dev15, PCI_ID_REG)) == 0x8086) {
    223  1.5  nisimura 		/* Intel (wm) at dev 15 */
    224  1.1  nisimura 		brdtype = BRD_QNAPTS101;
    225  1.1  nisimura 	}
    226  1.5  nisimura 	else if (PCI_VENDOR(pcicfgread(dev13, PCI_ID_REG)) == 0x1106) {
    227  1.5  nisimura 		/* VIA 6410 (viaide) at dev 13 */
    228  1.1  nisimura 		brdtype = BRD_STORCENTER;
    229  1.1  nisimura 	}
    230  1.5  nisimura 	else if (PCI_VENDOR(pcicfgread(dev16, PCI_ID_REG)) == 0x1191) {
    231  1.5  nisimura 		/* ACARD ATP865 (acardide) at dev 16 */
    232  1.4  nisimura 		brdtype = BRD_DLINKDSM;
    233  1.3  nisimura 	}
    234  1.5  nisimura 	else if (PCI_VENDOR(pcicfgread(dev16, PCI_ID_REG)) == 0x1283
    235  1.5  nisimura 		   || PCI_VENDOR(pcicfgread(dev16, PCI_ID_REG)) == 0x1095) {
    236  1.5  nisimura 		/* ITE (iteide) or SiI (satalink) at dev 16 */
    237  1.5  nisimura 		brdtype = BRD_NH230NAS;
    238  1.5  nisimura 	}
    239  1.1  nisimura 
    240  1.1  nisimura 	brdprop = brd_lookup(brdtype);
    241  1.1  nisimura 
    242  1.1  nisimura 	/* brd dependent adjustments */
    243  1.1  nisimura 	setup();
    244  1.1  nisimura 
    245  1.1  nisimura 	/* determine clock frequencies */
    246  1.1  nisimura 	if (brdprop->extclk != 0)
    247  1.1  nisimura 		extclk = brdprop->extclk;
    248  1.1  nisimura 	if (busclock == 0) {
    249  1.1  nisimura 		if (cputype() == MPC8245) {
    250  1.1  nisimura 			/* PLL_CFG from PCI host bridge register 0xe2 */
    251  1.1  nisimura 			val = pcicfgread(pchb, 0xe0);
    252  1.1  nisimura 			busclock = (extclk *
    253  1.1  nisimura 			    pci_to_memclk[(val >> 19) & 0x1f] + 10) / 10;
    254  1.1  nisimura 			/* PLLRATIO from HID1 */
    255  1.1  nisimura 			__asm ("mfspr %0,1009" : "=r"(val));
    256  1.1  nisimura 			cpuclock = ((uint64_t)busclock *
    257  1.1  nisimura 			    mem_to_cpuclk[val >> 27] + 10) / 10;
    258  1.1  nisimura 		} else
    259  1.1  nisimura 			busclock = 100000000;	/* 100MHz bus clock default */
    260  1.1  nisimura 	}
    261  1.1  nisimura 	ticks_per_sec = busclock >> 2;
    262  1.1  nisimura 	ns_per_tick = 1000000000 / ticks_per_sec;
    263  1.1  nisimura 
    264  1.1  nisimura 	/* now prepare serial console */
    265  1.1  nisimura 	consname = brdprop->consname;
    266  1.1  nisimura 	consport = brdprop->consport;
    267  1.1  nisimura 	if (strcmp(consname, "eumb") == 0) {
    268  1.1  nisimura 		uart1base = 0xfc000000 + consport;	/* 0x4500, 0x4600 */
    269  1.1  nisimura 		UART_WRITE(uart1base, DCR, 0x01);	/* enable DUART mode */
    270  1.1  nisimura 		uart2base = uart1base ^ 0x0300;
    271  1.1  nisimura 	} else
    272  1.1  nisimura 		uart1base = 0xfe000000 + consport;	/* 0x3f8, 0x2f8 */
    273  1.1  nisimura 
    274  1.1  nisimura 	/* more brd adjustments */
    275  1.1  nisimura 	brdfixup();
    276  1.1  nisimura 
    277  1.1  nisimura 	bi_mem.memsize = mpc107memsize();
    278  1.1  nisimura 	snprintf(bi_cons.devname, sizeof(bi_cons.devname), consname);
    279  1.1  nisimura 	bi_cons.addr = consport;
    280  1.1  nisimura 	bi_cons.speed = brdprop->consspeed;
    281  1.1  nisimura 	bi_clk.ticks_per_sec = ticks_per_sec;
    282  1.1  nisimura 	snprintf(bi_fam.name, sizeof(bi_fam.name), brdprop->family);
    283  1.1  nisimura }
    284  1.1  nisimura 
    285  1.1  nisimura struct brdprop *
    286  1.1  nisimura brd_lookup(int brd)
    287  1.1  nisimura {
    288  1.1  nisimura 	u_int i;
    289  1.1  nisimura 
    290  1.1  nisimura 	for (i = 0; i < sizeof(brdlist)/sizeof(brdlist[0]); i++) {
    291  1.1  nisimura 		if (brdlist[i].brdtype == brd)
    292  1.1  nisimura 			return &brdlist[i];
    293  1.1  nisimura 	}
    294  1.1  nisimura 	return &brdlist[i - 1];
    295  1.1  nisimura }
    296  1.1  nisimura 
    297  1.1  nisimura static void
    298  1.1  nisimura setup()
    299  1.1  nisimura {
    300  1.1  nisimura 
    301  1.1  nisimura 	if (brdprop->setup == NULL)
    302  1.1  nisimura 		return;
    303  1.1  nisimura 	(*brdprop->setup)(brdprop);
    304  1.1  nisimura }
    305  1.1  nisimura 
    306  1.1  nisimura static void
    307  1.1  nisimura brdfixup()
    308  1.1  nisimura {
    309  1.1  nisimura 
    310  1.1  nisimura 	if (brdprop->brdfix == NULL)
    311  1.1  nisimura 		return;
    312  1.1  nisimura 	(*brdprop->brdfix)(brdprop);
    313  1.1  nisimura }
    314  1.1  nisimura 
    315  1.1  nisimura void
    316  1.1  nisimura pcifixup()
    317  1.1  nisimura {
    318  1.1  nisimura 
    319  1.1  nisimura 	if (brdprop->pcifix == NULL)
    320  1.1  nisimura 		return;
    321  1.1  nisimura 	(*brdprop->pcifix)(brdprop);
    322  1.1  nisimura }
    323  1.1  nisimura 
    324  1.1  nisimura void
    325  1.1  nisimura encsetup(struct brdprop *brd)
    326  1.1  nisimura {
    327  1.1  nisimura 
    328  1.1  nisimura #ifdef COSNAME
    329  1.1  nisimura 	brd->consname = CONSNAME;
    330  1.1  nisimura #endif
    331  1.1  nisimura #ifdef CONSPORT
    332  1.1  nisimura 	brd->consport = CONSPORT;
    333  1.1  nisimura #endif
    334  1.1  nisimura #ifdef CONSSPEED
    335  1.1  nisimura 	brd->consspeed = CONSSPEED;
    336  1.1  nisimura #endif
    337  1.1  nisimura }
    338  1.1  nisimura 
    339  1.1  nisimura void
    340  1.1  nisimura encbrdfix(struct brdprop *brd)
    341  1.1  nisimura {
    342  1.5  nisimura 	unsigned ac97, ide, pcib, pmgt, usb12, usb34, val;
    343  1.1  nisimura 
    344  1.1  nisimura /*
    345  1.1  nisimura  * VIA82C686B Southbridge
    346  1.1  nisimura  *	0.22.0	1106.0686	PCI-ISA bridge
    347  1.1  nisimura  *	0.22.1	1106.0571	IDE (viaide)
    348  1.1  nisimura  *	0.22.2	1106.3038	USB 0/1 (uhci)
    349  1.1  nisimura  *	0.22.3	1106.3038	USB 2/3 (uhci)
    350  1.1  nisimura  *	0.22.4	1106.3057	power management
    351  1.1  nisimura  *	0.22.5	1106.3058	AC97 (auvia)
    352  1.1  nisimura  */
    353  1.1  nisimura 	pcib  = pcimaketag(0, 22, 0);
    354  1.1  nisimura 	ide   = pcimaketag(0, 22, 1);
    355  1.1  nisimura 	usb12 = pcimaketag(0, 22, 2);
    356  1.5  nisimura 	usb34 = pcimaketag(0, 22, 3);
    357  1.1  nisimura 	pmgt  = pcimaketag(0, 22, 4);
    358  1.1  nisimura 	ac97  = pcimaketag(0, 22, 5);
    359  1.1  nisimura 
    360  1.1  nisimura #define	CFG(i,v) do { \
    361  1.1  nisimura    *(volatile unsigned char *)(0xfe000000 + 0x3f0) = (i); \
    362  1.1  nisimura    *(volatile unsigned char *)(0xfe000000 + 0x3f1) = (v); \
    363  1.1  nisimura    } while (0)
    364  1.1  nisimura 	val = pcicfgread(pcib, 0x84);
    365  1.1  nisimura 	val |= (02 << 8);
    366  1.1  nisimura 	pcicfgwrite(pcib, 0x84, val);
    367  1.1  nisimura 	CFG(0xe2, 0x0f); /* use COM1/2, don't use FDC/LPT */
    368  1.1  nisimura 	val = pcicfgread(pcib, 0x84);
    369  1.1  nisimura 	val &= ~(02 << 8);
    370  1.1  nisimura 	pcicfgwrite(pcib, 0x84, val);
    371  1.1  nisimura 
    372  1.1  nisimura 	/* route pin C to i8259 IRQ 5, pin D to 11 */
    373  1.1  nisimura 	val = pcicfgread(pcib, 0x54);
    374  1.1  nisimura 	val = (val & 0xff) | 0xb0500000; /* Dx CB Ax xS */
    375  1.1  nisimura 	pcicfgwrite(pcib, 0x54, val);
    376  1.1  nisimura 
    377  1.1  nisimura 	/* enable EISA ELCR1 (0x4d0) and ELCR2 (0x4d1) */
    378  1.1  nisimura 	val = pcicfgread(pcib, 0x44);
    379  1.1  nisimura 	val = val | 0x20000000;
    380  1.1  nisimura 	pcicfgwrite(pcib, 0x44, val);
    381  1.1  nisimura 
    382  1.1  nisimura 	/* select level trigger for IRQ 5/11 at ELCR1/2 */
    383  1.1  nisimura 	*(volatile uint8_t *)0xfe0004d0 = 0x20; /* bit 5 */
    384  1.1  nisimura 	*(volatile uint8_t *)0xfe0004d1 = 0x08; /* bit 11 */
    385  1.1  nisimura 
    386  1.1  nisimura 	/* USB and AC97 are hardwired with pin D and C */
    387  1.1  nisimura 	val = pcicfgread(usb12, 0x3c) &~ 0xff;
    388  1.1  nisimura 	val |= 11;
    389  1.1  nisimura 	pcicfgwrite(usb12, 0x3c, val);
    390  1.5  nisimura 	val = pcicfgread(usb34, 0x3c) &~ 0xff;
    391  1.1  nisimura 	val |= 11;
    392  1.5  nisimura 	pcicfgwrite(usb34, 0x3c, val);
    393  1.1  nisimura 	val = pcicfgread(ac97, 0x3c) &~ 0xff;
    394  1.1  nisimura 	val |= 5;
    395  1.1  nisimura 	pcicfgwrite(ac97, 0x3c, val);
    396  1.1  nisimura }
    397  1.1  nisimura 
    398  1.1  nisimura void
    399  1.5  nisimura encpcifix(struct brdprop *brd)
    400  1.5  nisimura {
    401  1.5  nisimura 	unsigned ide, irq, net, pcib, steer, val;
    402  1.5  nisimura 
    403  1.5  nisimura #define	STEER(v, b) (((v) & (b)) ? "edge" : "level")
    404  1.5  nisimura 	pcib = pcimaketag(0, 22, 0);
    405  1.5  nisimura 	ide  = pcimaketag(0, 22, 1);
    406  1.5  nisimura 	net  = pcimaketag(0, 25, 0);
    407  1.5  nisimura 
    408  1.5  nisimura 	/*
    409  1.5  nisimura 	 * //// VIA PIRQ ////
    410  1.5  nisimura 	 * 0x57/56/55/54 - Dx CB Ax xS
    411  1.5  nisimura 	 */
    412  1.5  nisimura 	val = pcicfgread(pcib, 0x54);	/* Dx CB Ax xs */
    413  1.5  nisimura 	steer = val & 0xf;
    414  1.5  nisimura 	irq = (val >> 12) & 0xf;	/* 15:12 */
    415  1.5  nisimura 	if (irq) {
    416  1.5  nisimura 		printf("pin A -> irq %d, %s\n",
    417  1.5  nisimura 			irq, STEER(steer, 0x1));
    418  1.5  nisimura 	}
    419  1.5  nisimura 	irq = (val >> 16) & 0xf;	/* 19:16 */
    420  1.5  nisimura 	if (irq) {
    421  1.5  nisimura 		printf("pin B -> irq %d, %s\n",
    422  1.5  nisimura 			irq, STEER(steer, 0x2));
    423  1.5  nisimura 	}
    424  1.5  nisimura 	irq = (val >> 20) & 0xf;	/* 23:20 */
    425  1.5  nisimura 	if (irq) {
    426  1.5  nisimura 		printf("pin C -> irq %d, %s\n",
    427  1.5  nisimura 			irq, STEER(steer, 0x4));
    428  1.5  nisimura 	}
    429  1.5  nisimura 	irq = (val >> 28);		/* 31:28 */
    430  1.5  nisimura 	if (irq) {
    431  1.5  nisimura 		printf("pin D -> irq %d, %s\n",
    432  1.5  nisimura 			irq, STEER(steer, 0x8));
    433  1.5  nisimura 	}
    434  1.5  nisimura #if 0
    435  1.5  nisimura 	/*
    436  1.5  nisimura 	 * //// IDE fixup ////
    437  1.5  nisimura 	 * - "native mode" (ide 0x09)
    438  1.5  nisimura 	 * - use primary only (ide 0x40)
    439  1.5  nisimura 	 */
    440  1.5  nisimura 	/* ide: 0x09 - programming interface; 1000'SsPp */
    441  1.5  nisimura 	val = pcicfgread(ide, 0x08) & 0xffff00ff;
    442  1.5  nisimura 	pcicfgwrite(ide, 0x08, val | (0x8f << 8));
    443  1.5  nisimura 
    444  1.5  nisimura 	/* ide: 0x10-20 - leave them PCI memory space assigned */
    445  1.5  nisimura 
    446  1.5  nisimura 	/* ide: 0x40 - use primary only */
    447  1.5  nisimura 	val = pcicfgread(ide, 0x40) &~ 03;
    448  1.5  nisimura 	val |= 02;
    449  1.5  nisimura 	pcicfgwrite(ide, 0x40, val);
    450  1.5  nisimura #else
    451  1.5  nisimura 	/*
    452  1.5  nisimura 	 * //// IDE fixup ////
    453  1.5  nisimura 	 * - "compatiblity mode" (ide 0x09)
    454  1.5  nisimura 	 * - use primary only (ide 0x40)
    455  1.5  nisimura 	 * - remove PCI pin assignment (ide 0x3d)
    456  1.5  nisimura 	 */
    457  1.5  nisimura 	/* ide: 0x09 - programming interface; 1000'SsPp */
    458  1.5  nisimura 	val = pcicfgread(ide, 0x08) & 0xffff00ff;
    459  1.5  nisimura 	val |= (0x8a << 8);
    460  1.5  nisimura 	pcicfgwrite(ide, 0x08, val);
    461  1.5  nisimura 
    462  1.5  nisimura 	/* ide: 0x10-20 */
    463  1.5  nisimura 	/*
    464  1.5  nisimura 	experiment shows writing ide: 0x09 changes these
    465  1.5  nisimura 	register behaviour. The pcicfgwrite() above writes
    466  1.5  nisimura 	0x8a at ide: 0x09 to make sure legacy IDE.  Then
    467  1.5  nisimura 	reading BAR0-3 is to return value 0s even though
    468  1.5  nisimura 	pcisetup() has written range assignments.  Value
    469  1.5  nisimura 	overwrite makes no effect. Having 0x8f for native
    470  1.5  nisimura 	PCIIDE doesn't change register values and brings no
    471  1.5  nisimura 	weirdness.
    472  1.5  nisimura 	 */
    473  1.5  nisimura 
    474  1.5  nisimura 	/* ide: 0x40 - use primary only */
    475  1.5  nisimura 	val = pcicfgread(ide, 0x40) &~ 03;
    476  1.5  nisimura 	val |= 02;
    477  1.5  nisimura 	pcicfgwrite(ide, 0x40, val);
    478  1.5  nisimura 
    479  1.5  nisimura 		/* ide: 0x3d/3c - turn off PCI pin */
    480  1.5  nisimura 	val = pcicfgread(ide, 0x3c) & 0xffff00ff;
    481  1.5  nisimura 	pcicfgwrite(ide, 0x3c, val);
    482  1.5  nisimura #endif
    483  1.5  nisimura 	/*
    484  1.5  nisimura 	 * //// USBx2, audio, and modem fixup ////
    485  1.5  nisimura 	 * - disable USB #0 and #1 (pcib 0x48 and 0x85)
    486  1.5  nisimura 	 * - disable AC97 audio and MC97 modem (pcib 0x85)
    487  1.5  nisimura 	 */
    488  1.5  nisimura 
    489  1.5  nisimura 	/* pcib: 0x48 - disable USB #0 at function 2 */
    490  1.5  nisimura 	val = pcicfgread(pcib, 0x48);
    491  1.5  nisimura 	pcicfgwrite(pcib, 0x48, val | 04);
    492  1.5  nisimura 
    493  1.5  nisimura 	/* pcib: 0x85 - disable USB #1 at function 3 */
    494  1.5  nisimura 	/* pcib: 0x85 - disable AC97/MC97 at function 5/6 */
    495  1.5  nisimura 	val = pcicfgread(pcib, 0x84);
    496  1.5  nisimura 	pcicfgwrite(pcib, 0x84, val | 0x1c00);
    497  1.5  nisimura 
    498  1.5  nisimura 	/*
    499  1.5  nisimura 	 * //// fxp fixup ////
    500  1.5  nisimura 	 * - use PCI pin A line 25 (fxp 0x3d/3c)
    501  1.5  nisimura 	 */
    502  1.5  nisimura 	/* 0x3d/3c - PCI pin/line */
    503  1.5  nisimura 	val = pcicfgread(net, 0x3c) & 0xffff0000;
    504  1.5  nisimura 	val |= (('A' - '@') << 8) | 25;
    505  1.5  nisimura 	pcicfgwrite(net, 0x3c, val);
    506  1.5  nisimura }
    507  1.5  nisimura 
    508  1.5  nisimura void
    509  1.1  nisimura motsetup(struct brdprop *brd)
    510  1.1  nisimura {
    511  1.1  nisimura 
    512  1.1  nisimura #ifdef COSNAME
    513  1.1  nisimura 	brd->consname = CONSNAME;
    514  1.1  nisimura #endif
    515  1.1  nisimura #ifdef CONSPORT
    516  1.1  nisimura 	brd->consport = CONSPORT;
    517  1.1  nisimura #endif
    518  1.1  nisimura #ifdef CONSSPEED
    519  1.1  nisimura 	brd->consspeed = CONSSPEED;
    520  1.1  nisimura #endif
    521  1.1  nisimura }
    522  1.1  nisimura 
    523  1.1  nisimura void
    524  1.1  nisimura motbrdfix(struct brdprop *brd)
    525  1.1  nisimura {
    526  1.1  nisimura 
    527  1.1  nisimura /*
    528  1.1  nisimura  * WinBond/Symphony Lab 83C553 with PC87308 "SuperIO"
    529  1.1  nisimura  *
    530  1.1  nisimura  *	0.11.0	10ad.0565	PCI-ISA bridge
    531  1.1  nisimura  *	0.11.1	10ad.0105	IDE (slide)
    532  1.1  nisimura  */
    533  1.1  nisimura }
    534  1.1  nisimura 
    535  1.1  nisimura void
    536  1.1  nisimura motpcifix(struct brdprop *brd)
    537  1.1  nisimura {
    538  1.4  nisimura 	unsigned ide, net, pcib, steer, val;
    539  1.1  nisimura 	int line;
    540  1.1  nisimura 
    541  1.1  nisimura 	pcib = pcimaketag(0, 11, 0);
    542  1.1  nisimura 	ide  = pcimaketag(0, 11, 1);
    543  1.4  nisimura 	net  = pcimaketag(0, 15, 0);
    544  1.1  nisimura 
    545  1.1  nisimura 	/*
    546  1.1  nisimura 	 * //// WinBond PIRQ ////
    547  1.1  nisimura 	 * 0x40 - bit 5 (0x20) indicates PIRQ presense
    548  1.1  nisimura 	 * 0x60 - PIRQ interrupt routing steer
    549  1.1  nisimura 	 */
    550  1.1  nisimura 	if (pcicfgread(pcib, 0x40) & 0x20) {
    551  1.1  nisimura 		steer = pcicfgread(pcib, 0x60);
    552  1.1  nisimura 		if ((steer & 0x80808080) == 0x80808080)
    553  1.1  nisimura 			printf("PIRQ[0-3] disabled\n");
    554  1.1  nisimura 		else {
    555  1.1  nisimura 			unsigned i, v = steer;
    556  1.1  nisimura 			for (i = 0; i < 4; i++, v >>= 8) {
    557  1.1  nisimura 				if ((v & 0x80) != 0 || (v & 0xf) == 0)
    558  1.1  nisimura 					continue;
    559  1.1  nisimura 				printf("PIRQ[%d]=%d\n", i, v & 0xf);
    560  1.1  nisimura 				}
    561  1.1  nisimura 			}
    562  1.1  nisimura 		}
    563  1.1  nisimura #if 1
    564  1.1  nisimura 	/*
    565  1.1  nisimura 	 * //// IDE fixup -- case A ////
    566  1.1  nisimura 	 * - "native PCI mode" (ide 0x09)
    567  1.1  nisimura 	 * - don't use ISA IRQ14/15 (pcib 0x43)
    568  1.1  nisimura 	 * - native IDE for both channels (ide 0x40)
    569  1.1  nisimura 	 * - LEGIRQ bit 11 steers interrupt to pin C (ide 0x40)
    570  1.1  nisimura 	 * - sign as PCI pin C line 11 (ide 0x3d/3c)
    571  1.1  nisimura 	 */
    572  1.1  nisimura 	/* ide: 0x09 - programming interface; 1000'SsPp */
    573  1.1  nisimura 	val = pcicfgread(ide, 0x08);
    574  1.1  nisimura 	val &= 0xffff00ff;
    575  1.1  nisimura 	pcicfgwrite(ide, 0x08, val | (0x8f << 8));
    576  1.1  nisimura 
    577  1.1  nisimura 	/* pcib: 0x43 - IDE interrupt routing */
    578  1.1  nisimura 	val = pcicfgread(pcib, 0x40) & 0x00ffffff;
    579  1.1  nisimura 	pcicfgwrite(pcib, 0x40, val);
    580  1.1  nisimura 
    581  1.1  nisimura 	/* pcib: 0x45/44 - PCI interrupt routing */
    582  1.1  nisimura 	val = pcicfgread(pcib, 0x44) & 0xffff0000;
    583  1.1  nisimura 	pcicfgwrite(pcib, 0x44, val);
    584  1.1  nisimura 
    585  1.1  nisimura 	/* ide: 0x41/40 - IDE channel */
    586  1.1  nisimura 	val = pcicfgread(ide, 0x40) & 0xffff0000;
    587  1.1  nisimura 	val |= (1 << 11) | 0x33; /* LEGIRQ turns on PCI interrupt */
    588  1.1  nisimura 	pcicfgwrite(ide, 0x40, val);
    589  1.1  nisimura 
    590  1.1  nisimura 	/* ide: 0x3d/3c - use PCI pin C/line 11 */
    591  1.1  nisimura 	val = pcicfgread(ide, 0x3c) & 0xffffff00;
    592  1.1  nisimura 	val |= 11; /* pin designation is hardwired to pin A */
    593  1.1  nisimura 	pcicfgwrite(ide, 0x3c, val);
    594  1.1  nisimura #else
    595  1.1  nisimura 	/*
    596  1.1  nisimura 	 * //// IDE fixup -- case B ////
    597  1.1  nisimura 	 * - "compatiblity mode" (ide 0x09)
    598  1.1  nisimura 	 * - IDE primary/secondary interrupt routing (pcib 0x43)
    599  1.1  nisimura 	 * - PCI interrupt routing (pcib 0x45/44)
    600  1.1  nisimura 	 * - no PCI pin/line assignment (ide 0x3d/3c)
    601  1.1  nisimura 	 */
    602  1.1  nisimura 	/* ide: 0x09 - programming interface; 1000'SsPp */
    603  1.1  nisimura 	val = pcicfgread(ide, 0x08);
    604  1.1  nisimura 	val &= 0xffff00ff;
    605  1.1  nisimura 	pcicfgwrite(ide, 0x08, val | (0x8a << 8));
    606  1.1  nisimura 
    607  1.1  nisimura 	/* pcib: 0x43 - IDE interrupt routing */
    608  1.1  nisimura 	val = pcicfgread(pcib, 0x40) & 0x00ffffff;
    609  1.1  nisimura 	pcicfgwrite(pcib, 0x40, val | (0xee << 24));
    610  1.1  nisimura 
    611  1.1  nisimura 	/* ide: 0x45/44 - PCI interrupt routing */
    612  1.1  nisimura 	val = pcicfgread(ide, 0x44) & 0xffff0000;
    613  1.1  nisimura 	pcicfgwrite(ide, 0x44, val);
    614  1.1  nisimura 
    615  1.1  nisimura 	/* ide: 0x3d/3c - turn off PCI pin/line */
    616  1.1  nisimura 	val = pcicfgread(ide, 0x3c) & 0xffff0000;
    617  1.1  nisimura 	pcicfgwrite(ide, 0x3c, val);
    618  1.1  nisimura #endif
    619  1.1  nisimura 
    620  1.1  nisimura 	/*
    621  1.1  nisimura 	 * //// fxp fixup ////
    622  1.1  nisimura 	 * - use PCI pin A line 15 (fxp 0x3d/3c)
    623  1.1  nisimura 	 */
    624  1.4  nisimura 	val = pcicfgread(net, 0x3c) & 0xffff0000;
    625  1.4  nisimura 	pcidecomposetag(net, NULL, &line, NULL);
    626  1.1  nisimura 	val |= (('A' - '@') << 8) | line;
    627  1.4  nisimura 	pcicfgwrite(net, 0x3c, val);
    628  1.1  nisimura }
    629  1.1  nisimura 
    630  1.1  nisimura void
    631  1.1  nisimura kurosetup(struct brdprop *brd)
    632  1.1  nisimura {
    633  1.1  nisimura 
    634  1.1  nisimura 	if (PCI_VENDOR(pcicfgread(pcimaketag(0, 11, 0), PCI_ID_REG)) == 0x10ec)
    635  1.1  nisimura 		brd->extclk = 32768000; /* decr 2457600Hz */
    636  1.1  nisimura 	else
    637  1.1  nisimura 		brd->extclk = 32521333; /* decr 2439100Hz */
    638  1.1  nisimura }
    639  1.1  nisimura 
    640  1.1  nisimura void
    641  1.1  nisimura kurobrdfix(struct brdprop *brd)
    642  1.1  nisimura {
    643  1.1  nisimura 
    644  1.1  nisimura 	init_uart(uart2base, 9600, LCR_8BITS | LCR_PEVEN);
    645  1.1  nisimura 	/* Stop Watchdog */
    646  1.1  nisimura 	send_sat("AAAAFFFFJJJJ>>>>VVVV>>>>ZZZZVVVVKKKK");
    647  1.1  nisimura }
    648  1.1  nisimura 
    649  1.1  nisimura void
    650  1.1  nisimura synobrdfix(struct brdprop *brd)
    651  1.1  nisimura {
    652  1.1  nisimura 
    653  1.1  nisimura 	init_uart(uart2base, 9600, LCR_8BITS | LCR_PNONE);
    654  1.1  nisimura 	/* beep, power LED on, status LED off */
    655  1.1  nisimura 	send_sat("247");
    656  1.1  nisimura }
    657  1.1  nisimura 
    658  1.1  nisimura void
    659  1.2  nisimura synoreset()
    660  1.2  nisimura {
    661  1.2  nisimura 
    662  1.2  nisimura 	send_sat("C");
    663  1.2  nisimura 	/*NOTRECHED*/
    664  1.2  nisimura }
    665  1.2  nisimura 
    666  1.2  nisimura void
    667  1.5  nisimura qnapbrdfix(struct brdprop *brd)
    668  1.1  nisimura {
    669  1.1  nisimura 
    670  1.5  nisimura 	/* illuminate LEDs */
    671  1.1  nisimura }
    672  1.1  nisimura 
    673  1.1  nisimura void
    674  1.2  nisimura iomegabrdfix(struct brdprop *brd)
    675  1.2  nisimura {
    676  1.2  nisimura 
    677  1.2  nisimura 	init_uart(uart2base, 9600, LCR_8BITS | LCR_PNONE);
    678  1.5  nisimura 	/* illuminate LEDs */
    679  1.1  nisimura }
    680  1.1  nisimura 
    681  1.1  nisimura void
    682  1.3  nisimura dlinkbrdfix(struct brdprop *brd)
    683  1.3  nisimura {
    684  1.3  nisimura 
    685  1.3  nisimura 	init_uart(uart2base, 9600, LCR_8BITS | LCR_PNONE);
    686  1.5  nisimura 	/* illuminate LEDs */
    687  1.3  nisimura }
    688  1.3  nisimura 
    689  1.3  nisimura void
    690  1.5  nisimura nhnasbrdfix(struct brdprop *brd)
    691  1.3  nisimura {
    692  1.3  nisimura 
    693  1.5  nisimura 	/* illuminate LEDs */
    694  1.3  nisimura }
    695  1.3  nisimura 
    696  1.3  nisimura void
    697  1.1  nisimura _rtt(void)
    698  1.1  nisimura {
    699  1.1  nisimura 
    700  1.1  nisimura 	if (brdprop->reset != NULL)
    701  1.1  nisimura 		(*brdprop->reset)();
    702  1.1  nisimura 	else
    703  1.1  nisimura 		run(0, 0, 0, 0, (void *)0xFFF00100); /* reset entry */
    704  1.1  nisimura 	/*NOTREACHED*/
    705  1.1  nisimura }
    706  1.1  nisimura 
    707  1.1  nisimura satime_t
    708  1.1  nisimura getsecs(void)
    709  1.1  nisimura {
    710  1.1  nisimura 	u_quad_t tb = mftb();
    711  1.1  nisimura 
    712  1.1  nisimura 	return (tb / ticks_per_sec);
    713  1.1  nisimura }
    714  1.1  nisimura 
    715  1.1  nisimura /*
    716  1.1  nisimura  * Wait for about n microseconds (at least!).
    717  1.1  nisimura  */
    718  1.1  nisimura void
    719  1.1  nisimura delay(u_int n)
    720  1.1  nisimura {
    721  1.1  nisimura 	u_quad_t tb;
    722  1.1  nisimura 	u_long scratch, tbh, tbl;
    723  1.1  nisimura 
    724  1.1  nisimura 	tb = mftb();
    725  1.1  nisimura 	tb += (n * 1000 + ns_per_tick - 1) / ns_per_tick;
    726  1.1  nisimura 	tbh = tb >> 32;
    727  1.1  nisimura 	tbl = tb;
    728  1.1  nisimura 	asm volatile ("1: mftbu %0; cmpw %0,%1; blt 1b; bgt 2f; mftb %0; cmpw 0, %0,%2; blt 1b; 2:" : "=&r"(scratch) : "r"(tbh), "r"(tbl));
    729  1.1  nisimura }
    730  1.1  nisimura 
    731  1.1  nisimura void
    732  1.1  nisimura _wb(uint32_t adr, uint32_t siz)
    733  1.1  nisimura {
    734  1.1  nisimura 	uint32_t bnd;
    735  1.1  nisimura 
    736  1.1  nisimura 	asm volatile("eieio");
    737  1.1  nisimura 	for (bnd = adr + siz; adr < bnd; adr += dcache_line_size)
    738  1.1  nisimura 		asm volatile ("dcbst 0,%0" :: "r"(adr));
    739  1.1  nisimura 	asm volatile ("sync");
    740  1.1  nisimura }
    741  1.1  nisimura 
    742  1.1  nisimura void
    743  1.1  nisimura _wbinv(uint32_t adr, uint32_t siz)
    744  1.1  nisimura {
    745  1.1  nisimura 	uint32_t bnd;
    746  1.1  nisimura 
    747  1.1  nisimura 	asm volatile("eieio");
    748  1.1  nisimura 	for (bnd = adr + siz; adr < bnd; adr += dcache_line_size)
    749  1.1  nisimura 		asm volatile ("dcbf 0,%0" :: "r"(adr));
    750  1.1  nisimura 	asm volatile ("sync");
    751  1.1  nisimura }
    752  1.1  nisimura 
    753  1.1  nisimura void
    754  1.1  nisimura _inv(uint32_t adr, uint32_t siz)
    755  1.1  nisimura {
    756  1.1  nisimura 	uint32_t bnd, off;
    757  1.1  nisimura 
    758  1.1  nisimura 	off = adr & (dcache_line_size - 1);
    759  1.1  nisimura 	adr -= off;
    760  1.1  nisimura 	siz += off;
    761  1.1  nisimura 	asm volatile ("eieio");
    762  1.1  nisimura 	if (off != 0) {
    763  1.1  nisimura 		/* wbinv() leading unaligned dcache line */
    764  1.1  nisimura 		asm volatile ("dcbf 0,%0" :: "r"(adr));
    765  1.1  nisimura 		if (siz < dcache_line_size)
    766  1.1  nisimura 			goto done;
    767  1.1  nisimura 		adr += dcache_line_size;
    768  1.1  nisimura 		siz -= dcache_line_size;
    769  1.1  nisimura 	}
    770  1.1  nisimura 	bnd = adr + siz;
    771  1.1  nisimura 	off = bnd & (dcache_line_size - 1);
    772  1.1  nisimura 	if (off != 0) {
    773  1.1  nisimura 		/* wbinv() trailing unaligned dcache line */
    774  1.1  nisimura 		asm volatile ("dcbf 0,%0" :: "r"(bnd)); /* it's OK */
    775  1.1  nisimura 		if (siz < dcache_line_size)
    776  1.1  nisimura 			goto done;
    777  1.1  nisimura 		siz -= off;
    778  1.1  nisimura 	}
    779  1.1  nisimura 	for (bnd = adr + siz; adr < bnd; adr += dcache_line_size) {
    780  1.1  nisimura 		/* inv() intermediate dcache lines if ever */
    781  1.1  nisimura 		asm volatile ("dcbi 0,%0" :: "r"(adr));
    782  1.1  nisimura 	}
    783  1.1  nisimura   done:
    784  1.1  nisimura 	asm volatile ("sync");
    785  1.1  nisimura }
    786  1.1  nisimura 
    787  1.1  nisimura static inline uint32_t
    788  1.1  nisimura cputype(void)
    789  1.1  nisimura {
    790  1.1  nisimura 	uint32_t pvr;
    791  1.1  nisimura 
    792  1.1  nisimura 	__asm volatile ("mfpvr %0" : "=r"(pvr));
    793  1.1  nisimura 	return pvr >> 16;
    794  1.1  nisimura }
    795  1.1  nisimura 
    796  1.1  nisimura static inline u_quad_t
    797  1.1  nisimura mftb(void)
    798  1.1  nisimura {
    799  1.1  nisimura 	u_long scratch;
    800  1.1  nisimura 	u_quad_t tb;
    801  1.1  nisimura 
    802  1.1  nisimura 	asm ("1: mftbu %0; mftb %0+1; mftbu %1; cmpw %0,%1; bne 1b"
    803  1.1  nisimura 	    : "=r"(tb), "=r"(scratch));
    804  1.1  nisimura 	return (tb);
    805  1.1  nisimura }
    806  1.1  nisimura 
    807  1.1  nisimura static void
    808  1.1  nisimura init_uart(unsigned base, unsigned speed, uint8_t lcr)
    809  1.1  nisimura {
    810  1.1  nisimura 	unsigned div;
    811  1.1  nisimura 
    812  1.1  nisimura 	div = busclock / speed / 16;
    813  1.1  nisimura 	UART_WRITE(base, LCR, 0x80);		/* turn on DLAB bit */
    814  1.1  nisimura 	UART_WRITE(base, FCR, 0x00);
    815  1.1  nisimura 	UART_WRITE(base, DMB, div >> 8);	/* set speed */
    816  1.1  nisimura 	UART_WRITE(base, DLB, div & 0xff);
    817  1.1  nisimura 	UART_WRITE(base, LCR, lcr);
    818  1.1  nisimura 	UART_WRITE(base, FCR, 0x07);		/* FIFO on, TXRX FIFO reset */
    819  1.1  nisimura 	UART_WRITE(base, IER, 0x00);		/* make sure INT disabled */
    820  1.1  nisimura }
    821  1.1  nisimura 
    822  1.1  nisimura /* talk to satellite processor */
    823  1.1  nisimura static void
    824  1.1  nisimura send_sat(char *msg)
    825  1.1  nisimura {
    826  1.1  nisimura 	unsigned savedbase;
    827  1.1  nisimura 
    828  1.1  nisimura 	savedbase = uart1base;
    829  1.1  nisimura 	uart1base = uart2base;
    830  1.1  nisimura 	while (*msg)
    831  1.1  nisimura 		putchar(*msg++);
    832  1.1  nisimura 	uart1base = savedbase;
    833  1.1  nisimura }
    834  1.1  nisimura 
    835  1.1  nisimura void
    836  1.1  nisimura putchar(int c)
    837  1.1  nisimura {
    838  1.1  nisimura 	unsigned timo, lsr;
    839  1.1  nisimura 
    840  1.1  nisimura 	if (c == '\n')
    841  1.1  nisimura 		putchar('\r');
    842  1.1  nisimura 
    843  1.1  nisimura 	timo = 0x00100000;
    844  1.1  nisimura 	do {
    845  1.1  nisimura 		lsr = UART_READ(uart1base, LSR);
    846  1.1  nisimura 	} while (timo-- > 0 && (lsr & LSR_THRE) == 0);
    847  1.1  nisimura 	if (timo > 0)
    848  1.1  nisimura 		UART_WRITE(uart1base, THR, c);
    849  1.1  nisimura }
    850  1.1  nisimura 
    851  1.1  nisimura unsigned
    852  1.1  nisimura mpc107memsize()
    853  1.1  nisimura {
    854  1.1  nisimura 	unsigned bankn, end, n, tag, val;
    855  1.1  nisimura 
    856  1.1  nisimura 	tag = pcimaketag(0, 0, 0);
    857  1.1  nisimura 
    858  1.1  nisimura 	if (brdtype == BRD_ENCOREPP1) {
    859  1.1  nisimura 		/* the brd's PPCBOOT looks to have erroneous values */
    860  1.1  nisimura 		unsigned tbl[] = {
    861  1.1  nisimura #define MPC106_MEMSTARTADDR1	0x80
    862  1.1  nisimura #define MPC106_EXTMEMSTARTADDR1	0x88
    863  1.1  nisimura #define MPC106_MEMENDADDR1	0x90
    864  1.1  nisimura #define MPC106_EXTMEMENDADDR1	0x98
    865  1.1  nisimura #define MPC106_MEMEN		0xa0
    866  1.1  nisimura #define	BK0_S	0x00000000
    867  1.1  nisimura #define	BK0_E	(128 << 20) - 1
    868  1.1  nisimura #define BK1_S	0x3ff00000
    869  1.1  nisimura #define BK1_E	0x3fffffff
    870  1.1  nisimura #define BK2_S	0x3ff00000
    871  1.1  nisimura #define BK2_E	0x3fffffff
    872  1.1  nisimura #define BK3_S	0x3ff00000
    873  1.1  nisimura #define BK3_E	0x3fffffff
    874  1.1  nisimura #define AR(v, s) ((((v) & SAR_MASK) >> SAR_SHIFT) << (s))
    875  1.1  nisimura #define XR(v, s) ((((v) & EAR_MASK) >> EAR_SHIFT) << (s))
    876  1.1  nisimura #define SAR_MASK 0x0ff00000
    877  1.1  nisimura #define SAR_SHIFT    20
    878  1.1  nisimura #define EAR_MASK 0x30000000
    879  1.1  nisimura #define EAR_SHIFT    28
    880  1.1  nisimura 		AR(BK0_S, 0) | AR(BK1_S, 8) | AR(BK2_S, 16) | AR(BK3_S, 24),
    881  1.1  nisimura 		XR(BK0_S, 0) | XR(BK1_S, 8) | XR(BK2_S, 16) | XR(BK3_S, 24),
    882  1.1  nisimura 		AR(BK0_E, 0) | AR(BK1_E, 8) | AR(BK2_E, 16) | AR(BK3_E, 24),
    883  1.1  nisimura 		XR(BK0_E, 0) | XR(BK1_E, 8) | XR(BK2_E, 16) | XR(BK3_E, 24),
    884  1.1  nisimura 		};
    885  1.1  nisimura 		tag = pcimaketag(0, 0, 0);
    886  1.1  nisimura 		pcicfgwrite(tag, MPC106_MEMSTARTADDR1, tbl[0]);
    887  1.1  nisimura 		pcicfgwrite(tag, MPC106_EXTMEMSTARTADDR1, tbl[1]);
    888  1.1  nisimura 		pcicfgwrite(tag, MPC106_MEMENDADDR1, tbl[2]);
    889  1.1  nisimura 		pcicfgwrite(tag, MPC106_EXTMEMENDADDR1,	tbl[3]);
    890  1.1  nisimura 		pcicfgwrite(tag, MPC106_MEMEN, 1);
    891  1.1  nisimura 	}
    892  1.1  nisimura 
    893  1.1  nisimura 	bankn = 0;
    894  1.1  nisimura 	val = pcicfgread(tag, MPC106_MEMEN);
    895  1.1  nisimura 	for (n = 0; n < 4; n++) {
    896  1.1  nisimura 		if ((val & (1U << n)) == 0)
    897  1.1  nisimura 			break;
    898  1.1  nisimura 		bankn = n;
    899  1.1  nisimura 	}
    900  1.1  nisimura 	bankn = bankn * 8;
    901  1.1  nisimura 
    902  1.1  nisimura 	val = pcicfgread(tag, MPC106_EXTMEMENDADDR1);
    903  1.1  nisimura 	end =  ((val >> bankn) & 0x03) << 28;
    904  1.1  nisimura 	val = pcicfgread(tag, MPC106_MEMENDADDR1);
    905  1.1  nisimura 	end |= ((val >> bankn) & 0xff) << 20;
    906  1.1  nisimura 	end |= 0xfffff;
    907  1.1  nisimura 
    908  1.1  nisimura 	return (end + 1); /* assume the end address matches total amount */
    909  1.1  nisimura }
    910  1.1  nisimura 
    911  1.1  nisimura struct fis_dir_entry {
    912  1.1  nisimura 	char		name[16];
    913  1.1  nisimura 	uint32_t	startaddr;
    914  1.1  nisimura 	uint32_t	loadaddr;
    915  1.1  nisimura 	uint32_t	flashsize;
    916  1.1  nisimura 	uint32_t	entryaddr;
    917  1.1  nisimura 	uint32_t	filesize;
    918  1.1  nisimura 	char		pad[256 - (16 + 5 * sizeof(uint32_t))];
    919  1.1  nisimura };
    920  1.1  nisimura 
    921  1.1  nisimura #define FIS_LOWER_LIMIT	0xfff00000
    922  1.1  nisimura 
    923  1.1  nisimura /*
    924  1.1  nisimura  * Look for a Redboot-style Flash Image System FIS-directory and
    925  1.1  nisimura  * return a pointer to the start address of the requested file.
    926  1.1  nisimura  */
    927  1.1  nisimura static void *
    928  1.1  nisimura redboot_fis_lookup(const char *filename)
    929  1.1  nisimura {
    930  1.1  nisimura 	static const char FISdirname[16] = {
    931  1.1  nisimura 	    'F', 'I', 'S', ' ',
    932  1.1  nisimura 	    'd', 'i', 'r', 'e', 'c', 't', 'o', 'r', 'y', 0, 0, 0
    933  1.1  nisimura 	};
    934  1.1  nisimura 	struct fis_dir_entry *dir;
    935  1.1  nisimura 
    936  1.1  nisimura 	/*
    937  1.1  nisimura 	 * The FIS directory is usually in the last sector of the flash.
    938  1.1  nisimura 	 * But we do not know the sector size (erase size), so start
    939  1.1  nisimura 	 * at 0xffffff00 and scan backwards in steps of the FIS directory
    940  1.1  nisimura 	 * entry size (0x100).
    941  1.1  nisimura 	 */
    942  1.1  nisimura 	for (dir = (struct fis_dir_entry *)0xffffff00;
    943  1.1  nisimura 	    (uint32_t)dir >= FIS_LOWER_LIMIT; dir--)
    944  1.1  nisimura 		if (memcmp(dir->name, FISdirname, sizeof(FISdirname)) == 0)
    945  1.1  nisimura 			break;
    946  1.1  nisimura 	if ((uint32_t)dir < FIS_LOWER_LIMIT) {
    947  1.1  nisimura 		printf("No FIS directory found!\n");
    948  1.1  nisimura 		return NULL;
    949  1.1  nisimura 	}
    950  1.1  nisimura 
    951  1.1  nisimura 	/* Now find filename by scanning the directory from beginning. */
    952  1.1  nisimura 	dir = (struct fis_dir_entry *)dir->startaddr;
    953  1.1  nisimura 	while (dir->name[0] != 0xff && (uint32_t)dir < 0xffffff00) {
    954  1.1  nisimura 		if (strcmp(dir->name, filename) == 0)
    955  1.1  nisimura 			return (void *)dir->startaddr;	/* found */
    956  1.1  nisimura 		dir++;
    957  1.1  nisimura 	}
    958  1.1  nisimura 	printf("\"%s\" not found in FIS directory!\n", filename);
    959  1.1  nisimura 	return NULL;
    960  1.1  nisimura }
    961  1.1  nisimura 
    962  1.6       phx static uint8_t hex2nibble(char c)
    963  1.6       phx {
    964  1.6       phx 	if (c >= 'a')
    965  1.6       phx 		c &= ~0x20;
    966  1.6       phx 	return c > '9' ? c - 'A' + 10 : c - '0';
    967  1.6       phx }
    968  1.6       phx 
    969  1.6       phx static void
    970  1.6       phx read_mac_string(uint8_t *mac, char *p)
    971  1.6       phx {
    972  1.6       phx 	int i;
    973  1.6       phx 
    974  1.6       phx 	for (i = 0; i < 6; i++, p += 3)
    975  1.6       phx 		*mac++ = (hex2nibble(p[0]) << 4) | hex2nibble(p[1]);
    976  1.6       phx }
    977  1.6       phx 
    978  1.1  nisimura /*
    979  1.1  nisimura  * For cost saving reasons some NAS boxes are missing the ROM for the
    980  1.1  nisimura  * NIC's ethernet address and keep it in their Flash memory.
    981  1.1  nisimura  */
    982  1.1  nisimura void
    983  1.1  nisimura read_mac_from_flash(uint8_t *mac)
    984  1.1  nisimura {
    985  1.1  nisimura 	uint8_t *p;
    986  1.1  nisimura 
    987  1.1  nisimura 	if (brdtype == BRD_SYNOLOGY) {
    988  1.1  nisimura 		p = redboot_fis_lookup("vendor");
    989  1.1  nisimura 		if (p != NULL) {
    990  1.1  nisimura 			memcpy(mac, p, 6);
    991  1.1  nisimura 			return;
    992  1.1  nisimura 		}
    993  1.6       phx 	} else if (brdtype == BRD_DLINKDSM) {
    994  1.6       phx 		read_mac_string(mac, (char *)0xfff0ff80);
    995  1.6       phx 		return;
    996  1.6       phx 	}
    997  1.6       phx 	else
    998  1.1  nisimura 		printf("Warning: This board has no known method defined "
    999  1.1  nisimura 		    "to determine its MAC address!\n");
   1000  1.1  nisimura 
   1001  1.1  nisimura 	/* set to 00:00:00:00:00:00 in case of error */
   1002  1.1  nisimura 	memset(mac, 0, 6);
   1003  1.1  nisimura }
   1004