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