Home | History | Annotate | Line # | Download | only in sociox
if_scx.c revision 1.3
      1  1.3  nisimura /*	$NetBSD: if_scx.c,v 1.3 2020/03/23 04:34:16 nisimura Exp $	*/
      2  1.1  nisimura 
      3  1.1  nisimura /*-
      4  1.1  nisimura  * Copyright (c) 2020 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 #define NOT_MP_SAFE	0
     33  1.1  nisimura 
     34  1.1  nisimura /*
     35  1.1  nisimura  * Socionext SC2A11 SynQuacer NetSec GbE driver
     36  1.1  nisimura  *
     37  1.1  nisimura  *   (possibly incorrect notes to be removed eventually)
     38  1.1  nisimura  * - 32 byte descriptor for 64 bit paddr design.
     39  1.1  nisimura  * - multiple rings seems available. There are special descriptor fields
     40  1.1  nisimura  *   to designify ring number from which to arrive or to which go.
     41  1.1  nisimura  * - memory mapped EEPROM to hold MAC address. The rest of the area is
     42  1.1  nisimura  *   occupied by a set of ucode for two DMA engines and one packet engine.
     43  1.1  nisimura  * - The size of frame address filter is unknown. Might be 32
     44  1.1  nisimura  * - The first slot is my own station address. Always enabled to perform
     45  1.1  nisimura  *   to identify oneself.
     46  1.1  nisimura  * - 1~31 are for supplimental MAC addresses. Independently enabled
     47  1.1  nisimura  *   for use. Good to catch multicast. Byte-wise selective match available.
     48  1.1  nisimura  *   Use to catch { 0x01, 0x00, 0x00 } and/or { 0x33, 0x33 }.
     49  1.1  nisimura  * - The size of multicast hash filter store is unknown. Might be 256 bit.
     50  1.1  nisimura  */
     51  1.1  nisimura 
     52  1.1  nisimura #include <sys/cdefs.h>
     53  1.3  nisimura __KERNEL_RCSID(0, "$NetBSD: if_scx.c,v 1.3 2020/03/23 04:34:16 nisimura Exp $");
     54  1.1  nisimura 
     55  1.1  nisimura #include <sys/param.h>
     56  1.1  nisimura #include <sys/bus.h>
     57  1.1  nisimura #include <sys/intr.h>
     58  1.1  nisimura #include <sys/device.h>
     59  1.1  nisimura #include <sys/callout.h>
     60  1.1  nisimura #include <sys/mbuf.h>
     61  1.1  nisimura #include <sys/malloc.h>
     62  1.1  nisimura #include <sys/errno.h>
     63  1.1  nisimura #include <sys/rndsource.h>
     64  1.1  nisimura #include <sys/kernel.h>
     65  1.1  nisimura #include <sys/systm.h>
     66  1.1  nisimura 
     67  1.1  nisimura #include <net/if.h>
     68  1.1  nisimura #include <net/if_media.h>
     69  1.1  nisimura #include <net/if_dl.h>
     70  1.1  nisimura #include <net/if_ether.h>
     71  1.1  nisimura #include <dev/mii/mii.h>
     72  1.1  nisimura #include <dev/mii/miivar.h>
     73  1.1  nisimura #include <net/bpf.h>
     74  1.1  nisimura 
     75  1.1  nisimura #include <dev/fdt/fdtvar.h>
     76  1.1  nisimura #include <dev/acpi/acpireg.h>
     77  1.1  nisimura #include <dev/acpi/acpivar.h>
     78  1.1  nisimura #include <dev/acpi/acpi_intr.h>
     79  1.1  nisimura 
     80  1.1  nisimura #define SWRESET		0x104
     81  1.1  nisimura #define COMINIT		0x120
     82  1.1  nisimura #define INTRST		0x200
     83  1.1  nisimura #define  IRQ_RX		(1U<<1)
     84  1.1  nisimura #define  IRQ_TX		(1U<<0)
     85  1.1  nisimura #define INTREN		0x204
     86  1.1  nisimura #define INTR_SET	0x234
     87  1.1  nisimura #define INTR_CLR	0x238
     88  1.1  nisimura #define TXINTST		0x400
     89  1.1  nisimura #define TXINTEN		0x404
     90  1.1  nisimura #define TXINT_SET	0x428
     91  1.1  nisimura #define TXINT_CLR	0x42c
     92  1.1  nisimura #define  TXI_NTOWNR	(1U<<17)
     93  1.1  nisimura #define  TXI_TR_ERR	(1U<<16)
     94  1.1  nisimura #define  TXI_TXDONE	(1U<<15)
     95  1.1  nisimura #define  TXI_TMREXP	(1U<<14)
     96  1.1  nisimura #define RXINTST		0x440
     97  1.1  nisimura #define RXINTEN		0x444
     98  1.1  nisimura #define RXINT_SET	0x468
     99  1.1  nisimura #define RXINT_CLR	0x46c
    100  1.1  nisimura #define  RXI_RC_ERR	(1U<<16)
    101  1.1  nisimura #define  RXI_PKTCNT	(1U<<15)
    102  1.1  nisimura #define  RXI_TMREXP	(1U<<14)
    103  1.1  nisimura #define TXTIMER		0x41c
    104  1.1  nisimura #define RXTIMER		0x45c
    105  1.1  nisimura #define TXCOUNT		0x410
    106  1.1  nisimura #define RXCOUNT		0x454
    107  1.3  nisimura #define H2MENG		0x210		/* DMAC host2media ucode port */
    108  1.3  nisimura #define M2HENG		0x21c		/* DMAC media2host ucode port */
    109  1.1  nisimura #define PKTENG		0x0d0		/* packet engine ucode port */
    110  1.1  nisimura #define HWVER0		0x22c
    111  1.1  nisimura #define HWVER1		0x230
    112  1.1  nisimura 
    113  1.1  nisimura #define MACSTAT		0x1024		/* gmac status */
    114  1.1  nisimura #define MACDATA		0x11c0		/* gmac rd/wr data */
    115  1.1  nisimura #define MACCMD		0x11c4		/* gmac operation */
    116  1.1  nisimura #define  CMD_IOWR	(1U<<28)	/* write op */
    117  1.1  nisimura #define  CMD_BUSY	(1U<<31)	/* busy bit */
    118  1.1  nisimura #define DESCENG_INIT	0x11fc
    119  1.1  nisimura #define DESCENG_SRST	0x1204
    120  1.1  nisimura 
    121  1.1  nisimura #define GMACMCR		0x0000		/* MAC configuration */
    122  1.1  nisimura #define  MCR_IBN	(1U<<30)	/* */
    123  1.1  nisimura #define  MCR_CST	(1U<<25)	/* strip CRC */
    124  1.1  nisimura #define  MCR_TC		(1U<<24)	/* keep RGMII PHY notified */
    125  1.3  nisimura #define  MCR_JE		(1U<<20)	/* ignore oversized >9018 condition */
    126  1.1  nisimura #define  MCR_USEMII	(1U<<15)	/* 1: RMII/MII, 0: RGMII */
    127  1.1  nisimura #define  MCR_SPD100	(1U<<14)	/* force speed 100 */
    128  1.1  nisimura #define  MCR_USEFDX	(1U<<11)	/* force full duplex */
    129  1.1  nisimura #define  MCR_IPCKEN	(1U<<10)	/* handle checksum */
    130  1.1  nisimura #define  MCR_ACS	(1U<<7)		/* auto pad CRC strip */
    131  1.1  nisimura #define  MCR_TXE	(1U<<3)		/* start Tx DMA engine */
    132  1.1  nisimura #define  MCR_RXE	(1U<<2)		/* start Rx DMA engine */
    133  1.1  nisimura #define  _MCR_FDX	0x0000280c	/* XXX TBD */
    134  1.1  nisimura #define  _MCR_HDX	0x0001a00c	/* XXX TBD */
    135  1.1  nisimura #define GMACAFR		0x0004		/* frame DA/SA address filter */
    136  1.2  nisimura #define  AFR_RA		(1U<<31)	/* receive block all on */
    137  1.1  nisimura #define  AFR_HPF	(1U<<10)	/* activate hash or perfect filter */
    138  1.1  nisimura #define  AFR_SAF	(1U<<9)		/* source address filter */
    139  1.1  nisimura #define  AFR_SAIF	(1U<<8)		/* SA inverse filtering */
    140  1.1  nisimura #define  AFR_PCF	(3U<<6)		/* */
    141  1.1  nisimura #define  AFR_RB		(1U<<5)		/* reject broadcast frame */
    142  1.1  nisimura #define  AFR_AM		(1U<<4)		/* accept all multicast frame */
    143  1.1  nisimura #define  AFR_DAIF	(1U<<3)		/* DA inverse filtering */
    144  1.1  nisimura #define  AFR_MHTE	(1U<<2)		/* use multicast hash table */
    145  1.1  nisimura #define  AFR_UHTE	(1U<<1)		/* use additional MAC addresses */
    146  1.1  nisimura #define  AFR_PM		(1U<<0)		/* run promisc mode */
    147  1.1  nisimura #define  _AFR		0x80000001	/* XXX TBD */
    148  1.1  nisimura #define GMACMHTH	0x0008		/* XXX multicast hash table 63:32 */
    149  1.1  nisimura #define GMACMHTL	0x000c		/* XXX multicast hash table 31:0 */
    150  1.1  nisimura #define GMACGAR		0x0010		/* MDIO operation */
    151  1.1  nisimura #define  GAR_PHY	(11)		/* mii phy 15:11 */
    152  1.1  nisimura #define  GAR_REG	(6)		/* mii reg 10:6 */
    153  1.1  nisimura #define  GAR_CTL	(2)		/* control 5:2 */
    154  1.1  nisimura #define  GAR_IOWR	(1U<<1)		/* MDIO write op */
    155  1.1  nisimura #define  GAR_BUSY	(1U)		/* busy bit */
    156  1.1  nisimura #define GMACGDR		0x0014		/* MDIO rd/wr data */
    157  1.1  nisimura #define GMACFCR		0x0018		/* 802.3x flowcontrol */
    158  1.1  nisimura #define  FCR_RFE	(1U<<2)		/* accept PAUSE to throttle Tx */
    159  1.1  nisimura #define  FCR_TFE	(1U<<1)		/* generate PAUSE to moderate Rx lvl */
    160  1.3  nisimura #define GMACIMPL	0x0020		/* implementation number XXXX.YYYY */
    161  1.1  nisimura #define GMACVTAG	0x001c		/* VLAN tag control */
    162  1.1  nisimura #define GMACMAH0	0x0040		/* MAC address 0 47:32 */
    163  1.1  nisimura #define GMACMAL0	0x0044		/* MAC address 0 31:0 */
    164  1.2  nisimura #define GMACMAH(i) 	((i)*8+0x40)	/* supplimental MAC addr 1 - 15 */
    165  1.1  nisimura #define GMACMAL(i) 	((i)*8+0x44)
    166  1.2  nisimura #define GMACMHT0	0x0500		/* multicast hash table 0 - 8*/
    167  1.2  nisimura 
    168  1.3  nisimura #define GMACBMR		0x1000		/* DMA bus mode control
    169  1.1  nisimura 					 * 24    4PBL
    170  1.1  nisimura 					 * 22:17 RPBL
    171  1.1  nisimura 					 * 16    fix burst
    172  1.1  nisimura 					 * 15:14 priority between Rx and Tx
    173  1.1  nisimura 					 *  3    rxtx41
    174  1.1  nisimura 					 *  2    rxtx31
    175  1.1  nisimura 					 *  1    rxtx21
    176  1.1  nisimura 					 *  0    rxtx11
    177  1.1  nisimura 					 * 13:8  PBL possible DMA burst len
    178  1.1  nisimura 					 * 0     reset op. self clear
    179  1.1  nisimura 					 */
    180  1.1  nisimura #define  _BMR		0x00412080	/* XXX TBD */
    181  1.1  nisimura #define  _BMR0		0x00020181	/* XXX TBD */
    182  1.1  nisimura #define  BMR_RST	(1U<<0)		/* reset op. self clear when done */
    183  1.1  nisimura #define GMACRDLAR	0x100c		/* */
    184  1.1  nisimura #define  _RDLAR		0x18000		/* XXX TBD */
    185  1.1  nisimura #define GMACTDLAR	0x1010		/* */
    186  1.1  nisimura #define  _TDLAR		0x1c000		/* XXX TBD */
    187  1.1  nisimura #define GMACOMR		0x1018		/* DMA operation */
    188  1.3  nisimura #define  OMR_TXE	(1U<<13)	/* start Tx DMA engine, 0 to stop */
    189  1.3  nisimura #define  OMR_RXE	(1U<<1)		/* start Rx DMA engine, 0 to stop */
    190  1.1  nisimura 
    191  1.1  nisimura const struct {
    192  1.1  nisimura 	uint16_t freq, bit; /* GAR 5:2 MDIO frequency selection */
    193  1.1  nisimura } garclk[] = {
    194  1.1  nisimura 	{ 35,	2 },	/* 25-35 MHz */
    195  1.1  nisimura 	{ 60,	3 },	/* 35-60 MHz */
    196  1.1  nisimura 	{ 100,	0 },	/* 60-100 MHz */
    197  1.1  nisimura 	{ 150,	1 },	/* 100-150 MHz */
    198  1.1  nisimura 	{ 250,	4 },	/* 150-250 MHz */
    199  1.1  nisimura 	{ 300,	5 },	/* 250-300 MHz */
    200  1.1  nisimura 	{ 0 },
    201  1.1  nisimura };
    202  1.1  nisimura static int get_garclk(uint32_t);
    203  1.1  nisimura 
    204  1.1  nisimura /* descriptor format definition */
    205  1.1  nisimura struct tdes {
    206  1.1  nisimura 	uint32_t t0, t1, t2, t3;
    207  1.1  nisimura };
    208  1.1  nisimura 
    209  1.1  nisimura struct rdes {
    210  1.1  nisimura 	uint32_t r0, r1, r2, r3;
    211  1.1  nisimura };
    212  1.1  nisimura 
    213  1.1  nisimura #define T0_OWN		(1U<<31)	/* desc is ready to Tx */
    214  1.1  nisimura #define T0_EOD		(1U<<30)	/* end of descriptor array */
    215  1.1  nisimura #define T0_DRID		(24)		/* 29:24 DRID */
    216  1.1  nisimura #define T0_PT		(1U<<21)	/* 23:21 PT */
    217  1.1  nisimura #define T0_TRID		(16)		/* 20:16 TRID */
    218  1.1  nisimura #define T0_FS		(1U<<9)		/* first segment of frame */
    219  1.1  nisimura #define T0_LS		(1U<<8)		/* last segment of frame */
    220  1.1  nisimura #define T0_CSUM		(1U<<7)		/* enable check sum offload */
    221  1.1  nisimura #define T0_SGOL		(1U<<6)		/* enable TCP segment offload */
    222  1.1  nisimura #define T0_TRS		(1U<<4)		/* 5:4 TRS */
    223  1.1  nisimura #define T0_IOC		(0)		/* XXX TBD interrupt when completed */
    224  1.1  nisimura /* T1 segment address 63:32 */
    225  1.1  nisimura /* T2 segment address 31:0 */
    226  1.1  nisimura /* T3 31:16 TCP segment length, 15:0 segment length to transmit */
    227  1.1  nisimura #define R0_OWN		(1U<<31)	/* desc is empty */
    228  1.1  nisimura #define R0_EOD		(1U<<30)	/* end of descriptor array */
    229  1.1  nisimura #define R0_SRID		(24)		/* 29:24 SRID */
    230  1.1  nisimura #define R0_FR		(1U<<23)	/* FR */
    231  1.1  nisimura #define R0_ER		(1U<<21)	/* Rx error indication */
    232  1.1  nisimura #define R0_ERR		(3U<<16)	/* 18:16 receive error code */
    233  1.1  nisimura #define R0_TDRID	(14)		/* 15:14 TDRID */
    234  1.1  nisimura #define R0_FS		(1U<<9)		/* first segment of frame */
    235  1.1  nisimura #define R0_LS		(1U<<8)		/* last segment of frame */
    236  1.1  nisimura #define R0_CSUM		(3U<<6)		/* 7:6 checksum status */
    237  1.1  nisimura #define R0_CERR		(2U<<6)		/* 0 (undone), 1 (found ok), 2 (bad) */
    238  1.1  nisimura /* R1 frame address 63:32 */
    239  1.1  nisimura /* R2 frame address 31:0 */
    240  1.1  nisimura /* R3 31:16 received frame length, 15:0 buffer length to receive */
    241  1.1  nisimura 
    242  1.1  nisimura #define SCX_NTXSEGS		16
    243  1.1  nisimura #define SCX_TXQUEUELEN		16
    244  1.1  nisimura #define SCX_TXQUEUELEN_MASK	(SCX_TXQUEUELEN - 1)
    245  1.1  nisimura #define SCX_TXQUEUE_GC		(SCX_TXQUEUELEN / 4)
    246  1.1  nisimura #define SCX_NTXDESC		(SCX_TXQUEUELEN * SCX_NTXSEGS)
    247  1.1  nisimura #define SCX_NTXDESC_MASK	(SCX_NTXDESC - 1)
    248  1.1  nisimura #define SCX_NEXTTX(x)		(((x) + 1) & SCX_NTXDESC_MASK)
    249  1.1  nisimura #define SCX_NEXTTXS(x)		(((x) + 1) & SCX_TXQUEUELEN_MASK)
    250  1.1  nisimura 
    251  1.1  nisimura #define SCX_NRXDESC		64
    252  1.1  nisimura #define SCX_NRXDESC_MASK	(SCX_NRXDESC - 1)
    253  1.1  nisimura #define SCX_NEXTRX(x)		(((x) + 1) & SCX_NRXDESC_MASK)
    254  1.1  nisimura 
    255  1.1  nisimura #define SCX_INIT_RXDESC(sc, x)						\
    256  1.1  nisimura do {									\
    257  1.1  nisimura 	struct scx_rxsoft *__rxs = &(sc)->sc_rxsoft[(x)];		\
    258  1.1  nisimura 	struct rdes *__rxd = &(sc)->sc_rxdescs[(x)];			\
    259  1.1  nisimura 	struct mbuf *__m = __rxs->rxs_mbuf;				\
    260  1.1  nisimura 	bus_addr_t __paddr =__rxs->rxs_dmamap->dm_segs[0].ds_addr;	\
    261  1.1  nisimura 	__m->m_data = __m->m_ext.ext_buf;				\
    262  1.1  nisimura 	__rxd->r3 = __rxs->rxs_dmamap->dm_segs[0].ds_len;		\
    263  1.1  nisimura 	__rxd->r2 = htole32(BUS_ADDR_LO32(__paddr));			\
    264  1.1  nisimura 	__rxd->r1 = htole32(BUS_ADDR_HI32(__paddr));			\
    265  1.1  nisimura 	__rxd->r0 = R0_OWN | R0_FS | R0_LS;				\
    266  1.1  nisimura 	if ((x) == SCX_NRXDESC - 1) __rxd->r0 |= R0_EOD;		\
    267  1.1  nisimura } while (/*CONSTCOND*/0)
    268  1.1  nisimura 
    269  1.1  nisimura struct control_data {
    270  1.1  nisimura 	struct tdes cd_txdescs[SCX_NTXDESC];
    271  1.1  nisimura 	struct rdes cd_rxdescs[SCX_NRXDESC];
    272  1.1  nisimura };
    273  1.1  nisimura #define SCX_CDOFF(x)		offsetof(struct control_data, x)
    274  1.1  nisimura #define SCX_CDTXOFF(x)		SCX_CDOFF(cd_txdescs[(x)])
    275  1.1  nisimura #define SCX_CDRXOFF(x)		SCX_CDOFF(cd_rxdescs[(x)])
    276  1.1  nisimura 
    277  1.1  nisimura struct scx_txsoft {
    278  1.1  nisimura 	struct mbuf *txs_mbuf;		/* head of our mbuf chain */
    279  1.1  nisimura 	bus_dmamap_t txs_dmamap;	/* our DMA map */
    280  1.1  nisimura 	int txs_firstdesc;		/* first descriptor in packet */
    281  1.1  nisimura 	int txs_lastdesc;		/* last descriptor in packet */
    282  1.1  nisimura 	int txs_ndesc;			/* # of descriptors used */
    283  1.1  nisimura };
    284  1.1  nisimura 
    285  1.1  nisimura struct scx_rxsoft {
    286  1.1  nisimura 	struct mbuf *rxs_mbuf;		/* head of our mbuf chain */
    287  1.1  nisimura 	bus_dmamap_t rxs_dmamap;	/* our DMA map */
    288  1.1  nisimura };
    289  1.1  nisimura 
    290  1.1  nisimura struct scx_softc {
    291  1.1  nisimura 	device_t sc_dev;		/* generic device information */
    292  1.1  nisimura 	bus_space_tag_t sc_st;		/* bus space tag */
    293  1.1  nisimura 	bus_space_handle_t sc_sh;	/* bus space handle */
    294  1.1  nisimura 	bus_size_t sc_sz;		/* csr map size */
    295  1.1  nisimura 	bus_space_handle_t sc_eesh;	/* eeprom section handle */
    296  1.1  nisimura 	bus_size_t sc_eesz;		/* eeprom map size */
    297  1.1  nisimura 	bus_dma_tag_t sc_dmat;		/* bus DMA tag */
    298  1.1  nisimura 	struct ethercom sc_ethercom;	/* Ethernet common data */
    299  1.1  nisimura 	struct mii_data sc_mii;		/* MII */
    300  1.1  nisimura 	callout_t sc_tick_ch;		/* PHY monitor callout */
    301  1.1  nisimura 	bus_dma_segment_t sc_seg;	/* descriptor store seg */
    302  1.1  nisimura 	int sc_nseg;			/* descriptor store nseg */
    303  1.3  nisimura 	void *sc_ih;			/* interrupt cookie */
    304  1.1  nisimura 	int sc_phy_id;			/* PHY address */
    305  1.3  nisimura 	int sc_flowflags;		/* 802.3x PAUSE flow control */
    306  1.1  nisimura 	uint32_t sc_gar;		/* GAR 5:2 clock selection */
    307  1.3  nisimura 	uint32_t sc_t0coso;		/* T0_CSUM | T0_SGOL to run */
    308  1.3  nisimura 	int sc_ucodeloaded;		/* ucode for H2M/M2H/PKT */
    309  1.1  nisimura 	int sc_phandle;			/* fdt phandle */
    310  1.1  nisimura 
    311  1.1  nisimura 	bus_dmamap_t sc_cddmamap;	/* control data DMA map */
    312  1.1  nisimura #define sc_cddma	sc_cddmamap->dm_segs[0].ds_addr
    313  1.1  nisimura 
    314  1.1  nisimura 	struct control_data *sc_control_data;
    315  1.1  nisimura #define sc_txdescs	sc_control_data->cd_txdescs
    316  1.1  nisimura #define sc_rxdescs	sc_control_data->cd_rxdescs
    317  1.1  nisimura 
    318  1.1  nisimura 	struct scx_txsoft sc_txsoft[SCX_TXQUEUELEN];
    319  1.1  nisimura 	struct scx_rxsoft sc_rxsoft[SCX_NRXDESC];
    320  1.1  nisimura 	int sc_txfree;			/* number of free Tx descriptors */
    321  1.1  nisimura 	int sc_txnext;			/* next ready Tx descriptor */
    322  1.1  nisimura 	int sc_txsfree;			/* number of free Tx jobs */
    323  1.1  nisimura 	int sc_txsnext;			/* next ready Tx job */
    324  1.1  nisimura 	int sc_txsdirty;		/* dirty Tx jobs */
    325  1.1  nisimura 	int sc_rxptr;			/* next ready Rx descriptor/descsoft */
    326  1.1  nisimura 
    327  1.1  nisimura 	krndsource_t rnd_source;	/* random source */
    328  1.1  nisimura };
    329  1.1  nisimura 
    330  1.1  nisimura #define SCX_CDTXADDR(sc, x)	((sc)->sc_cddma + SCX_CDTXOFF((x)))
    331  1.1  nisimura #define SCX_CDRXADDR(sc, x)	((sc)->sc_cddma + SCX_CDRXOFF((x)))
    332  1.1  nisimura 
    333  1.1  nisimura #define SCX_CDTXSYNC(sc, x, n, ops)					\
    334  1.1  nisimura do {									\
    335  1.1  nisimura 	int __x, __n;							\
    336  1.1  nisimura 									\
    337  1.1  nisimura 	__x = (x);							\
    338  1.1  nisimura 	__n = (n);							\
    339  1.1  nisimura 									\
    340  1.1  nisimura 	/* If it will wrap around, sync to the end of the ring. */	\
    341  1.1  nisimura 	if ((__x + __n) > SCX_NTXDESC) {				\
    342  1.1  nisimura 		bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap,	\
    343  1.1  nisimura 		    SCX_CDTXOFF(__x), sizeof(struct tdes) *		\
    344  1.1  nisimura 		    (SCX_NTXDESC - __x), (ops));			\
    345  1.1  nisimura 		__n -= (SCX_NTXDESC - __x);				\
    346  1.1  nisimura 		__x = 0;						\
    347  1.1  nisimura 	}								\
    348  1.1  nisimura 									\
    349  1.1  nisimura 	/* Now sync whatever is left. */				\
    350  1.1  nisimura 	bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap,		\
    351  1.1  nisimura 	    SCX_CDTXOFF(__x), sizeof(struct tdes) * __n, (ops));	\
    352  1.1  nisimura } while (/*CONSTCOND*/0)
    353  1.1  nisimura 
    354  1.1  nisimura #define SCX_CDRXSYNC(sc, x, ops)					\
    355  1.1  nisimura do {									\
    356  1.1  nisimura 	bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap,		\
    357  1.1  nisimura 	    SCX_CDRXOFF((x)), sizeof(struct rdes), (ops));		\
    358  1.1  nisimura } while (/*CONSTCOND*/0)
    359  1.1  nisimura 
    360  1.1  nisimura static int scx_fdt_match(device_t, cfdata_t, void *);
    361  1.1  nisimura static void scx_fdt_attach(device_t, device_t, void *);
    362  1.1  nisimura static int scx_acpi_match(device_t, cfdata_t, void *);
    363  1.1  nisimura static void scx_acpi_attach(device_t, device_t, void *);
    364  1.1  nisimura 
    365  1.1  nisimura CFATTACH_DECL_NEW(scx_fdt, sizeof(struct scx_softc),
    366  1.1  nisimura     scx_fdt_match, scx_fdt_attach, NULL, NULL);
    367  1.1  nisimura 
    368  1.1  nisimura CFATTACH_DECL_NEW(scx_acpi, sizeof(struct scx_softc),
    369  1.1  nisimura     scx_acpi_match, scx_acpi_attach, NULL, NULL);
    370  1.1  nisimura 
    371  1.1  nisimura static void scx_attach_i(struct scx_softc *);
    372  1.1  nisimura static void scx_reset(struct scx_softc *);
    373  1.1  nisimura static int scx_init(struct ifnet *);
    374  1.1  nisimura static void scx_start(struct ifnet *);
    375  1.1  nisimura static void scx_stop(struct ifnet *, int);
    376  1.1  nisimura static void scx_watchdog(struct ifnet *);
    377  1.1  nisimura static int scx_ioctl(struct ifnet *, u_long, void *);
    378  1.1  nisimura static void scx_set_rcvfilt(struct scx_softc *);
    379  1.1  nisimura static int scx_ifmedia_upd(struct ifnet *);
    380  1.1  nisimura static void scx_ifmedia_sts(struct ifnet *, struct ifmediareq *);
    381  1.1  nisimura static void mii_statchg(struct ifnet *);
    382  1.1  nisimura static void phy_tick(void *);
    383  1.1  nisimura static int mii_readreg(device_t, int, int, uint16_t *);
    384  1.1  nisimura static int mii_writereg(device_t, int, int, uint16_t);
    385  1.1  nisimura static int scx_intr(void *);
    386  1.1  nisimura static void txreap(struct scx_softc *);
    387  1.1  nisimura static void rxintr(struct scx_softc *);
    388  1.1  nisimura static int add_rxbuf(struct scx_softc *, int);
    389  1.1  nisimura static int spin_waitfor(struct scx_softc *, int, int);
    390  1.1  nisimura static int mac_read(struct scx_softc *, int);
    391  1.1  nisimura static void mac_write(struct scx_softc *, int, int);
    392  1.1  nisimura static void loaducode(struct scx_softc *);
    393  1.2  nisimura static void injectucode(struct scx_softc *, int, bus_addr_t, bus_size_t);
    394  1.1  nisimura 
    395  1.1  nisimura #define CSR_READ(sc,off) \
    396  1.1  nisimura 	    bus_space_read_4((sc)->sc_st, (sc)->sc_sh, (off))
    397  1.1  nisimura #define CSR_WRITE(sc,off,val) \
    398  1.1  nisimura 	    bus_space_write_4((sc)->sc_st, (sc)->sc_sh, (off), (val))
    399  1.1  nisimura #define EE_READ(sc,off) \
    400  1.1  nisimura 	    bus_space_read_4((sc)->sc_st, (sc)->sc_eesh, (off))
    401  1.1  nisimura 
    402  1.1  nisimura static int
    403  1.1  nisimura scx_fdt_match(device_t parent, cfdata_t cf, void *aux)
    404  1.1  nisimura {
    405  1.1  nisimura 	static const char * compatible[] = {
    406  1.1  nisimura 		"socionext,synquacer-netsec",
    407  1.1  nisimura 		NULL
    408  1.1  nisimura 	};
    409  1.1  nisimura 	struct fdt_attach_args * const faa = aux;
    410  1.1  nisimura 
    411  1.1  nisimura 	return of_match_compatible(faa->faa_phandle, compatible);
    412  1.1  nisimura }
    413  1.1  nisimura 
    414  1.1  nisimura static void
    415  1.1  nisimura scx_fdt_attach(device_t parent, device_t self, void *aux)
    416  1.1  nisimura {
    417  1.1  nisimura 	struct scx_softc * const sc = device_private(self);
    418  1.1  nisimura 	struct fdt_attach_args * const faa = aux;
    419  1.1  nisimura 	const int phandle = faa->faa_phandle;
    420  1.1  nisimura 	bus_space_tag_t bst = faa->faa_bst;
    421  1.1  nisimura 	bus_space_handle_t bsh;
    422  1.1  nisimura 	bus_space_handle_t eebsh;
    423  1.2  nisimura 	bus_addr_t addr[2];
    424  1.2  nisimura 	bus_size_t size[2];
    425  1.1  nisimura 	char intrstr[128];
    426  1.1  nisimura 
    427  1.2  nisimura 	if (fdtbus_get_reg(phandle, 0, addr+0, size+0) != 0
    428  1.2  nisimura 	    || bus_space_map(faa->faa_bst, addr[0], size[0], 0, &bsh) != 0) {
    429  1.1  nisimura 		aprint_error(": unable to map device csr\n");
    430  1.1  nisimura 		return;
    431  1.1  nisimura 	}
    432  1.1  nisimura 	if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
    433  1.1  nisimura 		aprint_error(": failed to decode interrupt\n");
    434  1.1  nisimura 		goto fail;
    435  1.1  nisimura 	}
    436  1.1  nisimura 	sc->sc_ih = fdtbus_intr_establish(phandle, 0, IPL_NET,
    437  1.1  nisimura 		NOT_MP_SAFE, scx_intr, sc);
    438  1.1  nisimura 	if (sc->sc_ih == NULL) {
    439  1.1  nisimura 		aprint_error_dev(self, "couldn't establish interrupt\n");
    440  1.1  nisimura 		goto fail;
    441  1.1  nisimura 	}
    442  1.2  nisimura 	if (fdtbus_get_reg(phandle, 1, addr+1, size+1) != 0
    443  1.2  nisimura 	    || bus_space_map(faa->faa_bst, addr[0], size[1], 0, &eebsh) != 0) {
    444  1.1  nisimura 		aprint_error(": unable to map device eeprom\n");
    445  1.1  nisimura 		goto fail;
    446  1.1  nisimura 	}
    447  1.1  nisimura 
    448  1.1  nisimura 	aprint_naive("\n");
    449  1.1  nisimura 	aprint_normal(": Gigabit Ethernet Controller\n");
    450  1.1  nisimura 	aprint_normal_dev(self, "interrupt on %s\n", intrstr);
    451  1.1  nisimura 
    452  1.1  nisimura 	sc->sc_dev = self;
    453  1.1  nisimura 	sc->sc_st = bst;
    454  1.1  nisimura 	sc->sc_sh = bsh;
    455  1.2  nisimura 	sc->sc_sz = size[0];
    456  1.1  nisimura 	sc->sc_eesh = eebsh;
    457  1.2  nisimura 	sc->sc_eesz = size[1];
    458  1.1  nisimura 	sc->sc_dmat = faa->faa_dmat;
    459  1.1  nisimura 	sc->sc_phandle = phandle;
    460  1.1  nisimura 
    461  1.1  nisimura 	scx_attach_i(sc);
    462  1.1  nisimura 	return;
    463  1.1  nisimura  fail:
    464  1.1  nisimura 	if (sc->sc_eesz)
    465  1.1  nisimura 		bus_space_unmap(sc->sc_st, sc->sc_eesh, sc->sc_eesz);
    466  1.1  nisimura 	if (sc->sc_sz)
    467  1.1  nisimura 		bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
    468  1.1  nisimura 	return;
    469  1.1  nisimura }
    470  1.1  nisimura 
    471  1.1  nisimura static int
    472  1.1  nisimura scx_acpi_match(device_t parent, cfdata_t cf, void *aux)
    473  1.1  nisimura {
    474  1.1  nisimura 	static const char * compatible[] = {
    475  1.1  nisimura 		"SCX0001",
    476  1.1  nisimura 		NULL
    477  1.1  nisimura 	};
    478  1.1  nisimura 	struct acpi_attach_args *aa = aux;
    479  1.1  nisimura 
    480  1.1  nisimura 	if (aa->aa_node->ad_type != ACPI_TYPE_DEVICE)
    481  1.1  nisimura 		return 0;
    482  1.1  nisimura 	return acpi_match_hid(aa->aa_node->ad_devinfo, compatible);
    483  1.1  nisimura }
    484  1.1  nisimura 
    485  1.1  nisimura static void
    486  1.1  nisimura scx_acpi_attach(device_t parent, device_t self, void *aux)
    487  1.1  nisimura {
    488  1.1  nisimura 	struct scx_softc * const sc = device_private(self);
    489  1.1  nisimura 	struct acpi_attach_args * const aa = aux;
    490  1.1  nisimura 	ACPI_HANDLE handle = aa->aa_node->ad_handle;
    491  1.1  nisimura 	bus_space_tag_t bst = aa->aa_memt;
    492  1.1  nisimura 	bus_space_handle_t bsh, eebsh;
    493  1.1  nisimura 	struct acpi_resources res;
    494  1.1  nisimura 	struct acpi_mem *mem;
    495  1.1  nisimura 	struct acpi_irq *irq;
    496  1.1  nisimura 	ACPI_STATUS rv;
    497  1.1  nisimura 
    498  1.1  nisimura 	rv = acpi_resource_parse(self, handle, "_CRS",
    499  1.1  nisimura 	    &res, &acpi_resource_parse_ops_default);
    500  1.1  nisimura 	if (ACPI_FAILURE(rv))
    501  1.1  nisimura 		return;
    502  1.1  nisimura 	mem = acpi_res_mem(&res, 0);
    503  1.1  nisimura 	irq = acpi_res_irq(&res, 0);
    504  1.1  nisimura 	if (mem == NULL || irq == NULL || mem->ar_length == 0) {
    505  1.1  nisimura 		aprint_error(": incomplete csr resources\n");
    506  1.1  nisimura 		return;
    507  1.1  nisimura 	}
    508  1.1  nisimura 	if (bus_space_map(bst, mem->ar_base, mem->ar_length, 0, &bsh) != 0) {
    509  1.1  nisimura 		aprint_error(": couldn't map registers\n");
    510  1.1  nisimura 		return;
    511  1.1  nisimura 	}
    512  1.1  nisimura 	sc->sc_sz = mem->ar_length;
    513  1.1  nisimura 	sc->sc_ih = acpi_intr_establish(self, (uint64_t)handle, IPL_NET,
    514  1.1  nisimura 	    NOT_MP_SAFE, scx_intr, sc, device_xname(self));
    515  1.1  nisimura 	if (sc->sc_ih == NULL) {
    516  1.1  nisimura 		aprint_error_dev(self, "couldn't establish interrupt\n");
    517  1.1  nisimura 		goto fail;
    518  1.1  nisimura 	}
    519  1.1  nisimura 	mem = acpi_res_mem(&res, 1); /* EEPROM for MAC address and ucode */
    520  1.1  nisimura 	if (mem == NULL || mem->ar_length == 0) {
    521  1.1  nisimura 		aprint_error(": incomplete eeprom resources\n");
    522  1.1  nisimura 		goto fail;
    523  1.1  nisimura 	}
    524  1.1  nisimura 	if (bus_space_map(bst, mem->ar_base, mem->ar_length, 0, &eebsh) != 0) {
    525  1.1  nisimura 		aprint_error(": couldn't map registers\n");
    526  1.1  nisimura 		goto fail;
    527  1.1  nisimura 	}
    528  1.1  nisimura 	sc->sc_eesz = mem->ar_length;
    529  1.1  nisimura 
    530  1.1  nisimura 	aprint_naive("\n");
    531  1.1  nisimura 	aprint_normal(": Gigabit Ethernet Controller\n");
    532  1.1  nisimura 
    533  1.1  nisimura 	sc->sc_dev = self;
    534  1.1  nisimura 	sc->sc_st = bst;
    535  1.1  nisimura 	sc->sc_sh = bsh;
    536  1.1  nisimura 	sc->sc_eesh = eebsh;
    537  1.1  nisimura 	sc->sc_dmat = aa->aa_dmat64;
    538  1.1  nisimura 
    539  1.1  nisimura 	scx_attach_i(sc);
    540  1.1  nisimura 
    541  1.1  nisimura 	acpi_resource_cleanup(&res);
    542  1.1  nisimura 	return;
    543  1.1  nisimura  fail:
    544  1.1  nisimura 	if (sc->sc_eesz > 0)
    545  1.1  nisimura 		bus_space_unmap(sc->sc_st, sc->sc_eesh, sc->sc_eesz);
    546  1.1  nisimura 	if (sc->sc_sz > 0)
    547  1.1  nisimura 		bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
    548  1.1  nisimura 	acpi_resource_cleanup(&res);
    549  1.1  nisimura 	return;
    550  1.1  nisimura }
    551  1.1  nisimura 
    552  1.1  nisimura static void
    553  1.1  nisimura scx_attach_i(struct scx_softc *sc)
    554  1.1  nisimura {
    555  1.1  nisimura 	struct ifnet * const ifp = &sc->sc_ethercom.ec_if;
    556  1.1  nisimura 	struct mii_data * const mii = &sc->sc_mii;
    557  1.1  nisimura 	struct ifmedia * const ifm = &mii->mii_media;
    558  1.1  nisimura 	uint32_t hwver, phyfreq;
    559  1.1  nisimura 	uint8_t enaddr[ETHER_ADDR_LEN];
    560  1.1  nisimura 	bus_dma_segment_t seg;
    561  1.1  nisimura 	uint32_t csr;
    562  1.1  nisimura 	int i, nseg, error = 0;
    563  1.1  nisimura 
    564  1.1  nisimura 	hwver = CSR_READ(sc, HWVER1);
    565  1.1  nisimura 	csr = bus_space_read_4(sc->sc_st, sc->sc_eesh, 0);
    566  1.1  nisimura 	enaddr[0] = csr >> 24;
    567  1.1  nisimura 	enaddr[1] = csr >> 16;
    568  1.1  nisimura 	enaddr[2] = csr >> 8;
    569  1.1  nisimura 	enaddr[3] = csr;
    570  1.1  nisimura 	csr = bus_space_read_4(sc->sc_st, sc->sc_eesh, 4);
    571  1.1  nisimura 	enaddr[4] = csr >> 24;
    572  1.1  nisimura 	enaddr[5] = csr >> 16;
    573  1.3  nisimura 	csr = CSR_READ(sc, GMACIMPL);
    574  1.1  nisimura 
    575  1.3  nisimura 	aprint_normal_dev(sc->sc_dev, "NetSec GbE (%d.%d) impl (%x.%x)\n",
    576  1.3  nisimura 	    hwver >> 16, hwver & 0xffff, csr >> 16, csr & 0xffff);
    577  1.1  nisimura 	aprint_normal_dev(sc->sc_dev,
    578  1.1  nisimura 	    "Ethernet address %s\n", ether_sprintf(enaddr));
    579  1.1  nisimura 
    580  1.1  nisimura 	phyfreq = 0;
    581  1.1  nisimura 	sc->sc_phy_id = MII_PHY_ANY;
    582  1.1  nisimura 	sc->sc_gar = get_garclk(phyfreq) << GAR_CTL; /* 5:2 gar control */
    583  1.1  nisimura 
    584  1.1  nisimura 	sc->sc_flowflags = 0;
    585  1.1  nisimura 
    586  1.3  nisimura 	if (sc->sc_ucodeloaded == 0)
    587  1.1  nisimura 		loaducode(sc);
    588  1.1  nisimura 
    589  1.1  nisimura 	mii->mii_ifp = ifp;
    590  1.1  nisimura 	mii->mii_readreg = mii_readreg;
    591  1.1  nisimura 	mii->mii_writereg = mii_writereg;
    592  1.1  nisimura 	mii->mii_statchg = mii_statchg;
    593  1.1  nisimura 
    594  1.1  nisimura 	sc->sc_ethercom.ec_mii = mii;
    595  1.1  nisimura 	ifmedia_init(ifm, 0, scx_ifmedia_upd, scx_ifmedia_sts);
    596  1.1  nisimura 	mii_attach(sc->sc_dev, mii, 0xffffffff, sc->sc_phy_id,
    597  1.1  nisimura 	    MII_OFFSET_ANY, MIIF_DOPAUSE);
    598  1.1  nisimura 	if (LIST_FIRST(&mii->mii_phys) == NULL) {
    599  1.1  nisimura 		ifmedia_add(ifm, IFM_ETHER | IFM_NONE, 0, NULL);
    600  1.1  nisimura 		ifmedia_set(ifm, IFM_ETHER | IFM_NONE);
    601  1.1  nisimura 	} else
    602  1.1  nisimura 		ifmedia_set(ifm, IFM_ETHER | IFM_AUTO);
    603  1.1  nisimura 	ifm->ifm_media = ifm->ifm_cur->ifm_media; /* as if user has requested */
    604  1.1  nisimura 
    605  1.1  nisimura 	strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
    606  1.1  nisimura 	ifp->if_softc = sc;
    607  1.1  nisimura 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    608  1.1  nisimura 	ifp->if_ioctl = scx_ioctl;
    609  1.1  nisimura 	ifp->if_start = scx_start;
    610  1.1  nisimura 	ifp->if_watchdog = scx_watchdog;
    611  1.1  nisimura 	ifp->if_init = scx_init;
    612  1.1  nisimura 	ifp->if_stop = scx_stop;
    613  1.1  nisimura 	IFQ_SET_READY(&ifp->if_snd);
    614  1.1  nisimura 
    615  1.1  nisimura 	if_attach(ifp);
    616  1.1  nisimura 	if_deferred_start_init(ifp, NULL);
    617  1.1  nisimura 	ether_ifattach(ifp, enaddr);
    618  1.1  nisimura 
    619  1.1  nisimura 	callout_init(&sc->sc_tick_ch, 0);
    620  1.1  nisimura 	callout_setfunc(&sc->sc_tick_ch, phy_tick, sc);
    621  1.1  nisimura 
    622  1.1  nisimura 	/*
    623  1.1  nisimura 	 * Allocate the control data structures, and create and load the
    624  1.1  nisimura 	 * DMA map for it.
    625  1.1  nisimura 	 */
    626  1.1  nisimura 	error = bus_dmamem_alloc(sc->sc_dmat,
    627  1.1  nisimura 	    sizeof(struct control_data), PAGE_SIZE, 0, &seg, 1, &nseg, 0);
    628  1.1  nisimura 	if (error != 0) {
    629  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
    630  1.1  nisimura 		    "unable to allocate control data, error = %d\n", error);
    631  1.1  nisimura 		goto fail_0;
    632  1.1  nisimura 	}
    633  1.1  nisimura 	error = bus_dmamem_map(sc->sc_dmat, &seg, nseg,
    634  1.1  nisimura 	    sizeof(struct control_data), (void **)&sc->sc_control_data,
    635  1.1  nisimura 	    BUS_DMA_COHERENT);
    636  1.1  nisimura 	if (error != 0) {
    637  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
    638  1.1  nisimura 		    "unable to map control data, error = %d\n", error);
    639  1.1  nisimura 		goto fail_1;
    640  1.1  nisimura 	}
    641  1.1  nisimura 	error = bus_dmamap_create(sc->sc_dmat,
    642  1.1  nisimura 	    sizeof(struct control_data), 1,
    643  1.1  nisimura 	    sizeof(struct control_data), 0, 0, &sc->sc_cddmamap);
    644  1.1  nisimura 	if (error != 0) {
    645  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
    646  1.1  nisimura 		    "unable to create control data DMA map, "
    647  1.1  nisimura 		    "error = %d\n", error);
    648  1.1  nisimura 		goto fail_2;
    649  1.1  nisimura 	}
    650  1.1  nisimura 	error = bus_dmamap_load(sc->sc_dmat, sc->sc_cddmamap,
    651  1.1  nisimura 	    sc->sc_control_data, sizeof(struct control_data), NULL, 0);
    652  1.1  nisimura 	if (error != 0) {
    653  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
    654  1.1  nisimura 		    "unable to load control data DMA map, error = %d\n",
    655  1.1  nisimura 		    error);
    656  1.1  nisimura 		goto fail_3;
    657  1.1  nisimura 	}
    658  1.1  nisimura 	for (i = 0; i < SCX_TXQUEUELEN; i++) {
    659  1.1  nisimura 		if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
    660  1.1  nisimura 		    SCX_NTXSEGS, MCLBYTES, 0, 0,
    661  1.1  nisimura 		    &sc->sc_txsoft[i].txs_dmamap)) != 0) {
    662  1.1  nisimura 			aprint_error_dev(sc->sc_dev,
    663  1.1  nisimura 			    "unable to create tx DMA map %d, error = %d\n",
    664  1.1  nisimura 			    i, error);
    665  1.1  nisimura 			goto fail_4;
    666  1.1  nisimura 		}
    667  1.1  nisimura 	}
    668  1.1  nisimura 	for (i = 0; i < SCX_NRXDESC; i++) {
    669  1.1  nisimura 		if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
    670  1.1  nisimura 		    1, MCLBYTES, 0, 0, &sc->sc_rxsoft[i].rxs_dmamap)) != 0) {
    671  1.1  nisimura 			aprint_error_dev(sc->sc_dev,
    672  1.1  nisimura 			    "unable to create rx DMA map %d, error = %d\n",
    673  1.1  nisimura 			    i, error);
    674  1.1  nisimura 			goto fail_5;
    675  1.1  nisimura 		}
    676  1.1  nisimura 		sc->sc_rxsoft[i].rxs_mbuf = NULL;
    677  1.1  nisimura 	}
    678  1.1  nisimura 	sc->sc_seg = seg;
    679  1.1  nisimura 	sc->sc_nseg = nseg;
    680  1.1  nisimura printf("bus_dmaseg ds_addr %08lx, ds_len %08lx, nseg %d\n", seg.ds_addr, seg.ds_len, nseg);
    681  1.1  nisimura 
    682  1.1  nisimura 	if (pmf_device_register(sc->sc_dev, NULL, NULL))
    683  1.1  nisimura 		pmf_class_network_register(sc->sc_dev, ifp);
    684  1.1  nisimura 	else
    685  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
    686  1.1  nisimura 			"couldn't establish power handler\n");
    687  1.1  nisimura 
    688  1.1  nisimura 	rnd_attach_source(&sc->rnd_source, device_xname(sc->sc_dev),
    689  1.1  nisimura 	    RND_TYPE_NET, RND_FLAG_DEFAULT);
    690  1.1  nisimura 
    691  1.1  nisimura 	return;
    692  1.1  nisimura 
    693  1.1  nisimura   fail_5:
    694  1.1  nisimura 	for (i = 0; i < SCX_NRXDESC; i++) {
    695  1.1  nisimura 		if (sc->sc_rxsoft[i].rxs_dmamap != NULL)
    696  1.1  nisimura 			bus_dmamap_destroy(sc->sc_dmat,
    697  1.1  nisimura 			    sc->sc_rxsoft[i].rxs_dmamap);
    698  1.1  nisimura 	}
    699  1.1  nisimura   fail_4:
    700  1.1  nisimura 	for (i = 0; i < SCX_TXQUEUELEN; i++) {
    701  1.1  nisimura 		if (sc->sc_txsoft[i].txs_dmamap != NULL)
    702  1.1  nisimura 			bus_dmamap_destroy(sc->sc_dmat,
    703  1.1  nisimura 			    sc->sc_txsoft[i].txs_dmamap);
    704  1.1  nisimura 	}
    705  1.1  nisimura 	bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
    706  1.1  nisimura   fail_3:
    707  1.1  nisimura 	bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
    708  1.1  nisimura   fail_2:
    709  1.1  nisimura 	bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data,
    710  1.1  nisimura 	    sizeof(struct control_data));
    711  1.1  nisimura   fail_1:
    712  1.1  nisimura 	bus_dmamem_free(sc->sc_dmat, &seg, nseg);
    713  1.1  nisimura   fail_0:
    714  1.1  nisimura 	if (sc->sc_phandle)
    715  1.1  nisimura 		fdtbus_intr_disestablish(sc->sc_phandle, sc->sc_ih);
    716  1.1  nisimura 	else
    717  1.1  nisimura 		acpi_intr_disestablish(sc->sc_ih);
    718  1.1  nisimura 	bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
    719  1.1  nisimura 	return;
    720  1.1  nisimura }
    721  1.1  nisimura 
    722  1.1  nisimura static void
    723  1.1  nisimura scx_reset(struct scx_softc *sc)
    724  1.1  nisimura {
    725  1.1  nisimura 
    726  1.1  nisimura 	mac_write(sc, GMACBMR, BMR_RST); /* may take for a while */
    727  1.1  nisimura 	(void)spin_waitfor(sc, GMACBMR, BMR_RST);
    728  1.1  nisimura 
    729  1.1  nisimura 	CSR_WRITE(sc, DESCENG_SRST, 1);
    730  1.1  nisimura 	CSR_WRITE(sc, DESCENG_INIT, 1);
    731  1.1  nisimura 	mac_write(sc, GMACBMR, _BMR);
    732  1.1  nisimura 	mac_write(sc, GMACRDLAR, _RDLAR);
    733  1.1  nisimura 	mac_write(sc, GMACTDLAR, _TDLAR);
    734  1.1  nisimura 	mac_write(sc, GMACAFR, _AFR);
    735  1.1  nisimura }
    736  1.1  nisimura 
    737  1.1  nisimura static int
    738  1.1  nisimura scx_init(struct ifnet *ifp)
    739  1.1  nisimura {
    740  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
    741  1.1  nisimura 	const uint8_t *ea = CLLADDR(ifp->if_sadl);
    742  1.1  nisimura 	uint32_t csr;
    743  1.1  nisimura 	int i;
    744  1.1  nisimura 
    745  1.1  nisimura 	/* Cancel pending I/O. */
    746  1.1  nisimura 	scx_stop(ifp, 0);
    747  1.1  nisimura 
    748  1.1  nisimura 	/* Reset the chip to a known state. */
    749  1.1  nisimura 	scx_reset(sc);
    750  1.1  nisimura 
    751  1.1  nisimura 	/* build sane Tx and load Rx descriptors with mbuf */
    752  1.1  nisimura 	for (i = 0; i < SCX_NTXDESC; i++)
    753  1.1  nisimura 		sc->sc_txdescs[i].t0 = T0_OWN;
    754  1.1  nisimura 	sc->sc_txdescs[SCX_NTXDESC - 1].t0 |= T0_EOD; /* tie off the ring */
    755  1.1  nisimura 	for (i = 0; i < SCX_NRXDESC; i++)
    756  1.1  nisimura 		(void)add_rxbuf(sc, i);
    757  1.1  nisimura 
    758  1.1  nisimura 	/* set my address in perfect match slot 0 */
    759  1.1  nisimura 	csr = (ea[3] << 24) | (ea[2] << 16) | (ea[1] << 8) |  ea[0];
    760  1.1  nisimura 	CSR_WRITE(sc, GMACMAL0, csr);
    761  1.1  nisimura 	csr = (ea[5] << 8) | ea[4];
    762  1.1  nisimura 	CSR_WRITE(sc, GMACMAH0, csr | 1U<<31); /* always valid? */
    763  1.1  nisimura 
    764  1.1  nisimura 	/* accept multicast frame or run promisc mode */
    765  1.1  nisimura 	scx_set_rcvfilt(sc);
    766  1.1  nisimura 
    767  1.1  nisimura 	(void)scx_ifmedia_upd(ifp);
    768  1.1  nisimura 
    769  1.1  nisimura 	/* kick to start GMAC engine */
    770  1.1  nisimura 	csr = mac_read(sc, GMACOMR);
    771  1.1  nisimura 	CSR_WRITE(sc, RXINT_CLR, ~0);
    772  1.1  nisimura 	CSR_WRITE(sc, TXINT_CLR, ~0);
    773  1.1  nisimura 	mac_write(sc, GMACOMR, csr | OMR_RXE | OMR_TXE);
    774  1.1  nisimura 
    775  1.1  nisimura 	ifp->if_flags |= IFF_RUNNING;
    776  1.1  nisimura 	ifp->if_flags &= ~IFF_OACTIVE;
    777  1.1  nisimura 
    778  1.1  nisimura 	/* start one second timer */
    779  1.1  nisimura 	callout_schedule(&sc->sc_tick_ch, hz);
    780  1.1  nisimura 
    781  1.1  nisimura 	return 0;
    782  1.1  nisimura }
    783  1.1  nisimura 
    784  1.1  nisimura static void
    785  1.1  nisimura scx_stop(struct ifnet *ifp, int disable)
    786  1.1  nisimura {
    787  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
    788  1.1  nisimura 
    789  1.1  nisimura 	/* Stop the one second clock. */
    790  1.1  nisimura 	callout_stop(&sc->sc_tick_ch);
    791  1.1  nisimura 
    792  1.1  nisimura 	/* Down the MII. */
    793  1.1  nisimura 	mii_down(&sc->sc_mii);
    794  1.1  nisimura 
    795  1.1  nisimura 	/* Mark the interface down and cancel the watchdog timer. */
    796  1.1  nisimura 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    797  1.1  nisimura 	ifp->if_timer = 0;
    798  1.1  nisimura }
    799  1.1  nisimura 
    800  1.1  nisimura static void
    801  1.1  nisimura scx_watchdog(struct ifnet *ifp)
    802  1.1  nisimura {
    803  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
    804  1.1  nisimura 
    805  1.1  nisimura 	/*
    806  1.1  nisimura 	 * Since we're not interrupting every packet, sweep
    807  1.1  nisimura 	 * up before we report an error.
    808  1.1  nisimura 	 */
    809  1.1  nisimura 	txreap(sc);
    810  1.1  nisimura 
    811  1.1  nisimura 	if (sc->sc_txfree != SCX_NTXDESC) {
    812  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
    813  1.1  nisimura 		    "device timeout (txfree %d txsfree %d txnext %d)\n",
    814  1.1  nisimura 		    sc->sc_txfree, sc->sc_txsfree, sc->sc_txnext);
    815  1.1  nisimura 		if_statinc(ifp, if_oerrors);
    816  1.1  nisimura 
    817  1.1  nisimura 		/* Reset the interface. */
    818  1.1  nisimura 		scx_init(ifp);
    819  1.1  nisimura 	}
    820  1.1  nisimura 
    821  1.1  nisimura 	scx_start(ifp);
    822  1.1  nisimura }
    823  1.1  nisimura 
    824  1.1  nisimura static int
    825  1.1  nisimura scx_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    826  1.1  nisimura {
    827  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
    828  1.1  nisimura 	struct ifreq *ifr = (struct ifreq *)data;
    829  1.1  nisimura 	struct ifmedia *ifm;
    830  1.1  nisimura 	int s, error;
    831  1.1  nisimura 
    832  1.1  nisimura 	s = splnet();
    833  1.1  nisimura 
    834  1.1  nisimura 	switch (cmd) {
    835  1.1  nisimura 	case SIOCSIFMEDIA:
    836  1.1  nisimura 		/* Flow control requires full-duplex mode. */
    837  1.1  nisimura 		if (IFM_SUBTYPE(ifr->ifr_media) == IFM_AUTO ||
    838  1.1  nisimura 		    (ifr->ifr_media & IFM_FDX) == 0)
    839  1.1  nisimura 			ifr->ifr_media &= ~IFM_ETH_FMASK;
    840  1.1  nisimura 		if (IFM_SUBTYPE(ifr->ifr_media) != IFM_AUTO) {
    841  1.1  nisimura 			if ((ifr->ifr_media & IFM_ETH_FMASK) == IFM_FLOW) {
    842  1.1  nisimura 				/* We can do both TXPAUSE and RXPAUSE. */
    843  1.1  nisimura 				ifr->ifr_media |=
    844  1.1  nisimura 				    IFM_ETH_TXPAUSE | IFM_ETH_RXPAUSE;
    845  1.1  nisimura 			}
    846  1.1  nisimura 			sc->sc_flowflags = ifr->ifr_media & IFM_ETH_FMASK;
    847  1.1  nisimura 		}
    848  1.1  nisimura 		ifm = &sc->sc_mii.mii_media;
    849  1.1  nisimura 		error = ifmedia_ioctl(ifp, ifr, ifm, cmd);
    850  1.1  nisimura 		break;
    851  1.1  nisimura 	default:
    852  1.1  nisimura 		if ((error = ether_ioctl(ifp, cmd, data)) != ENETRESET)
    853  1.1  nisimura 			break;
    854  1.1  nisimura 
    855  1.1  nisimura 		error = 0;
    856  1.1  nisimura 
    857  1.1  nisimura 		if (cmd == SIOCSIFCAP)
    858  1.1  nisimura 			error = (*ifp->if_init)(ifp);
    859  1.1  nisimura 		if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
    860  1.1  nisimura 			;
    861  1.1  nisimura 		else if (ifp->if_flags & IFF_RUNNING) {
    862  1.1  nisimura 			/*
    863  1.1  nisimura 			 * Multicast list has changed; set the hardware filter
    864  1.1  nisimura 			 * accordingly.
    865  1.1  nisimura 			 */
    866  1.1  nisimura 			scx_set_rcvfilt(sc);
    867  1.1  nisimura 		}
    868  1.1  nisimura 		break;
    869  1.1  nisimura 	}
    870  1.1  nisimura 
    871  1.1  nisimura 	splx(s);
    872  1.1  nisimura 	return error;
    873  1.1  nisimura }
    874  1.1  nisimura 
    875  1.1  nisimura static void
    876  1.1  nisimura scx_set_rcvfilt(struct scx_softc *sc)
    877  1.1  nisimura {
    878  1.1  nisimura 	struct ethercom * const ec = &sc->sc_ethercom;
    879  1.1  nisimura 	struct ifnet * const ifp = &ec->ec_if;
    880  1.1  nisimura 	struct ether_multistep step;
    881  1.1  nisimura 	struct ether_multi *enm;
    882  1.1  nisimura 	uint32_t mchash[8]; 	/* 8x 32 = 256 bit */
    883  1.1  nisimura 	uint32_t csr, crc;
    884  1.1  nisimura 	int i;
    885  1.1  nisimura 
    886  1.1  nisimura 	csr = CSR_READ(sc, GMACAFR);
    887  1.1  nisimura 	csr &= ~(AFR_PM | AFR_AM | AFR_MHTE);
    888  1.1  nisimura 	CSR_WRITE(sc, GMACAFR, csr);
    889  1.1  nisimura 
    890  1.1  nisimura 	ETHER_LOCK(ec);
    891  1.1  nisimura 	if (ifp->if_flags & IFF_PROMISC) {
    892  1.1  nisimura 		ec->ec_flags |= ETHER_F_ALLMULTI;
    893  1.1  nisimura 		ETHER_UNLOCK(ec);
    894  1.1  nisimura 		goto update;
    895  1.1  nisimura 	}
    896  1.1  nisimura 	ec->ec_flags &= ~ETHER_F_ALLMULTI;
    897  1.1  nisimura 
    898  1.1  nisimura 	/* clear 15 entry supplimental perfect match filter */
    899  1.1  nisimura 	for (i = 1; i < 16; i++)
    900  1.1  nisimura 		 CSR_WRITE(sc, GMACMAH(i), 0);
    901  1.1  nisimura 	/* build 256 bit multicast hash filter */
    902  1.1  nisimura 	memset(mchash, 0, sizeof(mchash));
    903  1.1  nisimura 	crc = 0;
    904  1.1  nisimura 
    905  1.1  nisimura 	ETHER_FIRST_MULTI(step, ec, enm);
    906  1.1  nisimura 	i = 1; /* slot 0 is occupied */
    907  1.1  nisimura 	while (enm != NULL) {
    908  1.1  nisimura 		if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
    909  1.1  nisimura 			/*
    910  1.1  nisimura 			 * We must listen to a range of multicast addresses.
    911  1.1  nisimura 			 * For now, just accept all multicasts, rather than
    912  1.1  nisimura 			 * trying to set only those filter bits needed to match
    913  1.1  nisimura 			 * the range.  (At this time, the only use of address
    914  1.1  nisimura 			 * ranges is for IP multicast routing, for which the
    915  1.1  nisimura 			 * range is big enough to require all bits set.)
    916  1.1  nisimura 			 */
    917  1.1  nisimura 			ec->ec_flags |= ETHER_F_ALLMULTI;
    918  1.1  nisimura 			ETHER_UNLOCK(ec);
    919  1.1  nisimura 			goto update;
    920  1.1  nisimura 		}
    921  1.1  nisimura printf("[%d] %s\n", i, ether_sprintf(enm->enm_addrlo));
    922  1.1  nisimura 		if (i < 16) {
    923  1.1  nisimura 			/* use 31 entry perfect match filter */
    924  1.1  nisimura 			uint32_t addr;
    925  1.1  nisimura 			uint8_t *ep = enm->enm_addrlo;
    926  1.1  nisimura 			addr = (ep[3] << 24) | (ep[2] << 16)
    927  1.1  nisimura 			     | (ep[1] <<  8) |  ep[0];
    928  1.1  nisimura 			CSR_WRITE(sc, GMACMAL(i), addr);
    929  1.1  nisimura 			addr = (ep[5] << 8) | ep[4];
    930  1.1  nisimura 			CSR_WRITE(sc, GMACMAH(i), addr | 1U<<31);
    931  1.1  nisimura 		} else {
    932  1.1  nisimura 			/* use hash table when too many */
    933  1.1  nisimura 			/* bit_reserve_32(~crc) !? */
    934  1.1  nisimura 			crc = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN);
    935  1.1  nisimura 			/* 3(31:29) 5(28:24) bit sampling */
    936  1.1  nisimura 			mchash[crc >> 29] |= 1 << ((crc >> 24) & 0x1f);
    937  1.1  nisimura 		}
    938  1.1  nisimura 		ETHER_NEXT_MULTI(step, enm);
    939  1.1  nisimura 		i++;
    940  1.1  nisimura 	}
    941  1.1  nisimura 	ETHER_UNLOCK(ec);
    942  1.1  nisimura 
    943  1.1  nisimura 	if (crc)
    944  1.1  nisimura 		csr |= AFR_MHTE;
    945  1.1  nisimura 	for (i = 0; i < 8; i++)
    946  1.1  nisimura 		CSR_WRITE(sc, GMACMHT0 + i * 4, mchash[i]);
    947  1.1  nisimura 	CSR_WRITE(sc, GMACAFR, csr);
    948  1.1  nisimura 	return;
    949  1.1  nisimura 
    950  1.1  nisimura  update:
    951  1.2  nisimura 	/* With PM or AM, MHTE/MHTL/MHTH are never consulted. really? */
    952  1.1  nisimura 	if (ifp->if_flags & IFF_PROMISC)
    953  1.1  nisimura 		csr |= AFR_PM;	/* run promisc. mode */
    954  1.1  nisimura 	else
    955  1.1  nisimura 		csr |= AFR_AM;	/* accept all multicast */
    956  1.1  nisimura 	CSR_WRITE(sc, GMACAFR, csr);
    957  1.1  nisimura 	return;
    958  1.1  nisimura }
    959  1.1  nisimura 
    960  1.1  nisimura static int
    961  1.1  nisimura scx_ifmedia_upd(struct ifnet *ifp)
    962  1.1  nisimura {
    963  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
    964  1.1  nisimura 	struct ifmedia *ifm = &sc->sc_mii.mii_media;
    965  1.1  nisimura 
    966  1.1  nisimura 	if (IFM_SUBTYPE(ifm->ifm_cur->ifm_media) == IFM_AUTO) {
    967  1.1  nisimura 		; /* restart AN */
    968  1.1  nisimura 		; /* enable AN */
    969  1.1  nisimura 		; /* advertise flow control pause */
    970  1.1  nisimura 		; /* adv. 100FDX,100HDX,10FDX,10HDX */
    971  1.1  nisimura 	} else {
    972  1.1  nisimura #if 1
    973  1.1  nisimura 		uint32_t mcr = mac_read(sc, GMACMCR);
    974  1.1  nisimura 		if (IFM_SUBTYPE(ifm->ifm_cur->ifm_media) == IFM_1000_T)
    975  1.1  nisimura 			mcr &= ~MCR_USEMII; /* RGMII+SPD1000 */
    976  1.1  nisimura 		else {
    977  1.1  nisimura 			mcr |= MCR_USEMII;  /* RMII/MII */
    978  1.1  nisimura 			if (IFM_SUBTYPE(ifm->ifm_cur->ifm_media) == IFM_100_TX)
    979  1.1  nisimura 				mcr |= MCR_SPD100;
    980  1.1  nisimura 		}
    981  1.1  nisimura 		if (ifm->ifm_cur->ifm_media & IFM_FDX)
    982  1.1  nisimura 			mcr |= MCR_USEFDX;
    983  1.1  nisimura 		mcr |= MCR_CST | MCR_JE;
    984  1.1  nisimura 		mcr |= MCR_IBN;
    985  1.1  nisimura 		mac_write(sc, GMACMCR, mcr);
    986  1.1  nisimura #endif
    987  1.1  nisimura 	}
    988  1.1  nisimura 	return 0;
    989  1.1  nisimura }
    990  1.1  nisimura 
    991  1.1  nisimura static void
    992  1.1  nisimura scx_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
    993  1.1  nisimura {
    994  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
    995  1.1  nisimura 	struct mii_data *mii = &sc->sc_mii;
    996  1.1  nisimura 
    997  1.1  nisimura 	mii_pollstat(mii);
    998  1.1  nisimura 	ifmr->ifm_status = mii->mii_media_status;
    999  1.1  nisimura 	ifmr->ifm_active = sc->sc_flowflags |
   1000  1.1  nisimura 	    (mii->mii_media_active & ~IFM_ETH_FMASK);
   1001  1.1  nisimura }
   1002  1.1  nisimura 
   1003  1.1  nisimura void
   1004  1.1  nisimura mii_statchg(struct ifnet *ifp)
   1005  1.1  nisimura {
   1006  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
   1007  1.1  nisimura 	struct mii_data *mii = &sc->sc_mii;
   1008  1.1  nisimura 	uint32_t fcr;
   1009  1.1  nisimura 
   1010  1.1  nisimura 	/* Get flow control negotiation result. */
   1011  1.1  nisimura 	if (IFM_SUBTYPE(mii->mii_media.ifm_cur->ifm_media) == IFM_AUTO &&
   1012  1.1  nisimura 	    (mii->mii_media_active & IFM_ETH_FMASK) != sc->sc_flowflags)
   1013  1.1  nisimura 		sc->sc_flowflags = mii->mii_media_active & IFM_ETH_FMASK;
   1014  1.1  nisimura 
   1015  1.1  nisimura 	/* Adjust PAUSE flow control. */
   1016  1.1  nisimura 	fcr = mac_read(sc, GMACFCR) & ~(FCR_TFE | FCR_RFE);
   1017  1.1  nisimura 	if (mii->mii_media_active & IFM_FDX) {
   1018  1.1  nisimura 		if (sc->sc_flowflags & IFM_ETH_TXPAUSE)
   1019  1.1  nisimura 			fcr |= FCR_TFE;
   1020  1.1  nisimura 		if (sc->sc_flowflags & IFM_ETH_RXPAUSE)
   1021  1.1  nisimura 			fcr |= FCR_RFE;
   1022  1.1  nisimura 	}
   1023  1.1  nisimura 	mac_write(sc, GMACFCR, fcr);
   1024  1.1  nisimura 
   1025  1.1  nisimura printf("%ctxfe, %crxfe\n",
   1026  1.1  nisimura      (fcr & FCR_TFE) ? '+' : '-', (fcr & FCR_RFE) ? '+' : '-');
   1027  1.1  nisimura }
   1028  1.1  nisimura 
   1029  1.1  nisimura static void
   1030  1.1  nisimura phy_tick(void *arg)
   1031  1.1  nisimura {
   1032  1.1  nisimura 	struct scx_softc *sc = arg;
   1033  1.1  nisimura 	struct mii_data *mii = &sc->sc_mii;
   1034  1.1  nisimura 	int s;
   1035  1.1  nisimura 
   1036  1.1  nisimura 	s = splnet();
   1037  1.1  nisimura 	mii_tick(mii);
   1038  1.1  nisimura 	splx(s);
   1039  1.1  nisimura 
   1040  1.1  nisimura 	callout_schedule(&sc->sc_tick_ch, hz);
   1041  1.1  nisimura }
   1042  1.1  nisimura 
   1043  1.1  nisimura static int
   1044  1.1  nisimura mii_readreg(device_t self, int phy, int reg, uint16_t *val)
   1045  1.1  nisimura {
   1046  1.1  nisimura 	struct scx_softc *sc = device_private(self);
   1047  1.1  nisimura 	uint32_t gar;
   1048  1.1  nisimura 	int error;
   1049  1.1  nisimura 
   1050  1.1  nisimura 	gar = (phy << GAR_PHY) | (reg << GAR_REG) | sc->sc_gar;
   1051  1.1  nisimura 	mac_write(sc, GMACGAR, gar | GAR_BUSY);
   1052  1.1  nisimura 	error = spin_waitfor(sc, GMACGAR, GAR_BUSY);
   1053  1.1  nisimura 	if (error)
   1054  1.1  nisimura 		return error;
   1055  1.1  nisimura 	*val = mac_read(sc, GMACGDR);
   1056  1.1  nisimura 	return 0;
   1057  1.1  nisimura }
   1058  1.1  nisimura 
   1059  1.1  nisimura static int
   1060  1.1  nisimura mii_writereg(device_t self, int phy, int reg, uint16_t val)
   1061  1.1  nisimura {
   1062  1.1  nisimura 	struct scx_softc *sc = device_private(self);
   1063  1.1  nisimura 	uint32_t gar;
   1064  1.1  nisimura 	uint16_t dummy;
   1065  1.1  nisimura 	int error;
   1066  1.1  nisimura 
   1067  1.1  nisimura 	gar = (phy << GAR_PHY) | (reg << GAR_REG) | sc->sc_gar;
   1068  1.1  nisimura 	mac_write(sc, GMACGDR, val);
   1069  1.1  nisimura 	mac_write(sc, GMACGAR, gar | GAR_IOWR | GAR_BUSY);
   1070  1.1  nisimura 	error = spin_waitfor(sc, GMACGAR, GAR_BUSY);
   1071  1.1  nisimura 	if (error)
   1072  1.1  nisimura 		return error;
   1073  1.1  nisimura 	mii_readreg(self, phy, MII_PHYIDR1, &dummy); /* dummy read cycle */
   1074  1.1  nisimura 	return 0;
   1075  1.1  nisimura }
   1076  1.1  nisimura 
   1077  1.1  nisimura static void
   1078  1.1  nisimura scx_start(struct ifnet *ifp)
   1079  1.1  nisimura {
   1080  1.1  nisimura 	struct scx_softc *sc = ifp->if_softc;
   1081  1.1  nisimura 	struct mbuf *m0, *m;
   1082  1.1  nisimura 	struct scx_txsoft *txs;
   1083  1.1  nisimura 	bus_dmamap_t dmamap;
   1084  1.1  nisimura 	int error, nexttx, lasttx, ofree, seg;
   1085  1.1  nisimura 	uint32_t tdes0;
   1086  1.1  nisimura 
   1087  1.1  nisimura 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
   1088  1.1  nisimura 		return;
   1089  1.1  nisimura 
   1090  1.1  nisimura 	/* Remember the previous number of free descriptors. */
   1091  1.1  nisimura 	ofree = sc->sc_txfree;
   1092  1.1  nisimura 
   1093  1.1  nisimura 	/*
   1094  1.1  nisimura 	 * Loop through the send queue, setting up transmit descriptors
   1095  1.1  nisimura 	 * until we drain the queue, or use up all available transmit
   1096  1.1  nisimura 	 * descriptors.
   1097  1.1  nisimura 	 */
   1098  1.1  nisimura 	for (;;) {
   1099  1.1  nisimura 		IFQ_POLL(&ifp->if_snd, m0);
   1100  1.1  nisimura 		if (m0 == NULL)
   1101  1.1  nisimura 			break;
   1102  1.1  nisimura 
   1103  1.1  nisimura 		if (sc->sc_txsfree < SCX_TXQUEUE_GC) {
   1104  1.1  nisimura 			txreap(sc);
   1105  1.1  nisimura 			if (sc->sc_txsfree == 0)
   1106  1.1  nisimura 				break;
   1107  1.1  nisimura 		}
   1108  1.1  nisimura 		txs = &sc->sc_txsoft[sc->sc_txsnext];
   1109  1.1  nisimura 		dmamap = txs->txs_dmamap;
   1110  1.1  nisimura 
   1111  1.1  nisimura 		error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
   1112  1.1  nisimura 		    BUS_DMA_WRITE | BUS_DMA_NOWAIT);
   1113  1.1  nisimura 		if (error) {
   1114  1.1  nisimura 			if (error == EFBIG) {
   1115  1.1  nisimura 				aprint_error_dev(sc->sc_dev,
   1116  1.1  nisimura 				    "Tx packet consumes too many "
   1117  1.1  nisimura 				    "DMA segments, dropping...\n");
   1118  1.1  nisimura 				    IFQ_DEQUEUE(&ifp->if_snd, m0);
   1119  1.1  nisimura 				    m_freem(m0);
   1120  1.1  nisimura 				    continue;
   1121  1.1  nisimura 			}
   1122  1.1  nisimura 			/* Short on resources, just stop for now. */
   1123  1.1  nisimura 			break;
   1124  1.1  nisimura 		}
   1125  1.1  nisimura 
   1126  1.1  nisimura 		if (dmamap->dm_nsegs > sc->sc_txfree) {
   1127  1.1  nisimura 			/*
   1128  1.1  nisimura 			 * Not enough free descriptors to transmit this
   1129  1.1  nisimura 			 * packet.  We haven't committed anything yet,
   1130  1.1  nisimura 			 * so just unload the DMA map, put the packet
   1131  1.1  nisimura 			 * back on the queue, and punt.	 Notify the upper
   1132  1.1  nisimura 			 * layer that there are not more slots left.
   1133  1.1  nisimura 			 */
   1134  1.1  nisimura 			ifp->if_flags |= IFF_OACTIVE;
   1135  1.1  nisimura 			bus_dmamap_unload(sc->sc_dmat, dmamap);
   1136  1.1  nisimura 			break;
   1137  1.1  nisimura 		}
   1138  1.1  nisimura 
   1139  1.1  nisimura 		IFQ_DEQUEUE(&ifp->if_snd, m0);
   1140  1.1  nisimura 
   1141  1.1  nisimura 		/*
   1142  1.1  nisimura 		 * WE ARE NOW COMMITTED TO TRANSMITTING THE PACKET.
   1143  1.1  nisimura 		 */
   1144  1.1  nisimura 
   1145  1.1  nisimura 		bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
   1146  1.1  nisimura 		    BUS_DMASYNC_PREWRITE);
   1147  1.1  nisimura 
   1148  1.1  nisimura 		tdes0 = 0; /* to postpone 1st segment T0_OWN write */
   1149  1.1  nisimura 		lasttx = -1;
   1150  1.1  nisimura 		for (nexttx = sc->sc_txnext, seg = 0;
   1151  1.1  nisimura 		     seg < dmamap->dm_nsegs;
   1152  1.1  nisimura 		     seg++, nexttx = SCX_NEXTTX(nexttx)) {
   1153  1.1  nisimura 			struct tdes *tdes = &sc->sc_txdescs[nexttx];
   1154  1.1  nisimura 			bus_addr_t paddr = dmamap->dm_segs[seg].ds_addr;
   1155  1.1  nisimura 			/*
   1156  1.1  nisimura 			 * If this is the first descriptor we're
   1157  1.1  nisimura 			 * enqueueing, don't set the OWN bit just
   1158  1.1  nisimura 			 * yet.	 That could cause a race condition.
   1159  1.1  nisimura 			 * We'll do it below.
   1160  1.1  nisimura 			 */
   1161  1.1  nisimura 			tdes->t3 = dmamap->dm_segs[seg].ds_len;
   1162  1.1  nisimura 			tdes->t2 = htole32(BUS_ADDR_LO32(paddr));
   1163  1.1  nisimura 			tdes->t1 = htole32(BUS_ADDR_HI32(paddr));
   1164  1.1  nisimura 			tdes->t0 = tdes0 | (tdes->t0 & T0_EOD) |
   1165  1.1  nisimura 					(15 << T0_TRID) | T0_PT |
   1166  1.1  nisimura 					sc->sc_t0coso | T0_TRS;
   1167  1.1  nisimura 			tdes0 = T0_OWN; /* 2nd and other segments */
   1168  1.1  nisimura 			lasttx = nexttx;
   1169  1.1  nisimura 		}
   1170  1.1  nisimura 		/*
   1171  1.1  nisimura 		 * Outgoing NFS mbuf must be unloaded when Tx completed.
   1172  1.1  nisimura 		 * Without T1_IC NFS mbuf is left unack'ed for excessive
   1173  1.1  nisimura 		 * time and NFS stops to proceed until scx_watchdog()
   1174  1.1  nisimura 		 * calls txreap() to reclaim the unack'ed mbuf.
   1175  1.1  nisimura 		 * It's painful to traverse every mbuf chain to determine
   1176  1.1  nisimura 		 * whether someone is waiting for Tx completion.
   1177  1.1  nisimura 		 */
   1178  1.1  nisimura 		m = m0;
   1179  1.1  nisimura 		do {
   1180  1.1  nisimura 			if ((m->m_flags & M_EXT) && m->m_ext.ext_free) {
   1181  1.1  nisimura 				sc->sc_txdescs[lasttx].t0 |= T0_IOC; /* !!! */
   1182  1.1  nisimura 				break;
   1183  1.1  nisimura 			}
   1184  1.1  nisimura 		} while ((m = m->m_next) != NULL);
   1185  1.1  nisimura 
   1186  1.1  nisimura 		/* Write deferred 1st segment T0_OWN at the final stage */
   1187  1.1  nisimura 		sc->sc_txdescs[lasttx].t0 |= T0_LS;
   1188  1.1  nisimura 		sc->sc_txdescs[sc->sc_txnext].t0 |= (T0_FS | T0_OWN);
   1189  1.1  nisimura 		SCX_CDTXSYNC(sc, sc->sc_txnext, dmamap->dm_nsegs,
   1190  1.1  nisimura 		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
   1191  1.1  nisimura 
   1192  1.1  nisimura 		/* Tell DMA start transmit */
   1193  1.1  nisimura 		/* CSR_WRITE(sc, MDTSC, 1); */
   1194  1.1  nisimura 
   1195  1.1  nisimura 		txs->txs_mbuf = m0;
   1196  1.1  nisimura 		txs->txs_firstdesc = sc->sc_txnext;
   1197  1.1  nisimura 		txs->txs_lastdesc = lasttx;
   1198  1.1  nisimura 		txs->txs_ndesc = dmamap->dm_nsegs;
   1199  1.1  nisimura 
   1200  1.1  nisimura 		sc->sc_txfree -= txs->txs_ndesc;
   1201  1.1  nisimura 		sc->sc_txnext = nexttx;
   1202  1.1  nisimura 		sc->sc_txsfree--;
   1203  1.1  nisimura 		sc->sc_txsnext = SCX_NEXTTXS(sc->sc_txsnext);
   1204  1.1  nisimura 		/*
   1205  1.1  nisimura 		 * Pass the packet to any BPF listeners.
   1206  1.1  nisimura 		 */
   1207  1.1  nisimura 		bpf_mtap(ifp, m0, BPF_D_OUT);
   1208  1.1  nisimura 	}
   1209  1.1  nisimura 
   1210  1.1  nisimura 	if (sc->sc_txsfree == 0 || sc->sc_txfree == 0) {
   1211  1.1  nisimura 		/* No more slots left; notify upper layer. */
   1212  1.1  nisimura 		ifp->if_flags |= IFF_OACTIVE;
   1213  1.1  nisimura 	}
   1214  1.1  nisimura 	if (sc->sc_txfree != ofree) {
   1215  1.1  nisimura 		/* Set a watchdog timer in case the chip flakes out. */
   1216  1.1  nisimura 		ifp->if_timer = 5;
   1217  1.1  nisimura 	}
   1218  1.1  nisimura }
   1219  1.1  nisimura 
   1220  1.1  nisimura static int
   1221  1.1  nisimura scx_intr(void *arg)
   1222  1.1  nisimura {
   1223  1.1  nisimura 	struct scx_softc *sc = arg;
   1224  1.1  nisimura 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
   1225  1.3  nisimura 
   1226  1.1  nisimura 	(void)ifp;
   1227  1.1  nisimura 	rxintr(sc);
   1228  1.1  nisimura 	txreap(sc);
   1229  1.1  nisimura 	return 1;
   1230  1.1  nisimura }
   1231  1.1  nisimura 
   1232  1.1  nisimura static void
   1233  1.1  nisimura txreap(struct scx_softc *sc)
   1234  1.1  nisimura {
   1235  1.1  nisimura 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
   1236  1.1  nisimura 	struct scx_txsoft *txs;
   1237  1.1  nisimura 	uint32_t txstat;
   1238  1.1  nisimura 	int i;
   1239  1.1  nisimura 
   1240  1.1  nisimura 	ifp->if_flags &= ~IFF_OACTIVE;
   1241  1.1  nisimura 
   1242  1.1  nisimura 	for (i = sc->sc_txsdirty; sc->sc_txsfree != SCX_TXQUEUELEN;
   1243  1.1  nisimura 	     i = SCX_NEXTTXS(i), sc->sc_txsfree++) {
   1244  1.1  nisimura 		txs = &sc->sc_txsoft[i];
   1245  1.1  nisimura 
   1246  1.1  nisimura 		SCX_CDTXSYNC(sc, txs->txs_firstdesc, txs->txs_ndesc,
   1247  1.1  nisimura 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
   1248  1.1  nisimura 
   1249  1.1  nisimura 		txstat = sc->sc_txdescs[txs->txs_lastdesc].t0;
   1250  1.1  nisimura 		if (txstat & T0_OWN) /* desc is still in use */
   1251  1.1  nisimura 			break;
   1252  1.1  nisimura 
   1253  1.1  nisimura 		/* There is no way to tell transmission status per frame */
   1254  1.1  nisimura 
   1255  1.1  nisimura 		if_statinc(ifp, if_opackets);
   1256  1.1  nisimura 
   1257  1.1  nisimura 		sc->sc_txfree += txs->txs_ndesc;
   1258  1.1  nisimura 		bus_dmamap_sync(sc->sc_dmat, txs->txs_dmamap,
   1259  1.1  nisimura 		    0, txs->txs_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
   1260  1.1  nisimura 		bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
   1261  1.1  nisimura 		m_freem(txs->txs_mbuf);
   1262  1.1  nisimura 		txs->txs_mbuf = NULL;
   1263  1.1  nisimura 	}
   1264  1.1  nisimura 	sc->sc_txsdirty = i;
   1265  1.1  nisimura 	if (sc->sc_txsfree == SCX_TXQUEUELEN)
   1266  1.1  nisimura 		ifp->if_timer = 0;
   1267  1.1  nisimura }
   1268  1.1  nisimura 
   1269  1.1  nisimura static void
   1270  1.1  nisimura rxintr(struct scx_softc *sc)
   1271  1.1  nisimura {
   1272  1.1  nisimura 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
   1273  1.1  nisimura 	struct scx_rxsoft *rxs;
   1274  1.1  nisimura 	struct mbuf *m;
   1275  1.1  nisimura 	uint32_t rxstat;
   1276  1.1  nisimura 	int i, len;
   1277  1.1  nisimura 
   1278  1.1  nisimura 	for (i = sc->sc_rxptr; /*CONSTCOND*/ 1; i = SCX_NEXTRX(i)) {
   1279  1.1  nisimura 		rxs = &sc->sc_rxsoft[i];
   1280  1.1  nisimura 
   1281  1.1  nisimura 		SCX_CDRXSYNC(sc, i,
   1282  1.1  nisimura 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
   1283  1.1  nisimura 
   1284  1.1  nisimura 		rxstat = sc->sc_rxdescs[i].r0;
   1285  1.1  nisimura 		if (rxstat & R0_OWN) /* desc is left empty */
   1286  1.1  nisimura 			break;
   1287  1.1  nisimura 
   1288  1.1  nisimura 		/* R0_FS | R0_LS must have been marked for this desc */
   1289  1.1  nisimura 
   1290  1.1  nisimura 		bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
   1291  1.1  nisimura 		    rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
   1292  1.1  nisimura 
   1293  1.1  nisimura 		len = sc->sc_rxdescs[i].r3 >> 16; /* 31:16 received */
   1294  1.1  nisimura 		len -= ETHER_CRC_LEN;	/* Trim CRC off */
   1295  1.1  nisimura 		m = rxs->rxs_mbuf;
   1296  1.1  nisimura 
   1297  1.1  nisimura 		if (add_rxbuf(sc, i) != 0) {
   1298  1.1  nisimura 			if_statinc(ifp, if_ierrors);
   1299  1.1  nisimura 			SCX_INIT_RXDESC(sc, i);
   1300  1.1  nisimura 			bus_dmamap_sync(sc->sc_dmat,
   1301  1.1  nisimura 			    rxs->rxs_dmamap, 0,
   1302  1.1  nisimura 			    rxs->rxs_dmamap->dm_mapsize,
   1303  1.1  nisimura 			    BUS_DMASYNC_PREREAD);
   1304  1.1  nisimura 			continue;
   1305  1.1  nisimura 		}
   1306  1.1  nisimura 
   1307  1.1  nisimura 		m_set_rcvif(m, ifp);
   1308  1.1  nisimura 		m->m_pkthdr.len = m->m_len = len;
   1309  1.1  nisimura 
   1310  1.1  nisimura 		if (rxstat & R0_CSUM) {
   1311  1.1  nisimura 			uint32_t csum = M_CSUM_IPv4;
   1312  1.1  nisimura 			if (rxstat & R0_CERR)
   1313  1.1  nisimura 				csum |= M_CSUM_IPv4_BAD;
   1314  1.1  nisimura 			m->m_pkthdr.csum_flags |= csum;
   1315  1.1  nisimura 		}
   1316  1.1  nisimura 		if_percpuq_enqueue(ifp->if_percpuq, m);
   1317  1.1  nisimura 	}
   1318  1.1  nisimura 	sc->sc_rxptr = i;
   1319  1.1  nisimura }
   1320  1.1  nisimura 
   1321  1.1  nisimura static int
   1322  1.1  nisimura add_rxbuf(struct scx_softc *sc, int i)
   1323  1.1  nisimura {
   1324  1.1  nisimura 	struct scx_rxsoft *rxs = &sc->sc_rxsoft[i];
   1325  1.1  nisimura 	struct mbuf *m;
   1326  1.1  nisimura 	int error;
   1327  1.1  nisimura 
   1328  1.1  nisimura 	MGETHDR(m, M_DONTWAIT, MT_DATA);
   1329  1.1  nisimura 	if (m == NULL)
   1330  1.1  nisimura 		return ENOBUFS;
   1331  1.1  nisimura 
   1332  1.1  nisimura 	MCLGET(m, M_DONTWAIT);
   1333  1.1  nisimura 	if ((m->m_flags & M_EXT) == 0) {
   1334  1.1  nisimura 		m_freem(m);
   1335  1.1  nisimura 		return ENOBUFS;
   1336  1.1  nisimura 	}
   1337  1.1  nisimura 
   1338  1.1  nisimura 	if (rxs->rxs_mbuf != NULL)
   1339  1.1  nisimura 		bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
   1340  1.1  nisimura 
   1341  1.1  nisimura 	rxs->rxs_mbuf = m;
   1342  1.1  nisimura 
   1343  1.1  nisimura 	error = bus_dmamap_load(sc->sc_dmat, rxs->rxs_dmamap,
   1344  1.1  nisimura 	    m->m_ext.ext_buf, m->m_ext.ext_size, NULL, BUS_DMA_NOWAIT);
   1345  1.1  nisimura 	if (error) {
   1346  1.1  nisimura 		aprint_error_dev(sc->sc_dev,
   1347  1.1  nisimura 		    "can't load rx DMA map %d, error = %d\n", i, error);
   1348  1.1  nisimura 		panic("add_rxbuf");
   1349  1.1  nisimura 	}
   1350  1.1  nisimura 
   1351  1.1  nisimura 	bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
   1352  1.1  nisimura 	    rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
   1353  1.1  nisimura 	SCX_INIT_RXDESC(sc, i);
   1354  1.1  nisimura 
   1355  1.1  nisimura 	return 0;
   1356  1.1  nisimura }
   1357  1.1  nisimura 
   1358  1.1  nisimura static int
   1359  1.1  nisimura spin_waitfor(struct scx_softc *sc, int reg, int exist)
   1360  1.1  nisimura {
   1361  1.1  nisimura 	int val, loop;
   1362  1.1  nisimura 
   1363  1.1  nisimura 	val = CSR_READ(sc, reg);
   1364  1.1  nisimura 	if ((val & exist) == 0)
   1365  1.1  nisimura 		return 0;
   1366  1.1  nisimura 	loop = 3000;
   1367  1.1  nisimura 	do {
   1368  1.1  nisimura 		DELAY(10);
   1369  1.1  nisimura 		val = CSR_READ(sc, reg);
   1370  1.1  nisimura 	} while (--loop > 0 && (val & exist) != 0);
   1371  1.1  nisimura 	return (loop > 0) ? 0 : ETIMEDOUT;
   1372  1.1  nisimura }
   1373  1.1  nisimura 
   1374  1.1  nisimura static int
   1375  1.1  nisimura mac_read(struct scx_softc *sc, int reg)
   1376  1.1  nisimura {
   1377  1.1  nisimura 
   1378  1.1  nisimura 	CSR_WRITE(sc, MACCMD, reg);
   1379  1.1  nisimura 	(void)spin_waitfor(sc, MACCMD, CMD_BUSY);
   1380  1.1  nisimura 	return CSR_READ(sc, MACDATA);
   1381  1.1  nisimura }
   1382  1.1  nisimura 
   1383  1.1  nisimura static void
   1384  1.1  nisimura mac_write(struct scx_softc *sc, int reg, int val)
   1385  1.1  nisimura {
   1386  1.1  nisimura 
   1387  1.1  nisimura 	CSR_WRITE(sc, MACDATA, val);
   1388  1.1  nisimura 	CSR_WRITE(sc, MACCMD, reg | CMD_IOWR);
   1389  1.1  nisimura 	(void)spin_waitfor(sc, MACCMD, CMD_BUSY);
   1390  1.1  nisimura }
   1391  1.1  nisimura 
   1392  1.1  nisimura static int
   1393  1.1  nisimura get_garclk(uint32_t freq)
   1394  1.1  nisimura {
   1395  1.1  nisimura 	int i;
   1396  1.1  nisimura 
   1397  1.1  nisimura 	for (i = 0; garclk[i].freq != 0; i++) {
   1398  1.1  nisimura 		if (freq < garclk[i].freq)
   1399  1.1  nisimura 			return garclk[i].bit;
   1400  1.1  nisimura 	}
   1401  1.1  nisimura 	return garclk[i - 1].bit;
   1402  1.1  nisimura }
   1403  1.1  nisimura 
   1404  1.1  nisimura static void
   1405  1.1  nisimura loaducode(struct scx_softc *sc)
   1406  1.1  nisimura {
   1407  1.1  nisimura 	uint32_t up, lo, sz;
   1408  1.1  nisimura 	uint64_t addr;
   1409  1.1  nisimura 
   1410  1.3  nisimura 	sc->sc_ucodeloaded = 1;
   1411  1.3  nisimura 
   1412  1.1  nisimura 	up = EE_READ(sc, 0x08); /* H->M ucode addr high */
   1413  1.1  nisimura 	lo = EE_READ(sc, 0x0c); /* H->M ucode addr low */
   1414  1.1  nisimura 	sz = EE_READ(sc, 0x10); /* H->M ucode size */
   1415  1.2  nisimura 	sz *= 4;
   1416  1.1  nisimura 	addr = ((uint64_t)up << 32) | lo;
   1417  1.1  nisimura 	aprint_normal_dev(sc->sc_dev, "H2M ucode %u\n", sz);
   1418  1.3  nisimura 	injectucode(sc, H2MENG, (bus_addr_t)addr, (bus_size_t)sz);
   1419  1.1  nisimura 
   1420  1.1  nisimura 	up = EE_READ(sc, 0x14); /* M->H ucode addr high */
   1421  1.1  nisimura 	lo = EE_READ(sc, 0x18); /* M->H ucode addr low */
   1422  1.1  nisimura 	sz = EE_READ(sc, 0x1c); /* M->H ucode size */
   1423  1.2  nisimura 	sz *= 4;
   1424  1.1  nisimura 	addr = ((uint64_t)up << 32) | lo;
   1425  1.3  nisimura 	injectucode(sc, M2HENG, (bus_addr_t)addr, (bus_size_t)sz);
   1426  1.1  nisimura 	aprint_normal_dev(sc->sc_dev, "M2H ucode %u\n", sz);
   1427  1.1  nisimura 
   1428  1.1  nisimura 	lo = EE_READ(sc, 0x20); /* PKT ucode addr */
   1429  1.1  nisimura 	sz = EE_READ(sc, 0x24); /* PKT ucode size */
   1430  1.2  nisimura 	sz *= 4;
   1431  1.3  nisimura 	injectucode(sc, PKTENG, (bus_addr_t)lo, (bus_size_t)sz);
   1432  1.1  nisimura 	aprint_normal_dev(sc->sc_dev, "PKT ucode %u\n", sz);
   1433  1.1  nisimura }
   1434  1.1  nisimura 
   1435  1.1  nisimura static void
   1436  1.2  nisimura injectucode(struct scx_softc *sc, int port,
   1437  1.2  nisimura 	bus_addr_t addr, bus_size_t size)
   1438  1.1  nisimura {
   1439  1.2  nisimura 	bus_space_handle_t bsh;
   1440  1.2  nisimura 	bus_size_t off;
   1441  1.1  nisimura 	uint32_t ucode;
   1442  1.1  nisimura 	int i;
   1443  1.1  nisimura 
   1444  1.3  nisimura 	port &= 03;
   1445  1.2  nisimura 	if (!bus_space_map(sc->sc_st, addr, size, 0, &bsh) != 0) {
   1446  1.3  nisimura 		aprint_error_dev(sc->sc_dev,
   1447  1.3  nisimura 		    "eeprom map failure for ucode port 0x%x\n", port);
   1448  1.2  nisimura 		return;
   1449  1.2  nisimura 	}
   1450  1.2  nisimura 	off = 0;
   1451  1.1  nisimura 	for (i = 0; i < size; i++) {
   1452  1.2  nisimura 		ucode = bus_space_read_4(sc->sc_st, bsh, off);
   1453  1.1  nisimura 		CSR_WRITE(sc, port, ucode);
   1454  1.2  nisimura 		off += 4;
   1455  1.1  nisimura 	}
   1456  1.2  nisimura 	bus_space_unmap(sc->sc_st, bsh, size);
   1457  1.1  nisimura }
   1458