Home | History | Annotate | Line # | Download | only in sunxi
sunxi_emac.c revision 1.4.6.2
      1  1.4.6.2  skrll /* $NetBSD: sunxi_emac.c,v 1.4.6.2 2017/08/28 17:51:32 skrll Exp $ */
      2  1.4.6.2  skrll 
      3  1.4.6.2  skrll /*-
      4  1.4.6.2  skrll  * Copyright (c) 2016-2017 Jared McNeill <jmcneill (at) invisible.ca>
      5  1.4.6.2  skrll  * All rights reserved.
      6  1.4.6.2  skrll  *
      7  1.4.6.2  skrll  * Redistribution and use in source and binary forms, with or without
      8  1.4.6.2  skrll  * modification, are permitted provided that the following conditions
      9  1.4.6.2  skrll  * are met:
     10  1.4.6.2  skrll  * 1. Redistributions of source code must retain the above copyright
     11  1.4.6.2  skrll  *    notice, this list of conditions and the following disclaimer.
     12  1.4.6.2  skrll  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.4.6.2  skrll  *    notice, this list of conditions and the following disclaimer in the
     14  1.4.6.2  skrll  *    documentation and/or other materials provided with the distribution.
     15  1.4.6.2  skrll  *
     16  1.4.6.2  skrll  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  1.4.6.2  skrll  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  1.4.6.2  skrll  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  1.4.6.2  skrll  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  1.4.6.2  skrll  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  1.4.6.2  skrll  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  1.4.6.2  skrll  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  1.4.6.2  skrll  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  1.4.6.2  skrll  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  1.4.6.2  skrll  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  1.4.6.2  skrll  * SUCH DAMAGE.
     27  1.4.6.2  skrll  */
     28  1.4.6.2  skrll 
     29  1.4.6.2  skrll /*
     30  1.4.6.2  skrll  * Allwinner Gigabit Ethernet MAC (EMAC) controller
     31  1.4.6.2  skrll  */
     32  1.4.6.2  skrll 
     33  1.4.6.2  skrll #include "opt_net_mpsafe.h"
     34  1.4.6.2  skrll 
     35  1.4.6.2  skrll #include <sys/cdefs.h>
     36  1.4.6.2  skrll __KERNEL_RCSID(0, "$NetBSD: sunxi_emac.c,v 1.4.6.2 2017/08/28 17:51:32 skrll Exp $");
     37  1.4.6.2  skrll 
     38  1.4.6.2  skrll #include <sys/param.h>
     39  1.4.6.2  skrll #include <sys/bus.h>
     40  1.4.6.2  skrll #include <sys/device.h>
     41  1.4.6.2  skrll #include <sys/intr.h>
     42  1.4.6.2  skrll #include <sys/systm.h>
     43  1.4.6.2  skrll #include <sys/kernel.h>
     44  1.4.6.2  skrll #include <sys/mutex.h>
     45  1.4.6.2  skrll #include <sys/callout.h>
     46  1.4.6.2  skrll #include <sys/gpio.h>
     47  1.4.6.2  skrll #include <sys/cprng.h>
     48  1.4.6.2  skrll 
     49  1.4.6.2  skrll #include <net/if.h>
     50  1.4.6.2  skrll #include <net/if_dl.h>
     51  1.4.6.2  skrll #include <net/if_ether.h>
     52  1.4.6.2  skrll #include <net/if_media.h>
     53  1.4.6.2  skrll #include <net/bpf.h>
     54  1.4.6.2  skrll 
     55  1.4.6.2  skrll #include <dev/mii/miivar.h>
     56  1.4.6.2  skrll 
     57  1.4.6.2  skrll #include <dev/fdt/fdtvar.h>
     58  1.4.6.2  skrll 
     59  1.4.6.2  skrll #include <arm/sunxi/sunxi_emac.h>
     60  1.4.6.2  skrll 
     61  1.4.6.2  skrll #ifdef NET_MPSAFE
     62  1.4.6.2  skrll #define	EMAC_MPSAFE		1
     63  1.4.6.2  skrll #define	CALLOUT_FLAGS		CALLOUT_MPSAFE
     64  1.4.6.2  skrll #define	FDT_INTR_FLAGS		FDT_INTR_MPSAFE
     65  1.4.6.2  skrll #else
     66  1.4.6.2  skrll #define	CALLOUT_FLAGS		0
     67  1.4.6.2  skrll #define	FDT_INTR_FLAGS		0
     68  1.4.6.2  skrll #endif
     69  1.4.6.2  skrll 
     70  1.4.6.2  skrll #define	EMAC_IFNAME		"emac%d"
     71  1.4.6.2  skrll 
     72  1.4.6.2  skrll #define	ETHER_ALIGN		2
     73  1.4.6.2  skrll 
     74  1.4.6.2  skrll #define	EMAC_LOCK(sc)		mutex_enter(&(sc)->mtx)
     75  1.4.6.2  skrll #define	EMAC_UNLOCK(sc)		mutex_exit(&(sc)->mtx)
     76  1.4.6.2  skrll #define	EMAC_ASSERT_LOCKED(sc)	KASSERT(mutex_owned(&(sc)->mtx))
     77  1.4.6.2  skrll 
     78  1.4.6.2  skrll #define	DESC_ALIGN		sizeof(struct sunxi_emac_desc)
     79  1.4.6.2  skrll #define	TX_DESC_COUNT		1024
     80  1.4.6.2  skrll #define	TX_DESC_SIZE		(sizeof(struct sunxi_emac_desc) * TX_DESC_COUNT)
     81  1.4.6.2  skrll #define	RX_DESC_COUNT		256
     82  1.4.6.2  skrll #define	RX_DESC_SIZE		(sizeof(struct sunxi_emac_desc) * RX_DESC_COUNT)
     83  1.4.6.2  skrll 
     84  1.4.6.2  skrll #define	DESC_OFF(n)		((n) * sizeof(struct sunxi_emac_desc))
     85  1.4.6.2  skrll #define	TX_NEXT(n)		(((n) + 1) & (TX_DESC_COUNT - 1))
     86  1.4.6.2  skrll #define	TX_SKIP(n, o)		(((n) + (o)) & (TX_DESC_COUNT - 1))
     87  1.4.6.2  skrll #define	RX_NEXT(n)		(((n) + 1) & (RX_DESC_COUNT - 1))
     88  1.4.6.2  skrll 
     89  1.4.6.2  skrll #define	TX_MAX_SEGS		128
     90  1.4.6.2  skrll 
     91  1.4.6.2  skrll #define	SOFT_RST_RETRY		1000
     92  1.4.6.2  skrll #define	MII_BUSY_RETRY		1000
     93  1.4.6.2  skrll #define	MDIO_FREQ		2500000
     94  1.4.6.2  skrll 
     95  1.4.6.2  skrll #define	BURST_LEN_DEFAULT	8
     96  1.4.6.2  skrll #define	RX_TX_PRI_DEFAULT	0
     97  1.4.6.2  skrll #define	PAUSE_TIME_DEFAULT	0x400
     98  1.4.6.2  skrll #define	TX_INTERVAL_DEFAULT	64
     99  1.4.6.2  skrll 
    100  1.4.6.2  skrll /* syscon EMAC clock register */
    101  1.4.6.2  skrll #define	EMAC_CLK_EPHY_ADDR	(0x1f << 20)	/* H3 */
    102  1.4.6.2  skrll #define	EMAC_CLK_EPHY_ADDR_SHIFT 20
    103  1.4.6.2  skrll #define	EMAC_CLK_EPHY_LED_POL	(1 << 17)	/* H3 */
    104  1.4.6.2  skrll #define	EMAC_CLK_EPHY_SHUTDOWN	(1 << 16)	/* H3 */
    105  1.4.6.2  skrll #define	EMAC_CLK_EPHY_SELECT	(1 << 15)	/* H3 */
    106  1.4.6.2  skrll #define	EMAC_CLK_RMII_EN	(1 << 13)
    107  1.4.6.2  skrll #define	EMAC_CLK_ETXDC		(0x7 << 10)
    108  1.4.6.2  skrll #define	EMAC_CLK_ETXDC_SHIFT	10
    109  1.4.6.2  skrll #define	EMAC_CLK_ERXDC		(0x1f << 5)
    110  1.4.6.2  skrll #define	EMAC_CLK_ERXDC_SHIFT	5
    111  1.4.6.2  skrll #define	EMAC_CLK_PIT		(0x1 << 2)
    112  1.4.6.2  skrll #define	 EMAC_CLK_PIT_MII	(0 << 2)
    113  1.4.6.2  skrll #define	 EMAC_CLK_PIT_RGMII	(1 << 2)
    114  1.4.6.2  skrll #define	EMAC_CLK_SRC		(0x3 << 0)
    115  1.4.6.2  skrll #define	 EMAC_CLK_SRC_MII	(0 << 0)
    116  1.4.6.2  skrll #define	 EMAC_CLK_SRC_EXT_RGMII	(1 << 0)
    117  1.4.6.2  skrll #define	 EMAC_CLK_SRC_RGMII	(2 << 0)
    118  1.4.6.2  skrll 
    119  1.4.6.2  skrll /* Burst length of RX and TX DMA transfers */
    120  1.4.6.2  skrll static int sunxi_emac_burst_len = BURST_LEN_DEFAULT;
    121  1.4.6.2  skrll 
    122  1.4.6.2  skrll /* RX / TX DMA priority. If 1, RX DMA has priority over TX DMA. */
    123  1.4.6.2  skrll static int sunxi_emac_rx_tx_pri = RX_TX_PRI_DEFAULT;
    124  1.4.6.2  skrll 
    125  1.4.6.2  skrll /* Pause time field in the transmitted control frame */
    126  1.4.6.2  skrll static int sunxi_emac_pause_time = PAUSE_TIME_DEFAULT;
    127  1.4.6.2  skrll 
    128  1.4.6.2  skrll /* Request a TX interrupt every <n> descriptors */
    129  1.4.6.2  skrll static int sunxi_emac_tx_interval = TX_INTERVAL_DEFAULT;
    130  1.4.6.2  skrll 
    131  1.4.6.2  skrll enum sunxi_emac_type {
    132  1.4.6.2  skrll 	EMAC_A83T = 1,
    133  1.4.6.2  skrll 	EMAC_H3,
    134  1.4.6.2  skrll };
    135  1.4.6.2  skrll 
    136  1.4.6.2  skrll static const struct of_compat_data compat_data[] = {
    137  1.4.6.2  skrll 	{ "allwinner,sun8i-a83t-emac",	EMAC_A83T },
    138  1.4.6.2  skrll 	{ "allwinner,sun8i-h3-emac",	EMAC_H3 },
    139  1.4.6.2  skrll 	{ NULL }
    140  1.4.6.2  skrll };
    141  1.4.6.2  skrll 
    142  1.4.6.2  skrll struct sunxi_emac_bufmap {
    143  1.4.6.2  skrll 	bus_dmamap_t		map;
    144  1.4.6.2  skrll 	struct mbuf		*mbuf;
    145  1.4.6.2  skrll };
    146  1.4.6.2  skrll 
    147  1.4.6.2  skrll struct sunxi_emac_txring {
    148  1.4.6.2  skrll 	bus_dma_tag_t		desc_tag;
    149  1.4.6.2  skrll 	bus_dmamap_t		desc_map;
    150  1.4.6.2  skrll 	bus_dma_segment_t	desc_dmaseg;
    151  1.4.6.2  skrll 	struct sunxi_emac_desc	*desc_ring;
    152  1.4.6.2  skrll 	bus_addr_t		desc_ring_paddr;
    153  1.4.6.2  skrll 	bus_dma_tag_t		buf_tag;
    154  1.4.6.2  skrll 	struct sunxi_emac_bufmap buf_map[TX_DESC_COUNT];
    155  1.4.6.2  skrll 	u_int			cur, next, queued;
    156  1.4.6.2  skrll };
    157  1.4.6.2  skrll 
    158  1.4.6.2  skrll struct sunxi_emac_rxring {
    159  1.4.6.2  skrll 	bus_dma_tag_t		desc_tag;
    160  1.4.6.2  skrll 	bus_dmamap_t		desc_map;
    161  1.4.6.2  skrll 	bus_dma_segment_t	desc_dmaseg;
    162  1.4.6.2  skrll 	struct sunxi_emac_desc	*desc_ring;
    163  1.4.6.2  skrll 	bus_addr_t		desc_ring_paddr;
    164  1.4.6.2  skrll 	bus_dma_tag_t		buf_tag;
    165  1.4.6.2  skrll 	struct sunxi_emac_bufmap buf_map[RX_DESC_COUNT];
    166  1.4.6.2  skrll 	u_int			cur;
    167  1.4.6.2  skrll };
    168  1.4.6.2  skrll 
    169  1.4.6.2  skrll enum {
    170  1.4.6.2  skrll 	_RES_EMAC,
    171  1.4.6.2  skrll 	_RES_SYSCON,
    172  1.4.6.2  skrll 	_RES_NITEMS
    173  1.4.6.2  skrll };
    174  1.4.6.2  skrll 
    175  1.4.6.2  skrll struct sunxi_emac_softc {
    176  1.4.6.2  skrll 	device_t		dev;
    177  1.4.6.2  skrll 	int			phandle;
    178  1.4.6.2  skrll 	enum sunxi_emac_type	type;
    179  1.4.6.2  skrll 	bus_space_tag_t		bst;
    180  1.4.6.2  skrll 	bus_dma_tag_t		dmat;
    181  1.4.6.2  skrll 
    182  1.4.6.2  skrll 	bus_space_handle_t	bsh[_RES_NITEMS];
    183  1.4.6.2  skrll 	struct clk		*clk_ahb;
    184  1.4.6.2  skrll 	struct clk		*clk_ephy;
    185  1.4.6.2  skrll 	struct fdtbus_reset	*rst_ahb;
    186  1.4.6.2  skrll 	struct fdtbus_reset	*rst_ephy;
    187  1.4.6.2  skrll 	struct fdtbus_regulator	*reg_phy;
    188  1.4.6.2  skrll 	struct fdtbus_gpio_pin	*pin_reset;
    189  1.4.6.2  skrll 
    190  1.4.6.2  skrll 	kmutex_t		mtx;
    191  1.4.6.2  skrll 	struct ethercom		ec;
    192  1.4.6.2  skrll 	struct mii_data		mii;
    193  1.4.6.2  skrll 	callout_t		stat_ch;
    194  1.4.6.2  skrll 	void			*ih;
    195  1.4.6.2  skrll 	u_int			mdc_div_ratio_m;
    196  1.4.6.2  skrll 
    197  1.4.6.2  skrll 	struct sunxi_emac_txring	tx;
    198  1.4.6.2  skrll 	struct sunxi_emac_rxring	rx;
    199  1.4.6.2  skrll };
    200  1.4.6.2  skrll 
    201  1.4.6.2  skrll #define	RD4(sc, reg)			\
    202  1.4.6.2  skrll 	bus_space_read_4((sc)->bst, (sc)->bsh[_RES_EMAC], (reg))
    203  1.4.6.2  skrll #define	WR4(sc, reg, val)		\
    204  1.4.6.2  skrll 	bus_space_write_4((sc)->bst, (sc)->bsh[_RES_EMAC], (reg), (val))
    205  1.4.6.2  skrll 
    206  1.4.6.2  skrll #define	SYSCONRD4(sc, reg)		\
    207  1.4.6.2  skrll 	bus_space_read_4((sc)->bst, (sc)->bsh[_RES_SYSCON], (reg))
    208  1.4.6.2  skrll #define	SYSCONWR4(sc, reg, val)		\
    209  1.4.6.2  skrll 	bus_space_write_4((sc)->bst, (sc)->bsh[_RES_SYSCON], (reg), (val))
    210  1.4.6.2  skrll 
    211  1.4.6.2  skrll static int
    212  1.4.6.2  skrll sunxi_emac_mii_readreg(device_t dev, int phy, int reg)
    213  1.4.6.2  skrll {
    214  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = device_private(dev);
    215  1.4.6.2  skrll 	int retry, val;
    216  1.4.6.2  skrll 
    217  1.4.6.2  skrll 	val = 0;
    218  1.4.6.2  skrll 
    219  1.4.6.2  skrll 	WR4(sc, EMAC_MII_CMD,
    220  1.4.6.2  skrll 	    (sc->mdc_div_ratio_m << MDC_DIV_RATIO_M_SHIFT) |
    221  1.4.6.2  skrll 	    (phy << PHY_ADDR_SHIFT) |
    222  1.4.6.2  skrll 	    (reg << PHY_REG_ADDR_SHIFT) |
    223  1.4.6.2  skrll 	    MII_BUSY);
    224  1.4.6.2  skrll 	for (retry = MII_BUSY_RETRY; retry > 0; retry--) {
    225  1.4.6.2  skrll 		if ((RD4(sc, EMAC_MII_CMD) & MII_BUSY) == 0) {
    226  1.4.6.2  skrll 			val = RD4(sc, EMAC_MII_DATA);
    227  1.4.6.2  skrll 			break;
    228  1.4.6.2  skrll 		}
    229  1.4.6.2  skrll 		delay(10);
    230  1.4.6.2  skrll 	}
    231  1.4.6.2  skrll 
    232  1.4.6.2  skrll 	if (retry == 0)
    233  1.4.6.2  skrll 		device_printf(dev, "phy read timeout, phy=%d reg=%d\n",
    234  1.4.6.2  skrll 		    phy, reg);
    235  1.4.6.2  skrll 
    236  1.4.6.2  skrll 	return val;
    237  1.4.6.2  skrll }
    238  1.4.6.2  skrll 
    239  1.4.6.2  skrll static void
    240  1.4.6.2  skrll sunxi_emac_mii_writereg(device_t dev, int phy, int reg, int val)
    241  1.4.6.2  skrll {
    242  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = device_private(dev);
    243  1.4.6.2  skrll 	int retry;
    244  1.4.6.2  skrll 
    245  1.4.6.2  skrll 	WR4(sc, EMAC_MII_DATA, val);
    246  1.4.6.2  skrll 	WR4(sc, EMAC_MII_CMD,
    247  1.4.6.2  skrll 	    (sc->mdc_div_ratio_m << MDC_DIV_RATIO_M_SHIFT) |
    248  1.4.6.2  skrll 	    (phy << PHY_ADDR_SHIFT) |
    249  1.4.6.2  skrll 	    (reg << PHY_REG_ADDR_SHIFT) |
    250  1.4.6.2  skrll 	    MII_WR | MII_BUSY);
    251  1.4.6.2  skrll 	for (retry = MII_BUSY_RETRY; retry > 0; retry--) {
    252  1.4.6.2  skrll 		if ((RD4(sc, EMAC_MII_CMD) & MII_BUSY) == 0)
    253  1.4.6.2  skrll 			break;
    254  1.4.6.2  skrll 		delay(10);
    255  1.4.6.2  skrll 	}
    256  1.4.6.2  skrll 
    257  1.4.6.2  skrll 	if (retry == 0)
    258  1.4.6.2  skrll 		device_printf(dev, "phy write timeout, phy=%d reg=%d\n",
    259  1.4.6.2  skrll 		    phy, reg);
    260  1.4.6.2  skrll }
    261  1.4.6.2  skrll 
    262  1.4.6.2  skrll static void
    263  1.4.6.2  skrll sunxi_emac_update_link(struct sunxi_emac_softc *sc)
    264  1.4.6.2  skrll {
    265  1.4.6.2  skrll 	struct mii_data *mii = &sc->mii;
    266  1.4.6.2  skrll 	uint32_t val;
    267  1.4.6.2  skrll 
    268  1.4.6.2  skrll 	val = RD4(sc, EMAC_BASIC_CTL_0);
    269  1.4.6.2  skrll 	val &= ~(BASIC_CTL_SPEED | BASIC_CTL_DUPLEX);
    270  1.4.6.2  skrll 
    271  1.4.6.2  skrll 	if (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T ||
    272  1.4.6.2  skrll 	    IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_SX)
    273  1.4.6.2  skrll 		val |= BASIC_CTL_SPEED_1000 << BASIC_CTL_SPEED_SHIFT;
    274  1.4.6.2  skrll 	else if (IFM_SUBTYPE(mii->mii_media_active) == IFM_100_TX)
    275  1.4.6.2  skrll 		val |= BASIC_CTL_SPEED_100 << BASIC_CTL_SPEED_SHIFT;
    276  1.4.6.2  skrll 	else
    277  1.4.6.2  skrll 		val |= BASIC_CTL_SPEED_10 << BASIC_CTL_SPEED_SHIFT;
    278  1.4.6.2  skrll 
    279  1.4.6.2  skrll 	if ((IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0)
    280  1.4.6.2  skrll 		val |= BASIC_CTL_DUPLEX;
    281  1.4.6.2  skrll 
    282  1.4.6.2  skrll 	WR4(sc, EMAC_BASIC_CTL_0, val);
    283  1.4.6.2  skrll 
    284  1.4.6.2  skrll 	val = RD4(sc, EMAC_RX_CTL_0);
    285  1.4.6.2  skrll 	val &= ~RX_FLOW_CTL_EN;
    286  1.4.6.2  skrll 	if ((IFM_OPTIONS(mii->mii_media_active) & IFM_ETH_RXPAUSE) != 0)
    287  1.4.6.2  skrll 		val |= RX_FLOW_CTL_EN;
    288  1.4.6.2  skrll 	WR4(sc, EMAC_RX_CTL_0, val);
    289  1.4.6.2  skrll 
    290  1.4.6.2  skrll 	val = RD4(sc, EMAC_TX_FLOW_CTL);
    291  1.4.6.2  skrll 	val &= ~(PAUSE_TIME|TX_FLOW_CTL_EN);
    292  1.4.6.2  skrll 	if ((IFM_OPTIONS(mii->mii_media_active) & IFM_ETH_TXPAUSE) != 0)
    293  1.4.6.2  skrll 		val |= TX_FLOW_CTL_EN;
    294  1.4.6.2  skrll 	if ((IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0)
    295  1.4.6.2  skrll 		val |= sunxi_emac_pause_time << PAUSE_TIME_SHIFT;
    296  1.4.6.2  skrll 	WR4(sc, EMAC_TX_FLOW_CTL, val);
    297  1.4.6.2  skrll }
    298  1.4.6.2  skrll 
    299  1.4.6.2  skrll static void
    300  1.4.6.2  skrll sunxi_emac_mii_statchg(struct ifnet *ifp)
    301  1.4.6.2  skrll {
    302  1.4.6.2  skrll 	struct sunxi_emac_softc * const sc = ifp->if_softc;
    303  1.4.6.2  skrll 
    304  1.4.6.2  skrll 	sunxi_emac_update_link(sc);
    305  1.4.6.2  skrll }
    306  1.4.6.2  skrll 
    307  1.4.6.2  skrll static void
    308  1.4.6.2  skrll sunxi_emac_dma_sync(struct sunxi_emac_softc *sc, bus_dma_tag_t dmat,
    309  1.4.6.2  skrll     bus_dmamap_t map, int start, int end, int total, int flags)
    310  1.4.6.2  skrll {
    311  1.4.6.2  skrll 	if (end > start) {
    312  1.4.6.2  skrll 		bus_dmamap_sync(dmat, map, DESC_OFF(start),
    313  1.4.6.2  skrll 		    DESC_OFF(end) - DESC_OFF(start), flags);
    314  1.4.6.2  skrll 	} else {
    315  1.4.6.2  skrll 		bus_dmamap_sync(dmat, map, DESC_OFF(start),
    316  1.4.6.2  skrll 		    DESC_OFF(total) - DESC_OFF(start), flags);
    317  1.4.6.2  skrll 		if (DESC_OFF(end) - DESC_OFF(0) > 0)
    318  1.4.6.2  skrll 			bus_dmamap_sync(dmat, map, DESC_OFF(0),
    319  1.4.6.2  skrll 			    DESC_OFF(end) - DESC_OFF(0), flags);
    320  1.4.6.2  skrll 	}
    321  1.4.6.2  skrll }
    322  1.4.6.2  skrll 
    323  1.4.6.2  skrll static void
    324  1.4.6.2  skrll sunxi_emac_setup_txdesc(struct sunxi_emac_softc *sc, int index, int flags,
    325  1.4.6.2  skrll     bus_addr_t paddr, u_int len)
    326  1.4.6.2  skrll {
    327  1.4.6.2  skrll 	uint32_t status, size;
    328  1.4.6.2  skrll 
    329  1.4.6.2  skrll 	if (paddr == 0 || len == 0) {
    330  1.4.6.2  skrll 		status = 0;
    331  1.4.6.2  skrll 		size = 0;
    332  1.4.6.2  skrll 		--sc->tx.queued;
    333  1.4.6.2  skrll 	} else {
    334  1.4.6.2  skrll 		status = TX_DESC_CTL;
    335  1.4.6.2  skrll 		size = flags | len;
    336  1.4.6.2  skrll 		if ((index & (sunxi_emac_tx_interval - 1)) == 0)
    337  1.4.6.2  skrll 			size |= TX_INT_CTL;
    338  1.4.6.2  skrll 		++sc->tx.queued;
    339  1.4.6.2  skrll 	}
    340  1.4.6.2  skrll 
    341  1.4.6.2  skrll 	sc->tx.desc_ring[index].addr = htole32((uint32_t)paddr);
    342  1.4.6.2  skrll 	sc->tx.desc_ring[index].size = htole32(size);
    343  1.4.6.2  skrll 	sc->tx.desc_ring[index].status = htole32(status);
    344  1.4.6.2  skrll }
    345  1.4.6.2  skrll 
    346  1.4.6.2  skrll static int
    347  1.4.6.2  skrll sunxi_emac_setup_txbuf(struct sunxi_emac_softc *sc, int index, struct mbuf *m)
    348  1.4.6.2  skrll {
    349  1.4.6.2  skrll 	bus_dma_segment_t *segs;
    350  1.4.6.2  skrll 	int error, nsegs, cur, i, flags;
    351  1.4.6.2  skrll 	u_int csum_flags;
    352  1.4.6.2  skrll 
    353  1.4.6.2  skrll 	error = bus_dmamap_load_mbuf(sc->tx.buf_tag,
    354  1.4.6.2  skrll 	    sc->tx.buf_map[index].map, m, BUS_DMA_WRITE|BUS_DMA_NOWAIT);
    355  1.4.6.2  skrll 	if (error == EFBIG) {
    356  1.4.6.2  skrll 		device_printf(sc->dev,
    357  1.4.6.2  skrll 		    "TX packet needs too many DMA segments, dropping...\n");
    358  1.4.6.2  skrll 		m_freem(m);
    359  1.4.6.2  skrll 		return 0;
    360  1.4.6.2  skrll 	}
    361  1.4.6.2  skrll 	if (error != 0)
    362  1.4.6.2  skrll 		return 0;
    363  1.4.6.2  skrll 
    364  1.4.6.2  skrll 	segs = sc->tx.buf_map[index].map->dm_segs;
    365  1.4.6.2  skrll 	nsegs = sc->tx.buf_map[index].map->dm_nsegs;
    366  1.4.6.2  skrll 
    367  1.4.6.2  skrll 	flags = TX_FIR_DESC;
    368  1.4.6.2  skrll 	if ((m->m_pkthdr.csum_flags & M_CSUM_IPv4) != 0) {
    369  1.4.6.2  skrll 		if ((m->m_pkthdr.csum_flags & (M_CSUM_TCPv4|M_CSUM_UDPv4)) != 0)
    370  1.4.6.2  skrll 			csum_flags = TX_CHECKSUM_CTL_FULL;
    371  1.4.6.2  skrll 		else
    372  1.4.6.2  skrll 			csum_flags = TX_CHECKSUM_CTL_IP;
    373  1.4.6.2  skrll 		flags |= (csum_flags << TX_CHECKSUM_CTL_SHIFT);
    374  1.4.6.2  skrll 	}
    375  1.4.6.2  skrll 
    376  1.4.6.2  skrll 	for (cur = index, i = 0; i < nsegs; i++) {
    377  1.4.6.2  skrll 		sc->tx.buf_map[cur].mbuf = (i == 0 ? m : NULL);
    378  1.4.6.2  skrll 		if (i == nsegs - 1)
    379  1.4.6.2  skrll 			flags |= TX_LAST_DESC;
    380  1.4.6.2  skrll 
    381  1.4.6.2  skrll 		sunxi_emac_setup_txdesc(sc, cur, flags, segs[i].ds_addr,
    382  1.4.6.2  skrll 		    segs[i].ds_len);
    383  1.4.6.2  skrll 		flags &= ~TX_FIR_DESC;
    384  1.4.6.2  skrll 		cur = TX_NEXT(cur);
    385  1.4.6.2  skrll 	}
    386  1.4.6.2  skrll 
    387  1.4.6.2  skrll 	bus_dmamap_sync(sc->tx.buf_tag, sc->tx.buf_map[index].map,
    388  1.4.6.2  skrll 	    0, sc->tx.buf_map[index].map->dm_mapsize, BUS_DMASYNC_PREWRITE);
    389  1.4.6.2  skrll 
    390  1.4.6.2  skrll 	return nsegs;
    391  1.4.6.2  skrll }
    392  1.4.6.2  skrll 
    393  1.4.6.2  skrll static void
    394  1.4.6.2  skrll sunxi_emac_setup_rxdesc(struct sunxi_emac_softc *sc, int index,
    395  1.4.6.2  skrll     bus_addr_t paddr)
    396  1.4.6.2  skrll {
    397  1.4.6.2  skrll 	uint32_t status, size;
    398  1.4.6.2  skrll 
    399  1.4.6.2  skrll 	status = RX_DESC_CTL;
    400  1.4.6.2  skrll 	size = MCLBYTES - 1;
    401  1.4.6.2  skrll 
    402  1.4.6.2  skrll 	sc->rx.desc_ring[index].addr = htole32((uint32_t)paddr);
    403  1.4.6.2  skrll 	sc->rx.desc_ring[index].size = htole32(size);
    404  1.4.6.2  skrll 	sc->rx.desc_ring[index].next =
    405  1.4.6.2  skrll 	    htole32(sc->rx.desc_ring_paddr + DESC_OFF(RX_NEXT(index)));
    406  1.4.6.2  skrll 	sc->rx.desc_ring[index].status = htole32(status);
    407  1.4.6.2  skrll }
    408  1.4.6.2  skrll 
    409  1.4.6.2  skrll static int
    410  1.4.6.2  skrll sunxi_emac_setup_rxbuf(struct sunxi_emac_softc *sc, int index, struct mbuf *m)
    411  1.4.6.2  skrll {
    412  1.4.6.2  skrll 	int error;
    413  1.4.6.2  skrll 
    414  1.4.6.2  skrll 	m_adj(m, ETHER_ALIGN);
    415  1.4.6.2  skrll 
    416  1.4.6.2  skrll 	error = bus_dmamap_load_mbuf(sc->rx.buf_tag,
    417  1.4.6.2  skrll 	    sc->rx.buf_map[index].map, m, BUS_DMA_READ|BUS_DMA_NOWAIT);
    418  1.4.6.2  skrll 	if (error != 0)
    419  1.4.6.2  skrll 		return error;
    420  1.4.6.2  skrll 
    421  1.4.6.2  skrll 	bus_dmamap_sync(sc->rx.buf_tag, sc->rx.buf_map[index].map,
    422  1.4.6.2  skrll 	    0, sc->rx.buf_map[index].map->dm_mapsize,
    423  1.4.6.2  skrll 	    BUS_DMASYNC_PREREAD);
    424  1.4.6.2  skrll 
    425  1.4.6.2  skrll 	sc->rx.buf_map[index].mbuf = m;
    426  1.4.6.2  skrll 	sunxi_emac_setup_rxdesc(sc, index,
    427  1.4.6.2  skrll 	    sc->rx.buf_map[index].map->dm_segs[0].ds_addr);
    428  1.4.6.2  skrll 
    429  1.4.6.2  skrll 	return 0;
    430  1.4.6.2  skrll }
    431  1.4.6.2  skrll 
    432  1.4.6.2  skrll static struct mbuf *
    433  1.4.6.2  skrll sunxi_emac_alloc_mbufcl(struct sunxi_emac_softc *sc)
    434  1.4.6.2  skrll {
    435  1.4.6.2  skrll 	struct mbuf *m;
    436  1.4.6.2  skrll 
    437  1.4.6.2  skrll 	m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
    438  1.4.6.2  skrll 	if (m != NULL)
    439  1.4.6.2  skrll 		m->m_pkthdr.len = m->m_len = m->m_ext.ext_size;
    440  1.4.6.2  skrll 
    441  1.4.6.2  skrll 	return m;
    442  1.4.6.2  skrll }
    443  1.4.6.2  skrll 
    444  1.4.6.2  skrll static void
    445  1.4.6.2  skrll sunxi_emac_start_locked(struct sunxi_emac_softc *sc)
    446  1.4.6.2  skrll {
    447  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    448  1.4.6.2  skrll 	struct mbuf *m;
    449  1.4.6.2  skrll 	uint32_t val;
    450  1.4.6.2  skrll 	int cnt, nsegs, start;
    451  1.4.6.2  skrll 
    452  1.4.6.2  skrll 	EMAC_ASSERT_LOCKED(sc);
    453  1.4.6.2  skrll 
    454  1.4.6.2  skrll 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
    455  1.4.6.2  skrll 		return;
    456  1.4.6.2  skrll 
    457  1.4.6.2  skrll 	for (cnt = 0, start = sc->tx.cur; ; cnt++) {
    458  1.4.6.2  skrll 		if (sc->tx.queued >= TX_DESC_COUNT - TX_MAX_SEGS) {
    459  1.4.6.2  skrll 			ifp->if_flags |= IFF_OACTIVE;
    460  1.4.6.2  skrll 			break;
    461  1.4.6.2  skrll 		}
    462  1.4.6.2  skrll 
    463  1.4.6.2  skrll 		IFQ_POLL(&ifp->if_snd, m);
    464  1.4.6.2  skrll 		if (m == NULL)
    465  1.4.6.2  skrll 			break;
    466  1.4.6.2  skrll 
    467  1.4.6.2  skrll 		nsegs = sunxi_emac_setup_txbuf(sc, sc->tx.cur, m);
    468  1.4.6.2  skrll 		if (nsegs == 0) {
    469  1.4.6.2  skrll 			ifp->if_flags |= IFF_OACTIVE;
    470  1.4.6.2  skrll 			break;
    471  1.4.6.2  skrll 		}
    472  1.4.6.2  skrll 		IFQ_DEQUEUE(&ifp->if_snd, m);
    473  1.4.6.2  skrll 		bpf_mtap(ifp, m);
    474  1.4.6.2  skrll 
    475  1.4.6.2  skrll 		sc->tx.cur = TX_SKIP(sc->tx.cur, nsegs);
    476  1.4.6.2  skrll 	}
    477  1.4.6.2  skrll 
    478  1.4.6.2  skrll 	if (cnt != 0) {
    479  1.4.6.2  skrll 		sunxi_emac_dma_sync(sc, sc->tx.desc_tag, sc->tx.desc_map,
    480  1.4.6.2  skrll 		    start, sc->tx.cur, TX_DESC_COUNT,
    481  1.4.6.2  skrll 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
    482  1.4.6.2  skrll 
    483  1.4.6.2  skrll 		/* Start and run TX DMA */
    484  1.4.6.2  skrll 		val = RD4(sc, EMAC_TX_CTL_1);
    485  1.4.6.2  skrll 		WR4(sc, EMAC_TX_CTL_1, val | TX_DMA_START);
    486  1.4.6.2  skrll 	}
    487  1.4.6.2  skrll }
    488  1.4.6.2  skrll 
    489  1.4.6.2  skrll static void
    490  1.4.6.2  skrll sunxi_emac_start(struct ifnet *ifp)
    491  1.4.6.2  skrll {
    492  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = ifp->if_softc;
    493  1.4.6.2  skrll 
    494  1.4.6.2  skrll 	EMAC_LOCK(sc);
    495  1.4.6.2  skrll 	sunxi_emac_start_locked(sc);
    496  1.4.6.2  skrll 	EMAC_UNLOCK(sc);
    497  1.4.6.2  skrll }
    498  1.4.6.2  skrll 
    499  1.4.6.2  skrll static void
    500  1.4.6.2  skrll sunxi_emac_tick(void *softc)
    501  1.4.6.2  skrll {
    502  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = softc;
    503  1.4.6.2  skrll 	struct mii_data *mii = &sc->mii;
    504  1.4.6.2  skrll #ifndef EMAC_MPSAFE
    505  1.4.6.2  skrll 	int s = splnet();
    506  1.4.6.2  skrll #endif
    507  1.4.6.2  skrll 
    508  1.4.6.2  skrll 	EMAC_LOCK(sc);
    509  1.4.6.2  skrll 	mii_tick(mii);
    510  1.4.6.2  skrll 	callout_schedule(&sc->stat_ch, hz);
    511  1.4.6.2  skrll 	EMAC_UNLOCK(sc);
    512  1.4.6.2  skrll 
    513  1.4.6.2  skrll #ifndef EMAC_MPSAFE
    514  1.4.6.2  skrll 	splx(s);
    515  1.4.6.2  skrll #endif
    516  1.4.6.2  skrll }
    517  1.4.6.2  skrll 
    518  1.4.6.2  skrll /* Bit Reversal - http://aggregate.org/MAGIC/#Bit%20Reversal */
    519  1.4.6.2  skrll static uint32_t
    520  1.4.6.2  skrll bitrev32(uint32_t x)
    521  1.4.6.2  skrll {
    522  1.4.6.2  skrll 	x = (((x & 0xaaaaaaaa) >> 1) | ((x & 0x55555555) << 1));
    523  1.4.6.2  skrll 	x = (((x & 0xcccccccc) >> 2) | ((x & 0x33333333) << 2));
    524  1.4.6.2  skrll 	x = (((x & 0xf0f0f0f0) >> 4) | ((x & 0x0f0f0f0f) << 4));
    525  1.4.6.2  skrll 	x = (((x & 0xff00ff00) >> 8) | ((x & 0x00ff00ff) << 8));
    526  1.4.6.2  skrll 
    527  1.4.6.2  skrll 	return (x >> 16) | (x << 16);
    528  1.4.6.2  skrll }
    529  1.4.6.2  skrll 
    530  1.4.6.2  skrll static void
    531  1.4.6.2  skrll sunxi_emac_setup_rxfilter(struct sunxi_emac_softc *sc)
    532  1.4.6.2  skrll {
    533  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    534  1.4.6.2  skrll 	uint32_t val, crc, hashreg, hashbit, hash[2], machi, maclo;
    535  1.4.6.2  skrll 	struct ether_multi *enm;
    536  1.4.6.2  skrll 	struct ether_multistep step;
    537  1.4.6.2  skrll 	const uint8_t *eaddr;
    538  1.4.6.2  skrll 
    539  1.4.6.2  skrll 	EMAC_ASSERT_LOCKED(sc);
    540  1.4.6.2  skrll 
    541  1.4.6.2  skrll 	val = 0;
    542  1.4.6.2  skrll 	hash[0] = hash[1] = 0;
    543  1.4.6.2  skrll 
    544  1.4.6.2  skrll 	if ((ifp->if_flags & IFF_PROMISC) != 0)
    545  1.4.6.2  skrll 		val |= DIS_ADDR_FILTER;
    546  1.4.6.2  skrll 	else if ((ifp->if_flags & IFF_ALLMULTI) != 0) {
    547  1.4.6.2  skrll 		val |= RX_ALL_MULTICAST;
    548  1.4.6.2  skrll 		hash[0] = hash[1] = ~0;
    549  1.4.6.2  skrll 	} else {
    550  1.4.6.2  skrll 		val |= HASH_MULTICAST;
    551  1.4.6.2  skrll 		ETHER_FIRST_MULTI(step, &sc->ec, enm);
    552  1.4.6.2  skrll 		while (enm != NULL) {
    553  1.4.6.2  skrll 			crc = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN);
    554  1.4.6.2  skrll 			crc &= 0x7f;
    555  1.4.6.2  skrll 			crc = bitrev32(~crc) >> 26;
    556  1.4.6.2  skrll 			hashreg = (crc >> 5);
    557  1.4.6.2  skrll 			hashbit = (crc & 0x1f);
    558  1.4.6.2  skrll 			hash[hashreg] |= (1 << hashbit);
    559  1.4.6.2  skrll 			ETHER_NEXT_MULTI(step, enm);
    560  1.4.6.2  skrll 		}
    561  1.4.6.2  skrll 	}
    562  1.4.6.2  skrll 
    563  1.4.6.2  skrll 	/* Write our unicast address */
    564  1.4.6.2  skrll 	eaddr = CLLADDR(ifp->if_sadl);
    565  1.4.6.2  skrll 	machi = (eaddr[5] << 8) | eaddr[4];
    566  1.4.6.2  skrll 	maclo = (eaddr[3] << 24) | (eaddr[2] << 16) | (eaddr[1] << 8) |
    567  1.4.6.2  skrll 	   (eaddr[0] << 0);
    568  1.4.6.2  skrll 	WR4(sc, EMAC_ADDR_HIGH(0), machi);
    569  1.4.6.2  skrll 	WR4(sc, EMAC_ADDR_LOW(0), maclo);
    570  1.4.6.2  skrll 
    571  1.4.6.2  skrll 	/* Multicast hash filters */
    572  1.4.6.2  skrll 	WR4(sc, EMAC_RX_HASH_0, hash[1]);
    573  1.4.6.2  skrll 	WR4(sc, EMAC_RX_HASH_1, hash[0]);
    574  1.4.6.2  skrll 
    575  1.4.6.2  skrll 	/* RX frame filter config */
    576  1.4.6.2  skrll 	WR4(sc, EMAC_RX_FRM_FLT, val);
    577  1.4.6.2  skrll }
    578  1.4.6.2  skrll 
    579  1.4.6.2  skrll static void
    580  1.4.6.2  skrll sunxi_emac_enable_intr(struct sunxi_emac_softc *sc)
    581  1.4.6.2  skrll {
    582  1.4.6.2  skrll 	/* Enable interrupts */
    583  1.4.6.2  skrll 	WR4(sc, EMAC_INT_EN, RX_INT_EN | TX_INT_EN | TX_BUF_UA_INT_EN);
    584  1.4.6.2  skrll }
    585  1.4.6.2  skrll 
    586  1.4.6.2  skrll static void
    587  1.4.6.2  skrll sunxi_emac_disable_intr(struct sunxi_emac_softc *sc)
    588  1.4.6.2  skrll {
    589  1.4.6.2  skrll 	/* Disable interrupts */
    590  1.4.6.2  skrll 	WR4(sc, EMAC_INT_EN, 0);
    591  1.4.6.2  skrll }
    592  1.4.6.2  skrll 
    593  1.4.6.2  skrll static int
    594  1.4.6.2  skrll sunxi_emac_init_locked(struct sunxi_emac_softc *sc)
    595  1.4.6.2  skrll {
    596  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    597  1.4.6.2  skrll 	struct mii_data *mii = &sc->mii;
    598  1.4.6.2  skrll 	uint32_t val;
    599  1.4.6.2  skrll 
    600  1.4.6.2  skrll 	EMAC_ASSERT_LOCKED(sc);
    601  1.4.6.2  skrll 
    602  1.4.6.2  skrll 	if ((ifp->if_flags & IFF_RUNNING) != 0)
    603  1.4.6.2  skrll 		return 0;
    604  1.4.6.2  skrll 
    605  1.4.6.2  skrll 	sunxi_emac_setup_rxfilter(sc);
    606  1.4.6.2  skrll 
    607  1.4.6.2  skrll 	/* Configure DMA burst length and priorities */
    608  1.4.6.2  skrll 	val = sunxi_emac_burst_len << BASIC_CTL_BURST_LEN_SHIFT;
    609  1.4.6.2  skrll 	if (sunxi_emac_rx_tx_pri)
    610  1.4.6.2  skrll 		val |= BASIC_CTL_RX_TX_PRI;
    611  1.4.6.2  skrll 	WR4(sc, EMAC_BASIC_CTL_1, val);
    612  1.4.6.2  skrll 
    613  1.4.6.2  skrll 	/* Enable interrupts */
    614  1.4.6.2  skrll 	sunxi_emac_enable_intr(sc);
    615  1.4.6.2  skrll 
    616  1.4.6.2  skrll 	/* Enable transmit DMA */
    617  1.4.6.2  skrll 	val = RD4(sc, EMAC_TX_CTL_1);
    618  1.4.6.2  skrll 	WR4(sc, EMAC_TX_CTL_1, val | TX_DMA_EN | TX_MD | TX_NEXT_FRAME);
    619  1.4.6.2  skrll 
    620  1.4.6.2  skrll 	/* Enable receive DMA */
    621  1.4.6.2  skrll 	val = RD4(sc, EMAC_RX_CTL_1);
    622  1.4.6.2  skrll 	WR4(sc, EMAC_RX_CTL_1, val | RX_DMA_EN | RX_MD);
    623  1.4.6.2  skrll 
    624  1.4.6.2  skrll 	/* Enable transmitter */
    625  1.4.6.2  skrll 	val = RD4(sc, EMAC_TX_CTL_0);
    626  1.4.6.2  skrll 	WR4(sc, EMAC_TX_CTL_0, val | TX_EN);
    627  1.4.6.2  skrll 
    628  1.4.6.2  skrll 	/* Enable receiver */
    629  1.4.6.2  skrll 	val = RD4(sc, EMAC_RX_CTL_0);
    630  1.4.6.2  skrll 	WR4(sc, EMAC_RX_CTL_0, val | RX_EN | CHECK_CRC);
    631  1.4.6.2  skrll 
    632  1.4.6.2  skrll 	ifp->if_flags |= IFF_RUNNING;
    633  1.4.6.2  skrll 	ifp->if_flags &= ~IFF_OACTIVE;
    634  1.4.6.2  skrll 
    635  1.4.6.2  skrll 	mii_mediachg(mii);
    636  1.4.6.2  skrll 	callout_schedule(&sc->stat_ch, hz);
    637  1.4.6.2  skrll 
    638  1.4.6.2  skrll 	return 0;
    639  1.4.6.2  skrll }
    640  1.4.6.2  skrll 
    641  1.4.6.2  skrll static int
    642  1.4.6.2  skrll sunxi_emac_init(struct ifnet *ifp)
    643  1.4.6.2  skrll {
    644  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = ifp->if_softc;
    645  1.4.6.2  skrll 	int error;
    646  1.4.6.2  skrll 
    647  1.4.6.2  skrll 	EMAC_LOCK(sc);
    648  1.4.6.2  skrll 	error = sunxi_emac_init_locked(sc);
    649  1.4.6.2  skrll 	EMAC_UNLOCK(sc);
    650  1.4.6.2  skrll 
    651  1.4.6.2  skrll 	return error;
    652  1.4.6.2  skrll }
    653  1.4.6.2  skrll 
    654  1.4.6.2  skrll static void
    655  1.4.6.2  skrll sunxi_emac_stop_locked(struct sunxi_emac_softc *sc, int disable)
    656  1.4.6.2  skrll {
    657  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    658  1.4.6.2  skrll 	uint32_t val;
    659  1.4.6.2  skrll 
    660  1.4.6.2  skrll 	EMAC_ASSERT_LOCKED(sc);
    661  1.4.6.2  skrll 
    662  1.4.6.2  skrll 	callout_stop(&sc->stat_ch);
    663  1.4.6.2  skrll 
    664  1.4.6.2  skrll 	mii_down(&sc->mii);
    665  1.4.6.2  skrll 
    666  1.4.6.2  skrll 	/* Stop transmit DMA and flush data in the TX FIFO */
    667  1.4.6.2  skrll 	val = RD4(sc, EMAC_TX_CTL_1);
    668  1.4.6.2  skrll 	val &= ~TX_DMA_EN;
    669  1.4.6.2  skrll 	val |= FLUSH_TX_FIFO;
    670  1.4.6.2  skrll 	WR4(sc, EMAC_TX_CTL_1, val);
    671  1.4.6.2  skrll 
    672  1.4.6.2  skrll 	/* Disable transmitter */
    673  1.4.6.2  skrll 	val = RD4(sc, EMAC_TX_CTL_0);
    674  1.4.6.2  skrll 	WR4(sc, EMAC_TX_CTL_0, val & ~TX_EN);
    675  1.4.6.2  skrll 
    676  1.4.6.2  skrll 	/* Disable receiver */
    677  1.4.6.2  skrll 	val = RD4(sc, EMAC_RX_CTL_0);
    678  1.4.6.2  skrll 	WR4(sc, EMAC_RX_CTL_0, val & ~RX_EN);
    679  1.4.6.2  skrll 
    680  1.4.6.2  skrll 	/* Disable interrupts */
    681  1.4.6.2  skrll 	sunxi_emac_disable_intr(sc);
    682  1.4.6.2  skrll 
    683  1.4.6.2  skrll 	/* Disable transmit DMA */
    684  1.4.6.2  skrll 	val = RD4(sc, EMAC_TX_CTL_1);
    685  1.4.6.2  skrll 	WR4(sc, EMAC_TX_CTL_1, val & ~TX_DMA_EN);
    686  1.4.6.2  skrll 
    687  1.4.6.2  skrll 	/* Disable receive DMA */
    688  1.4.6.2  skrll 	val = RD4(sc, EMAC_RX_CTL_1);
    689  1.4.6.2  skrll 	WR4(sc, EMAC_RX_CTL_1, val & ~RX_DMA_EN);
    690  1.4.6.2  skrll 
    691  1.4.6.2  skrll 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    692  1.4.6.2  skrll }
    693  1.4.6.2  skrll 
    694  1.4.6.2  skrll static void
    695  1.4.6.2  skrll sunxi_emac_stop(struct ifnet *ifp, int disable)
    696  1.4.6.2  skrll {
    697  1.4.6.2  skrll 	struct sunxi_emac_softc * const sc = ifp->if_softc;
    698  1.4.6.2  skrll 
    699  1.4.6.2  skrll 	EMAC_LOCK(sc);
    700  1.4.6.2  skrll 	sunxi_emac_stop_locked(sc, disable);
    701  1.4.6.2  skrll 	EMAC_UNLOCK(sc);
    702  1.4.6.2  skrll }
    703  1.4.6.2  skrll 
    704  1.4.6.2  skrll static int
    705  1.4.6.2  skrll sunxi_emac_rxintr(struct sunxi_emac_softc *sc)
    706  1.4.6.2  skrll {
    707  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    708  1.4.6.2  skrll 	int error, index, len, npkt;
    709  1.4.6.2  skrll 	struct mbuf *m, *m0;
    710  1.4.6.2  skrll 	uint32_t status;
    711  1.4.6.2  skrll 
    712  1.4.6.2  skrll 	npkt = 0;
    713  1.4.6.2  skrll 
    714  1.4.6.2  skrll 	for (index = sc->rx.cur; ; index = RX_NEXT(index)) {
    715  1.4.6.2  skrll 		sunxi_emac_dma_sync(sc, sc->rx.desc_tag, sc->rx.desc_map,
    716  1.4.6.2  skrll 		    index, index + 1,
    717  1.4.6.2  skrll 		    RX_DESC_COUNT, BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
    718  1.4.6.2  skrll 
    719  1.4.6.2  skrll 		status = le32toh(sc->rx.desc_ring[index].status);
    720  1.4.6.2  skrll 		if ((status & RX_DESC_CTL) != 0)
    721  1.4.6.2  skrll 			break;
    722  1.4.6.2  skrll 
    723  1.4.6.2  skrll 		bus_dmamap_sync(sc->rx.buf_tag, sc->rx.buf_map[index].map,
    724  1.4.6.2  skrll 		    0, sc->rx.buf_map[index].map->dm_mapsize,
    725  1.4.6.2  skrll 		    BUS_DMASYNC_POSTREAD);
    726  1.4.6.2  skrll 		bus_dmamap_unload(sc->rx.buf_tag, sc->rx.buf_map[index].map);
    727  1.4.6.2  skrll 
    728  1.4.6.2  skrll 		len = (status & RX_FRM_LEN) >> RX_FRM_LEN_SHIFT;
    729  1.4.6.2  skrll 		if (len != 0) {
    730  1.4.6.2  skrll 			m = sc->rx.buf_map[index].mbuf;
    731  1.4.6.2  skrll 			m_set_rcvif(m, ifp);
    732  1.4.6.2  skrll 			m->m_flags |= M_HASFCS;
    733  1.4.6.2  skrll 			m->m_pkthdr.len = len;
    734  1.4.6.2  skrll 			m->m_len = len;
    735  1.4.6.2  skrll 			m->m_nextpkt = NULL;
    736  1.4.6.2  skrll 
    737  1.4.6.2  skrll 			if ((ifp->if_capenable & IFCAP_CSUM_IPv4_Rx) != 0 &&
    738  1.4.6.2  skrll 			    (status & RX_FRM_TYPE) != 0) {
    739  1.4.6.2  skrll 				m->m_pkthdr.csum_flags = M_CSUM_IPv4;
    740  1.4.6.2  skrll 				if ((status & RX_HEADER_ERR) != 0)
    741  1.4.6.2  skrll 					m->m_pkthdr.csum_flags |=
    742  1.4.6.2  skrll 					    M_CSUM_IPv4_BAD;
    743  1.4.6.2  skrll 				if ((status & RX_PAYLOAD_ERR) == 0) {
    744  1.4.6.2  skrll 					m->m_pkthdr.csum_flags |=
    745  1.4.6.2  skrll 					    M_CSUM_DATA;
    746  1.4.6.2  skrll 					m->m_pkthdr.csum_data = 0xffff;
    747  1.4.6.2  skrll 				}
    748  1.4.6.2  skrll 			}
    749  1.4.6.2  skrll 
    750  1.4.6.2  skrll 			++npkt;
    751  1.4.6.2  skrll 
    752  1.4.6.2  skrll 			if_percpuq_enqueue(ifp->if_percpuq, m);
    753  1.4.6.2  skrll 		}
    754  1.4.6.2  skrll 
    755  1.4.6.2  skrll 		if ((m0 = sunxi_emac_alloc_mbufcl(sc)) != NULL) {
    756  1.4.6.2  skrll 			error = sunxi_emac_setup_rxbuf(sc, index, m0);
    757  1.4.6.2  skrll 			if (error != 0) {
    758  1.4.6.2  skrll 				/* XXX hole in RX ring */
    759  1.4.6.2  skrll 			}
    760  1.4.6.2  skrll 		} else
    761  1.4.6.2  skrll 			ifp->if_ierrors++;
    762  1.4.6.2  skrll 
    763  1.4.6.2  skrll 		sunxi_emac_dma_sync(sc, sc->rx.desc_tag, sc->rx.desc_map,
    764  1.4.6.2  skrll 		    index, index + 1,
    765  1.4.6.2  skrll 		    RX_DESC_COUNT, BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
    766  1.4.6.2  skrll 	}
    767  1.4.6.2  skrll 
    768  1.4.6.2  skrll 	sc->rx.cur = index;
    769  1.4.6.2  skrll 
    770  1.4.6.2  skrll 	return npkt;
    771  1.4.6.2  skrll }
    772  1.4.6.2  skrll 
    773  1.4.6.2  skrll static void
    774  1.4.6.2  skrll sunxi_emac_txintr(struct sunxi_emac_softc *sc)
    775  1.4.6.2  skrll {
    776  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    777  1.4.6.2  skrll 	struct sunxi_emac_bufmap *bmap;
    778  1.4.6.2  skrll 	struct sunxi_emac_desc *desc;
    779  1.4.6.2  skrll 	uint32_t status;
    780  1.4.6.2  skrll 	int i;
    781  1.4.6.2  skrll 
    782  1.4.6.2  skrll 	EMAC_ASSERT_LOCKED(sc);
    783  1.4.6.2  skrll 
    784  1.4.6.2  skrll 	for (i = sc->tx.next; sc->tx.queued > 0; i = TX_NEXT(i)) {
    785  1.4.6.2  skrll 		KASSERT(sc->tx.queued > 0 && sc->tx.queued <= TX_DESC_COUNT);
    786  1.4.6.2  skrll 		sunxi_emac_dma_sync(sc, sc->tx.desc_tag, sc->tx.desc_map,
    787  1.4.6.2  skrll 		    i, i + 1, TX_DESC_COUNT,
    788  1.4.6.2  skrll 		    BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
    789  1.4.6.2  skrll 		desc = &sc->tx.desc_ring[i];
    790  1.4.6.2  skrll 		status = le32toh(desc->status);
    791  1.4.6.2  skrll 		if ((status & TX_DESC_CTL) != 0)
    792  1.4.6.2  skrll 			break;
    793  1.4.6.2  skrll 		bmap = &sc->tx.buf_map[i];
    794  1.4.6.2  skrll 		if (bmap->mbuf != NULL) {
    795  1.4.6.2  skrll 			bus_dmamap_sync(sc->tx.buf_tag, bmap->map,
    796  1.4.6.2  skrll 			    0, bmap->map->dm_mapsize,
    797  1.4.6.2  skrll 			    BUS_DMASYNC_POSTWRITE);
    798  1.4.6.2  skrll 			bus_dmamap_unload(sc->tx.buf_tag, bmap->map);
    799  1.4.6.2  skrll 			m_freem(bmap->mbuf);
    800  1.4.6.2  skrll 			bmap->mbuf = NULL;
    801  1.4.6.2  skrll 		}
    802  1.4.6.2  skrll 
    803  1.4.6.2  skrll 		sunxi_emac_setup_txdesc(sc, i, 0, 0, 0);
    804  1.4.6.2  skrll 		sunxi_emac_dma_sync(sc, sc->tx.desc_tag, sc->tx.desc_map,
    805  1.4.6.2  skrll 		    i, i + 1, TX_DESC_COUNT,
    806  1.4.6.2  skrll 		    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
    807  1.4.6.2  skrll 
    808  1.4.6.2  skrll 		ifp->if_flags &= ~IFF_OACTIVE;
    809  1.4.6.2  skrll 		ifp->if_opackets++;
    810  1.4.6.2  skrll 	}
    811  1.4.6.2  skrll 
    812  1.4.6.2  skrll 	sc->tx.next = i;
    813  1.4.6.2  skrll }
    814  1.4.6.2  skrll 
    815  1.4.6.2  skrll static int
    816  1.4.6.2  skrll sunxi_emac_intr(void *arg)
    817  1.4.6.2  skrll {
    818  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = arg;
    819  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
    820  1.4.6.2  skrll 	uint32_t val;
    821  1.4.6.2  skrll 
    822  1.4.6.2  skrll 	EMAC_LOCK(sc);
    823  1.4.6.2  skrll 
    824  1.4.6.2  skrll 	val = RD4(sc, EMAC_INT_STA);
    825  1.4.6.2  skrll 	WR4(sc, EMAC_INT_STA, val);
    826  1.4.6.2  skrll 
    827  1.4.6.2  skrll 	if (val & RX_INT)
    828  1.4.6.2  skrll 		sunxi_emac_rxintr(sc);
    829  1.4.6.2  skrll 
    830  1.4.6.2  skrll 	if (val & (TX_INT|TX_BUF_UA_INT)) {
    831  1.4.6.2  skrll 		sunxi_emac_txintr(sc);
    832  1.4.6.2  skrll 		if_schedule_deferred_start(ifp);
    833  1.4.6.2  skrll 	}
    834  1.4.6.2  skrll 
    835  1.4.6.2  skrll 	EMAC_UNLOCK(sc);
    836  1.4.6.2  skrll 
    837  1.4.6.2  skrll 	return 1;
    838  1.4.6.2  skrll }
    839  1.4.6.2  skrll 
    840  1.4.6.2  skrll static int
    841  1.4.6.2  skrll sunxi_emac_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    842  1.4.6.2  skrll {
    843  1.4.6.2  skrll 	struct sunxi_emac_softc *sc = ifp->if_softc;
    844  1.4.6.2  skrll 	struct mii_data *mii = &sc->mii;
    845  1.4.6.2  skrll 	struct ifreq *ifr = data;
    846  1.4.6.2  skrll 	int error, s;
    847  1.4.6.2  skrll 
    848  1.4.6.2  skrll #ifndef EMAC_MPSAFE
    849  1.4.6.2  skrll 	s = splnet();
    850  1.4.6.2  skrll #endif
    851  1.4.6.2  skrll 
    852  1.4.6.2  skrll 	switch (cmd) {
    853  1.4.6.2  skrll 	case SIOCSIFMEDIA:
    854  1.4.6.2  skrll 	case SIOCGIFMEDIA:
    855  1.4.6.2  skrll #ifdef EMAC_MPSAFE
    856  1.4.6.2  skrll 		s = splnet();
    857  1.4.6.2  skrll #endif
    858  1.4.6.2  skrll 		error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, cmd);
    859  1.4.6.2  skrll #ifdef EMAC_MPSAFE
    860  1.4.6.2  skrll 		splx(s);
    861  1.4.6.2  skrll #endif
    862  1.4.6.2  skrll 		break;
    863  1.4.6.2  skrll 	default:
    864  1.4.6.2  skrll #ifdef EMAC_MPSAFE
    865  1.4.6.2  skrll 		s = splnet();
    866  1.4.6.2  skrll #endif
    867  1.4.6.2  skrll 		error = ether_ioctl(ifp, cmd, data);
    868  1.4.6.2  skrll #ifdef EMAC_MPSAFE
    869  1.4.6.2  skrll 		splx(s);
    870  1.4.6.2  skrll #endif
    871  1.4.6.2  skrll 		if (error != ENETRESET)
    872  1.4.6.2  skrll 			break;
    873  1.4.6.2  skrll 
    874  1.4.6.2  skrll 		error = 0;
    875  1.4.6.2  skrll 
    876  1.4.6.2  skrll 		if (cmd == SIOCSIFCAP)
    877  1.4.6.2  skrll 			error = (*ifp->if_init)(ifp);
    878  1.4.6.2  skrll 		else if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
    879  1.4.6.2  skrll 			;
    880  1.4.6.2  skrll 		else if ((ifp->if_flags & IFF_RUNNING) != 0) {
    881  1.4.6.2  skrll 			EMAC_LOCK(sc);
    882  1.4.6.2  skrll 			sunxi_emac_setup_rxfilter(sc);
    883  1.4.6.2  skrll 			EMAC_UNLOCK(sc);
    884  1.4.6.2  skrll 		}
    885  1.4.6.2  skrll 		break;
    886  1.4.6.2  skrll 	}
    887  1.4.6.2  skrll 
    888  1.4.6.2  skrll #ifndef EMAC_MPSAFE
    889  1.4.6.2  skrll 	splx(s);
    890  1.4.6.2  skrll #endif
    891  1.4.6.2  skrll 
    892  1.4.6.2  skrll 	return error;
    893  1.4.6.2  skrll }
    894  1.4.6.2  skrll 
    895  1.4.6.2  skrll static int
    896  1.4.6.2  skrll sunxi_emac_setup_phy(struct sunxi_emac_softc *sc)
    897  1.4.6.2  skrll {
    898  1.4.6.2  skrll 	uint32_t reg, tx_delay, rx_delay;
    899  1.4.6.2  skrll 	const char *phy_type;
    900  1.4.6.2  skrll 
    901  1.4.6.2  skrll 	phy_type = fdtbus_get_string(sc->phandle, "phy-mode");
    902  1.4.6.2  skrll 	if (phy_type == NULL)
    903  1.4.6.2  skrll 		return 0;
    904  1.4.6.2  skrll 
    905  1.4.6.2  skrll 	aprint_debug_dev(sc->dev, "PHY type: %s\n", phy_type);
    906  1.4.6.2  skrll 
    907  1.4.6.2  skrll 	reg = SYSCONRD4(sc, 0);
    908  1.4.6.2  skrll 
    909  1.4.6.2  skrll 	reg &= ~(EMAC_CLK_PIT | EMAC_CLK_SRC | EMAC_CLK_RMII_EN);
    910  1.4.6.2  skrll 	if (strcmp(phy_type, "rgmii") == 0)
    911  1.4.6.2  skrll 		reg |= EMAC_CLK_PIT_RGMII | EMAC_CLK_SRC_RGMII;
    912  1.4.6.2  skrll 	else if (strcmp(phy_type, "rmii") == 0)
    913  1.4.6.2  skrll 		reg |= EMAC_CLK_RMII_EN;
    914  1.4.6.2  skrll 	else
    915  1.4.6.2  skrll 		reg |= EMAC_CLK_PIT_MII | EMAC_CLK_SRC_MII;
    916  1.4.6.2  skrll 
    917  1.4.6.2  skrll 	if (of_getprop_uint32(sc->phandle, "tx-delay", &tx_delay) == 0) {
    918  1.4.6.2  skrll 		reg &= ~EMAC_CLK_ETXDC;
    919  1.4.6.2  skrll 		reg |= (tx_delay << EMAC_CLK_ETXDC_SHIFT);
    920  1.4.6.2  skrll 	}
    921  1.4.6.2  skrll 	if (of_getprop_uint32(sc->phandle, "rx-delay", &rx_delay) == 0) {
    922  1.4.6.2  skrll 		reg &= ~EMAC_CLK_ERXDC;
    923  1.4.6.2  skrll 		reg |= (rx_delay << EMAC_CLK_ERXDC_SHIFT);
    924  1.4.6.2  skrll 	}
    925  1.4.6.2  skrll 
    926  1.4.6.2  skrll 	if (sc->type == EMAC_H3) {
    927  1.4.6.2  skrll 		if (of_hasprop(sc->phandle, "allwinner,use-internal-phy")) {
    928  1.4.6.2  skrll 			reg |= EMAC_CLK_EPHY_SELECT;
    929  1.4.6.2  skrll 			reg &= ~EMAC_CLK_EPHY_SHUTDOWN;
    930  1.4.6.2  skrll 			if (of_hasprop(sc->phandle,
    931  1.4.6.2  skrll 			    "allwinner,leds-active-low"))
    932  1.4.6.2  skrll 				reg |= EMAC_CLK_EPHY_LED_POL;
    933  1.4.6.2  skrll 			else
    934  1.4.6.2  skrll 				reg &= ~EMAC_CLK_EPHY_LED_POL;
    935  1.4.6.2  skrll 
    936  1.4.6.2  skrll 			/* Set internal PHY addr to 1 */
    937  1.4.6.2  skrll 			reg &= ~EMAC_CLK_EPHY_ADDR;
    938  1.4.6.2  skrll 			reg |= (1 << EMAC_CLK_EPHY_ADDR_SHIFT);
    939  1.4.6.2  skrll 		} else {
    940  1.4.6.2  skrll 			reg &= ~EMAC_CLK_EPHY_SELECT;
    941  1.4.6.2  skrll 		}
    942  1.4.6.2  skrll 	}
    943  1.4.6.2  skrll 
    944  1.4.6.2  skrll 	aprint_debug_dev(sc->dev, "EMAC clock: 0x%08x\n", reg);
    945  1.4.6.2  skrll 
    946  1.4.6.2  skrll 	SYSCONWR4(sc, 0, reg);
    947  1.4.6.2  skrll 
    948  1.4.6.2  skrll 	return 0;
    949  1.4.6.2  skrll }
    950  1.4.6.2  skrll 
    951  1.4.6.2  skrll static int
    952  1.4.6.2  skrll sunxi_emac_setup_resources(struct sunxi_emac_softc *sc)
    953  1.4.6.2  skrll {
    954  1.4.6.2  skrll 	u_int freq;
    955  1.4.6.2  skrll 	int error, div;
    956  1.4.6.2  skrll 
    957  1.4.6.2  skrll 	/* Configure PHY for MII or RGMII mode */
    958  1.4.6.2  skrll 	if (sunxi_emac_setup_phy(sc) != 0)
    959  1.4.6.2  skrll 		return ENXIO;
    960  1.4.6.2  skrll 
    961  1.4.6.2  skrll 	/* Enable clocks */
    962  1.4.6.2  skrll 	error = clk_enable(sc->clk_ahb);
    963  1.4.6.2  skrll 	if (error != 0) {
    964  1.4.6.2  skrll 		aprint_error_dev(sc->dev, "cannot enable ahb clock\n");
    965  1.4.6.2  skrll 		return error;
    966  1.4.6.2  skrll 	}
    967  1.4.6.2  skrll 
    968  1.4.6.2  skrll 	if (sc->clk_ephy != NULL) {
    969  1.4.6.2  skrll 		error = clk_enable(sc->clk_ephy);
    970  1.4.6.2  skrll 		if (error != 0) {
    971  1.4.6.2  skrll 			aprint_error_dev(sc->dev, "cannot enable ephy clock\n");
    972  1.4.6.2  skrll 			return error;
    973  1.4.6.2  skrll 		}
    974  1.4.6.2  skrll 	}
    975  1.4.6.2  skrll 
    976  1.4.6.2  skrll 	/* De-assert reset */
    977  1.4.6.2  skrll 	error = fdtbus_reset_deassert(sc->rst_ahb);
    978  1.4.6.2  skrll 	if (error != 0) {
    979  1.4.6.2  skrll 		aprint_error_dev(sc->dev, "cannot de-assert ahb reset\n");
    980  1.4.6.2  skrll 		return error;
    981  1.4.6.2  skrll 	}
    982  1.4.6.2  skrll 	if (sc->rst_ephy != NULL) {
    983  1.4.6.2  skrll 		error = fdtbus_reset_deassert(sc->rst_ephy);
    984  1.4.6.2  skrll 		if (error != 0) {
    985  1.4.6.2  skrll 			aprint_error_dev(sc->dev,
    986  1.4.6.2  skrll 			    "cannot de-assert ephy reset\n");
    987  1.4.6.2  skrll 			return error;
    988  1.4.6.2  skrll 		}
    989  1.4.6.2  skrll 	}
    990  1.4.6.2  skrll 
    991  1.4.6.2  skrll 	/* Enable PHY regulator if applicable */
    992  1.4.6.2  skrll 	if (sc->reg_phy != NULL) {
    993  1.4.6.2  skrll 		error = fdtbus_regulator_enable(sc->reg_phy);
    994  1.4.6.2  skrll 		if (error != 0) {
    995  1.4.6.2  skrll 			aprint_error_dev(sc->dev,
    996  1.4.6.2  skrll 			    "cannot enable PHY regulator\n");
    997  1.4.6.2  skrll 			return error;
    998  1.4.6.2  skrll 		}
    999  1.4.6.2  skrll 	}
   1000  1.4.6.2  skrll 
   1001  1.4.6.2  skrll 	/* Determine MDC clock divide ratio based on AHB clock */
   1002  1.4.6.2  skrll 	freq = clk_get_rate(sc->clk_ahb);
   1003  1.4.6.2  skrll 	if (freq == 0) {
   1004  1.4.6.2  skrll 		aprint_error_dev(sc->dev, "cannot get AHB clock frequency\n");
   1005  1.4.6.2  skrll 		return ENXIO;
   1006  1.4.6.2  skrll 	}
   1007  1.4.6.2  skrll 	div = freq / MDIO_FREQ;
   1008  1.4.6.2  skrll 	if (div <= 16)
   1009  1.4.6.2  skrll 		sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_16;
   1010  1.4.6.2  skrll 	else if (div <= 32)
   1011  1.4.6.2  skrll 		sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_32;
   1012  1.4.6.2  skrll 	else if (div <= 64)
   1013  1.4.6.2  skrll 		sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_64;
   1014  1.4.6.2  skrll 	else if (div <= 128)
   1015  1.4.6.2  skrll 		sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_128;
   1016  1.4.6.2  skrll 	else {
   1017  1.4.6.2  skrll 		aprint_error_dev(sc->dev,
   1018  1.4.6.2  skrll 		    "cannot determine MDC clock divide ratio\n");
   1019  1.4.6.2  skrll 		return ENXIO;
   1020  1.4.6.2  skrll 	}
   1021  1.4.6.2  skrll 
   1022  1.4.6.2  skrll 	aprint_debug_dev(sc->dev, "AHB frequency %u Hz, MDC div: 0x%x\n",
   1023  1.4.6.2  skrll 	    freq, sc->mdc_div_ratio_m);
   1024  1.4.6.2  skrll 
   1025  1.4.6.2  skrll 	return 0;
   1026  1.4.6.2  skrll }
   1027  1.4.6.2  skrll 
   1028  1.4.6.2  skrll static void
   1029  1.4.6.2  skrll sunxi_emac_get_eaddr(struct sunxi_emac_softc *sc, uint8_t *eaddr)
   1030  1.4.6.2  skrll {
   1031  1.4.6.2  skrll 	uint32_t maclo, machi;
   1032  1.4.6.2  skrll #if notyet
   1033  1.4.6.2  skrll 	u_char rootkey[16];
   1034  1.4.6.2  skrll #endif
   1035  1.4.6.2  skrll 
   1036  1.4.6.2  skrll 	machi = RD4(sc, EMAC_ADDR_HIGH(0)) & 0xffff;
   1037  1.4.6.2  skrll 	maclo = RD4(sc, EMAC_ADDR_LOW(0));
   1038  1.4.6.2  skrll 
   1039  1.4.6.2  skrll 	if (maclo == 0xffffffff && machi == 0xffff) {
   1040  1.4.6.2  skrll #if notyet
   1041  1.4.6.2  skrll 		/* MAC address in hardware is invalid, create one */
   1042  1.4.6.2  skrll 		if (aw_sid_get_rootkey(rootkey) == 0 &&
   1043  1.4.6.2  skrll 		    (rootkey[3] | rootkey[12] | rootkey[13] | rootkey[14] |
   1044  1.4.6.2  skrll 		     rootkey[15]) != 0) {
   1045  1.4.6.2  skrll 			/* MAC address is derived from the root key in SID */
   1046  1.4.6.2  skrll 			maclo = (rootkey[13] << 24) | (rootkey[12] << 16) |
   1047  1.4.6.2  skrll 				(rootkey[3] << 8) | 0x02;
   1048  1.4.6.2  skrll 			machi = (rootkey[15] << 8) | rootkey[14];
   1049  1.4.6.2  skrll 		} else {
   1050  1.4.6.2  skrll #endif
   1051  1.4.6.2  skrll 			/* Create one */
   1052  1.4.6.2  skrll 			maclo = 0x00f2 | (cprng_strong32() & 0xffff0000);
   1053  1.4.6.2  skrll 			machi = cprng_strong32() & 0xffff;
   1054  1.4.6.2  skrll #if notyet
   1055  1.4.6.2  skrll 		}
   1056  1.4.6.2  skrll #endif
   1057  1.4.6.2  skrll 	}
   1058  1.4.6.2  skrll 
   1059  1.4.6.2  skrll 	eaddr[0] = maclo & 0xff;
   1060  1.4.6.2  skrll 	eaddr[1] = (maclo >> 8) & 0xff;
   1061  1.4.6.2  skrll 	eaddr[2] = (maclo >> 16) & 0xff;
   1062  1.4.6.2  skrll 	eaddr[3] = (maclo >> 24) & 0xff;
   1063  1.4.6.2  skrll 	eaddr[4] = machi & 0xff;
   1064  1.4.6.2  skrll 	eaddr[5] = (machi >> 8) & 0xff;
   1065  1.4.6.2  skrll }
   1066  1.4.6.2  skrll 
   1067  1.4.6.2  skrll #ifdef SUNXI_EMAC_DEBUG
   1068  1.4.6.2  skrll static void
   1069  1.4.6.2  skrll sunxi_emac_dump_regs(struct sunxi_emac_softc *sc)
   1070  1.4.6.2  skrll {
   1071  1.4.6.2  skrll 	static const struct {
   1072  1.4.6.2  skrll 		const char *name;
   1073  1.4.6.2  skrll 		u_int reg;
   1074  1.4.6.2  skrll 	} regs[] = {
   1075  1.4.6.2  skrll 		{ "BASIC_CTL_0", EMAC_BASIC_CTL_0 },
   1076  1.4.6.2  skrll 		{ "BASIC_CTL_1", EMAC_BASIC_CTL_1 },
   1077  1.4.6.2  skrll 		{ "INT_STA", EMAC_INT_STA },
   1078  1.4.6.2  skrll 		{ "INT_EN", EMAC_INT_EN },
   1079  1.4.6.2  skrll 		{ "TX_CTL_0", EMAC_TX_CTL_0 },
   1080  1.4.6.2  skrll 		{ "TX_CTL_1", EMAC_TX_CTL_1 },
   1081  1.4.6.2  skrll 		{ "TX_FLOW_CTL", EMAC_TX_FLOW_CTL },
   1082  1.4.6.2  skrll 		{ "TX_DMA_LIST", EMAC_TX_DMA_LIST },
   1083  1.4.6.2  skrll 		{ "RX_CTL_0", EMAC_RX_CTL_0 },
   1084  1.4.6.2  skrll 		{ "RX_CTL_1", EMAC_RX_CTL_1 },
   1085  1.4.6.2  skrll 		{ "RX_DMA_LIST", EMAC_RX_DMA_LIST },
   1086  1.4.6.2  skrll 		{ "RX_FRM_FLT", EMAC_RX_FRM_FLT },
   1087  1.4.6.2  skrll 		{ "RX_HASH_0", EMAC_RX_HASH_0 },
   1088  1.4.6.2  skrll 		{ "RX_HASH_1", EMAC_RX_HASH_1 },
   1089  1.4.6.2  skrll 		{ "MII_CMD", EMAC_MII_CMD },
   1090  1.4.6.2  skrll 		{ "ADDR_HIGH0", EMAC_ADDR_HIGH(0) },
   1091  1.4.6.2  skrll 		{ "ADDR_LOW0", EMAC_ADDR_LOW(0) },
   1092  1.4.6.2  skrll 		{ "TX_DMA_STA", EMAC_TX_DMA_STA },
   1093  1.4.6.2  skrll 		{ "TX_DMA_CUR_DESC", EMAC_TX_DMA_CUR_DESC },
   1094  1.4.6.2  skrll 		{ "TX_DMA_CUR_BUF", EMAC_TX_DMA_CUR_BUF },
   1095  1.4.6.2  skrll 		{ "RX_DMA_STA", EMAC_RX_DMA_STA },
   1096  1.4.6.2  skrll 		{ "RX_DMA_CUR_DESC", EMAC_RX_DMA_CUR_DESC },
   1097  1.4.6.2  skrll 		{ "RX_DMA_CUR_BUF", EMAC_RX_DMA_CUR_BUF },
   1098  1.4.6.2  skrll 		{ "RGMII_STA", EMAC_RGMII_STA },
   1099  1.4.6.2  skrll 	};
   1100  1.4.6.2  skrll 	u_int n;
   1101  1.4.6.2  skrll 
   1102  1.4.6.2  skrll 	for (n = 0; n < __arraycount(regs); n++)
   1103  1.4.6.2  skrll 		device_printf(dev, "  %-20s %08x\n", regs[n].name,
   1104  1.4.6.2  skrll 		    RD4(sc, regs[n].reg));
   1105  1.4.6.2  skrll }
   1106  1.4.6.2  skrll #endif
   1107  1.4.6.2  skrll 
   1108  1.4.6.2  skrll static int
   1109  1.4.6.2  skrll sunxi_emac_phy_reset(struct sunxi_emac_softc *sc)
   1110  1.4.6.2  skrll {
   1111  1.4.6.2  skrll 	uint32_t delay_prop[3];
   1112  1.4.6.2  skrll 	int pin_value;
   1113  1.4.6.2  skrll 
   1114  1.4.6.2  skrll 	if (sc->pin_reset == NULL)
   1115  1.4.6.2  skrll 		return 0;
   1116  1.4.6.2  skrll 
   1117  1.4.6.2  skrll 	if (OF_getprop(sc->phandle, "allwinner,reset-delays-us", delay_prop,
   1118  1.4.6.2  skrll 	    sizeof(delay_prop)) <= 0)
   1119  1.4.6.2  skrll 		return ENXIO;
   1120  1.4.6.2  skrll 
   1121  1.4.6.2  skrll 	pin_value = of_hasprop(sc->phandle, "allwinner,reset-active-low");
   1122  1.4.6.2  skrll 
   1123  1.4.6.2  skrll 	fdtbus_gpio_write(sc->pin_reset, pin_value);
   1124  1.4.6.2  skrll 	delay(htole32(delay_prop[0]));
   1125  1.4.6.2  skrll 	fdtbus_gpio_write(sc->pin_reset, !pin_value);
   1126  1.4.6.2  skrll 	delay(htole32(delay_prop[1]));
   1127  1.4.6.2  skrll 	fdtbus_gpio_write(sc->pin_reset, pin_value);
   1128  1.4.6.2  skrll 	delay(htole32(delay_prop[2]));
   1129  1.4.6.2  skrll 
   1130  1.4.6.2  skrll 	return 0;
   1131  1.4.6.2  skrll }
   1132  1.4.6.2  skrll 
   1133  1.4.6.2  skrll static int
   1134  1.4.6.2  skrll sunxi_emac_reset(struct sunxi_emac_softc *sc)
   1135  1.4.6.2  skrll {
   1136  1.4.6.2  skrll 	int retry;
   1137  1.4.6.2  skrll 
   1138  1.4.6.2  skrll 	/* Reset PHY if necessary */
   1139  1.4.6.2  skrll 	if (sunxi_emac_phy_reset(sc) != 0) {
   1140  1.4.6.2  skrll 		aprint_error_dev(sc->dev, "failed to reset PHY\n");
   1141  1.4.6.2  skrll 		return ENXIO;
   1142  1.4.6.2  skrll 	}
   1143  1.4.6.2  skrll 
   1144  1.4.6.2  skrll 	/* Soft reset all registers and logic */
   1145  1.4.6.2  skrll 	WR4(sc, EMAC_BASIC_CTL_1, BASIC_CTL_SOFT_RST);
   1146  1.4.6.2  skrll 
   1147  1.4.6.2  skrll 	/* Wait for soft reset bit to self-clear */
   1148  1.4.6.2  skrll 	for (retry = SOFT_RST_RETRY; retry > 0; retry--) {
   1149  1.4.6.2  skrll 		if ((RD4(sc, EMAC_BASIC_CTL_1) & BASIC_CTL_SOFT_RST) == 0)
   1150  1.4.6.2  skrll 			break;
   1151  1.4.6.2  skrll 		delay(10);
   1152  1.4.6.2  skrll 	}
   1153  1.4.6.2  skrll 	if (retry == 0) {
   1154  1.4.6.2  skrll 		aprint_error_dev(sc->dev, "soft reset timed out\n");
   1155  1.4.6.2  skrll #ifdef SUNXI_EMAC_DEBUG
   1156  1.4.6.2  skrll 		sunxi_emac_dump_regs(sc);
   1157  1.4.6.2  skrll #endif
   1158  1.4.6.2  skrll 		return ETIMEDOUT;
   1159  1.4.6.2  skrll 	}
   1160  1.4.6.2  skrll 
   1161  1.4.6.2  skrll 	return 0;
   1162  1.4.6.2  skrll }
   1163  1.4.6.2  skrll 
   1164  1.4.6.2  skrll static int
   1165  1.4.6.2  skrll sunxi_emac_setup_dma(struct sunxi_emac_softc *sc)
   1166  1.4.6.2  skrll {
   1167  1.4.6.2  skrll 	struct mbuf *m;
   1168  1.4.6.2  skrll 	int error, nsegs, i;
   1169  1.4.6.2  skrll 
   1170  1.4.6.2  skrll 	/* Setup TX ring */
   1171  1.4.6.2  skrll 	sc->tx.buf_tag = sc->tx.desc_tag = sc->dmat;
   1172  1.4.6.2  skrll 	error = bus_dmamap_create(sc->dmat, TX_DESC_SIZE, 1, TX_DESC_SIZE, 0,
   1173  1.4.6.2  skrll 	    BUS_DMA_WAITOK, &sc->tx.desc_map);
   1174  1.4.6.2  skrll 	if (error)
   1175  1.4.6.2  skrll 		return error;
   1176  1.4.6.2  skrll 	error = bus_dmamem_alloc(sc->dmat, TX_DESC_SIZE, DESC_ALIGN, 0,
   1177  1.4.6.2  skrll 	    &sc->tx.desc_dmaseg, 1, &nsegs, BUS_DMA_WAITOK);
   1178  1.4.6.2  skrll 	if (error)
   1179  1.4.6.2  skrll 		return error;
   1180  1.4.6.2  skrll 	error = bus_dmamem_map(sc->dmat, &sc->tx.desc_dmaseg, nsegs,
   1181  1.4.6.2  skrll 	    TX_DESC_SIZE, (void *)&sc->tx.desc_ring,
   1182  1.4.6.2  skrll 	    BUS_DMA_WAITOK);
   1183  1.4.6.2  skrll 	if (error)
   1184  1.4.6.2  skrll 		return error;
   1185  1.4.6.2  skrll 	error = bus_dmamap_load(sc->dmat, sc->tx.desc_map, sc->tx.desc_ring,
   1186  1.4.6.2  skrll 	    TX_DESC_SIZE, NULL, BUS_DMA_WAITOK);
   1187  1.4.6.2  skrll 	if (error)
   1188  1.4.6.2  skrll 		return error;
   1189  1.4.6.2  skrll 	sc->tx.desc_ring_paddr = sc->tx.desc_map->dm_segs[0].ds_addr;
   1190  1.4.6.2  skrll 
   1191  1.4.6.2  skrll 	memset(sc->tx.desc_ring, 0, TX_DESC_SIZE);
   1192  1.4.6.2  skrll 	bus_dmamap_sync(sc->dmat, sc->tx.desc_map, 0, TX_DESC_SIZE,
   1193  1.4.6.2  skrll 	    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   1194  1.4.6.2  skrll 
   1195  1.4.6.2  skrll 	for (i = 0; i < TX_DESC_COUNT; i++)
   1196  1.4.6.2  skrll 		sc->tx.desc_ring[i].next =
   1197  1.4.6.2  skrll 		    htole32(sc->tx.desc_ring_paddr + DESC_OFF(TX_NEXT(i)));
   1198  1.4.6.2  skrll 
   1199  1.4.6.2  skrll 	sc->tx.queued = TX_DESC_COUNT;
   1200  1.4.6.2  skrll 	for (i = 0; i < TX_DESC_COUNT; i++) {
   1201  1.4.6.2  skrll 		error = bus_dmamap_create(sc->tx.buf_tag, MCLBYTES,
   1202  1.4.6.2  skrll 		    TX_MAX_SEGS, MCLBYTES, 0, BUS_DMA_WAITOK,
   1203  1.4.6.2  skrll 		    &sc->tx.buf_map[i].map);
   1204  1.4.6.2  skrll 		if (error != 0) {
   1205  1.4.6.2  skrll 			device_printf(sc->dev, "cannot create TX buffer map\n");
   1206  1.4.6.2  skrll 			return error;
   1207  1.4.6.2  skrll 		}
   1208  1.4.6.2  skrll 		sunxi_emac_setup_txdesc(sc, i, 0, 0, 0);
   1209  1.4.6.2  skrll 	}
   1210  1.4.6.2  skrll 
   1211  1.4.6.2  skrll 	/* Setup RX ring */
   1212  1.4.6.2  skrll 	sc->rx.buf_tag = sc->rx.desc_tag = sc->dmat;
   1213  1.4.6.2  skrll 	error = bus_dmamap_create(sc->dmat, RX_DESC_SIZE, 1, RX_DESC_SIZE, 0,
   1214  1.4.6.2  skrll 	    BUS_DMA_WAITOK, &sc->rx.desc_map);
   1215  1.4.6.2  skrll 	if (error)
   1216  1.4.6.2  skrll 		return error;
   1217  1.4.6.2  skrll 	error = bus_dmamem_alloc(sc->dmat, RX_DESC_SIZE, DESC_ALIGN, 0,
   1218  1.4.6.2  skrll 	    &sc->rx.desc_dmaseg, 1, &nsegs, BUS_DMA_WAITOK);
   1219  1.4.6.2  skrll 	if (error)
   1220  1.4.6.2  skrll 		return error;
   1221  1.4.6.2  skrll 	error = bus_dmamem_map(sc->dmat, &sc->rx.desc_dmaseg, nsegs,
   1222  1.4.6.2  skrll 	    RX_DESC_SIZE, (void *)&sc->rx.desc_ring,
   1223  1.4.6.2  skrll 	    BUS_DMA_WAITOK);
   1224  1.4.6.2  skrll 	if (error)
   1225  1.4.6.2  skrll 		return error;
   1226  1.4.6.2  skrll 	error = bus_dmamap_load(sc->dmat, sc->rx.desc_map, sc->rx.desc_ring,
   1227  1.4.6.2  skrll 	    RX_DESC_SIZE, NULL, BUS_DMA_WAITOK);
   1228  1.4.6.2  skrll 	if (error)
   1229  1.4.6.2  skrll 		return error;
   1230  1.4.6.2  skrll 	sc->rx.desc_ring_paddr = sc->rx.desc_map->dm_segs[0].ds_addr;
   1231  1.4.6.2  skrll 
   1232  1.4.6.2  skrll 	memset(sc->rx.desc_ring, 0, RX_DESC_SIZE);
   1233  1.4.6.2  skrll 
   1234  1.4.6.2  skrll 	for (i = 0; i < RX_DESC_COUNT; i++) {
   1235  1.4.6.2  skrll 		error = bus_dmamap_create(sc->rx.buf_tag, MCLBYTES,
   1236  1.4.6.2  skrll 		    RX_DESC_COUNT, MCLBYTES, 0, BUS_DMA_WAITOK,
   1237  1.4.6.2  skrll 		    &sc->rx.buf_map[i].map);
   1238  1.4.6.2  skrll 		if (error != 0) {
   1239  1.4.6.2  skrll 			device_printf(sc->dev, "cannot create RX buffer map\n");
   1240  1.4.6.2  skrll 			return error;
   1241  1.4.6.2  skrll 		}
   1242  1.4.6.2  skrll 		if ((m = sunxi_emac_alloc_mbufcl(sc)) == NULL) {
   1243  1.4.6.2  skrll 			device_printf(sc->dev, "cannot allocate RX mbuf\n");
   1244  1.4.6.2  skrll 			return ENOMEM;
   1245  1.4.6.2  skrll 		}
   1246  1.4.6.2  skrll 		error = sunxi_emac_setup_rxbuf(sc, i, m);
   1247  1.4.6.2  skrll 		if (error != 0) {
   1248  1.4.6.2  skrll 			device_printf(sc->dev, "cannot create RX buffer\n");
   1249  1.4.6.2  skrll 			return error;
   1250  1.4.6.2  skrll 		}
   1251  1.4.6.2  skrll 	}
   1252  1.4.6.2  skrll 	bus_dmamap_sync(sc->rx.desc_tag, sc->rx.desc_map,
   1253  1.4.6.2  skrll 	    0, sc->rx.desc_map->dm_mapsize,
   1254  1.4.6.2  skrll 	    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
   1255  1.4.6.2  skrll 
   1256  1.4.6.2  skrll 	/* Write transmit and receive descriptor base address registers */
   1257  1.4.6.2  skrll 	WR4(sc, EMAC_TX_DMA_LIST, sc->tx.desc_ring_paddr);
   1258  1.4.6.2  skrll 	WR4(sc, EMAC_RX_DMA_LIST, sc->rx.desc_ring_paddr);
   1259  1.4.6.2  skrll 
   1260  1.4.6.2  skrll 	return 0;
   1261  1.4.6.2  skrll }
   1262  1.4.6.2  skrll 
   1263  1.4.6.2  skrll static int
   1264  1.4.6.2  skrll sunxi_emac_get_resources(struct sunxi_emac_softc *sc)
   1265  1.4.6.2  skrll {
   1266  1.4.6.2  skrll 	const int phandle = sc->phandle;
   1267  1.4.6.2  skrll 	bus_addr_t addr, size;
   1268  1.4.6.2  skrll 	u_int n;
   1269  1.4.6.2  skrll 
   1270  1.4.6.2  skrll 	/* Map registers */
   1271  1.4.6.2  skrll 	for (n = 0; n < _RES_NITEMS; n++) {
   1272  1.4.6.2  skrll 		if (fdtbus_get_reg(phandle, n, &addr, &size) != 0)
   1273  1.4.6.2  skrll 			return ENXIO;
   1274  1.4.6.2  skrll 		if (bus_space_map(sc->bst, addr, size, 0, &sc->bsh[n]) != 0)
   1275  1.4.6.2  skrll 			return ENXIO;
   1276  1.4.6.2  skrll 	}
   1277  1.4.6.2  skrll 
   1278  1.4.6.2  skrll 	/* Get clocks and resets. "ahb" is required, "ephy" is optional. */
   1279  1.4.6.2  skrll 
   1280  1.4.6.2  skrll 	if ((sc->clk_ahb = fdtbus_clock_get(phandle, "ahb")) == NULL)
   1281  1.4.6.2  skrll 		return ENXIO;
   1282  1.4.6.2  skrll 	sc->clk_ephy = fdtbus_clock_get(phandle, "ephy");
   1283  1.4.6.2  skrll 
   1284  1.4.6.2  skrll 	if ((sc->rst_ahb = fdtbus_reset_get(phandle, "ahb")) == NULL)
   1285  1.4.6.2  skrll 		return ENXIO;
   1286  1.4.6.2  skrll 	sc->rst_ahb = fdtbus_reset_get(phandle, "ephy");
   1287  1.4.6.2  skrll 
   1288  1.4.6.2  skrll 	/* Regulator is optional */
   1289  1.4.6.2  skrll 	sc->reg_phy = fdtbus_regulator_acquire(phandle, "phy-supply");
   1290  1.4.6.2  skrll 
   1291  1.4.6.2  skrll 	/* Reset GPIO is optional */
   1292  1.4.6.2  skrll 	sc->pin_reset = fdtbus_gpio_acquire(sc->phandle,
   1293  1.4.6.2  skrll 	    "allwinner,reset-gpio", GPIO_PIN_OUTPUT);
   1294  1.4.6.2  skrll 
   1295  1.4.6.2  skrll 	return 0;
   1296  1.4.6.2  skrll }
   1297  1.4.6.2  skrll 
   1298  1.4.6.2  skrll static int
   1299  1.4.6.2  skrll sunxi_emac_match(device_t parent, cfdata_t cf, void *aux)
   1300  1.4.6.2  skrll {
   1301  1.4.6.2  skrll 	struct fdt_attach_args * const faa = aux;
   1302  1.4.6.2  skrll 
   1303  1.4.6.2  skrll 	return of_match_compat_data(faa->faa_phandle, compat_data);
   1304  1.4.6.2  skrll }
   1305  1.4.6.2  skrll 
   1306  1.4.6.2  skrll static void
   1307  1.4.6.2  skrll sunxi_emac_attach(device_t parent, device_t self, void *aux)
   1308  1.4.6.2  skrll {
   1309  1.4.6.2  skrll 	struct fdt_attach_args * const faa = aux;
   1310  1.4.6.2  skrll 	struct sunxi_emac_softc * const sc = device_private(self);
   1311  1.4.6.2  skrll 	const int phandle = faa->faa_phandle;
   1312  1.4.6.2  skrll 	struct mii_data *mii = &sc->mii;
   1313  1.4.6.2  skrll 	struct ifnet *ifp = &sc->ec.ec_if;
   1314  1.4.6.2  skrll 	uint8_t eaddr[ETHER_ADDR_LEN];
   1315  1.4.6.2  skrll 	char intrstr[128];
   1316  1.4.6.2  skrll 
   1317  1.4.6.2  skrll 	sc->dev = self;
   1318  1.4.6.2  skrll 	sc->phandle = phandle;
   1319  1.4.6.2  skrll 	sc->bst = faa->faa_bst;
   1320  1.4.6.2  skrll 	sc->dmat = faa->faa_dmat;
   1321  1.4.6.2  skrll 	sc->type = of_search_compatible(phandle, compat_data)->data;
   1322  1.4.6.2  skrll 
   1323  1.4.6.2  skrll 	if (sunxi_emac_get_resources(sc) != 0) {
   1324  1.4.6.2  skrll 		aprint_error(": cannot allocate resources for device\n");
   1325  1.4.6.2  skrll 		return;
   1326  1.4.6.2  skrll 	}
   1327  1.4.6.2  skrll 	if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
   1328  1.4.6.2  skrll 		aprint_error(": cannot decode interrupt\n");
   1329  1.4.6.2  skrll 		return;
   1330  1.4.6.2  skrll 	}
   1331  1.4.6.2  skrll 
   1332  1.4.6.2  skrll 	mutex_init(&sc->mtx, MUTEX_DEFAULT, IPL_NET);
   1333  1.4.6.2  skrll 	callout_init(&sc->stat_ch, CALLOUT_FLAGS);
   1334  1.4.6.2  skrll 	callout_setfunc(&sc->stat_ch, sunxi_emac_tick, sc);
   1335  1.4.6.2  skrll 
   1336  1.4.6.2  skrll 	aprint_naive("\n");
   1337  1.4.6.2  skrll 	aprint_normal(": EMAC\n");
   1338  1.4.6.2  skrll 
   1339  1.4.6.2  skrll 	/* Setup clocks and regulators */
   1340  1.4.6.2  skrll 	if (sunxi_emac_setup_resources(sc) != 0)
   1341  1.4.6.2  skrll 		return;
   1342  1.4.6.2  skrll 
   1343  1.4.6.2  skrll 	/* Read MAC address before resetting the chip */
   1344  1.4.6.2  skrll 	sunxi_emac_get_eaddr(sc, eaddr);
   1345  1.4.6.2  skrll 
   1346  1.4.6.2  skrll 	/* Soft reset EMAC core */
   1347  1.4.6.2  skrll 	if (sunxi_emac_reset(sc) != 0)
   1348  1.4.6.2  skrll 		return;
   1349  1.4.6.2  skrll 
   1350  1.4.6.2  skrll 	/* Setup DMA descriptors */
   1351  1.4.6.2  skrll 	if (sunxi_emac_setup_dma(sc) != 0) {
   1352  1.4.6.2  skrll 		aprint_error_dev(self, "failed to setup DMA descriptors\n");
   1353  1.4.6.2  skrll 		return;
   1354  1.4.6.2  skrll 	}
   1355  1.4.6.2  skrll 
   1356  1.4.6.2  skrll 	/* Install interrupt handler */
   1357  1.4.6.2  skrll 	sc->ih = fdtbus_intr_establish(phandle, 0, IPL_NET,
   1358  1.4.6.2  skrll 	    FDT_INTR_FLAGS, sunxi_emac_intr, sc);
   1359  1.4.6.2  skrll 	if (sc->ih == NULL) {
   1360  1.4.6.2  skrll 		aprint_error_dev(self, "failed to establish interrupt on %s\n",
   1361  1.4.6.2  skrll 		    intrstr);
   1362  1.4.6.2  skrll 		return;
   1363  1.4.6.2  skrll 	}
   1364  1.4.6.2  skrll 	aprint_normal_dev(self, "interrupting on %s\n", intrstr);
   1365  1.4.6.2  skrll 
   1366  1.4.6.2  skrll 	/* Setup ethernet interface */
   1367  1.4.6.2  skrll 	ifp->if_softc = sc;
   1368  1.4.6.2  skrll 	snprintf(ifp->if_xname, IFNAMSIZ, EMAC_IFNAME, device_unit(self));
   1369  1.4.6.2  skrll 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
   1370  1.4.6.2  skrll #ifdef EMAC_MPSAFE
   1371  1.4.6.2  skrll 	ifp->if_extflags = IFEF_START_MPSAFE;
   1372  1.4.6.2  skrll #endif
   1373  1.4.6.2  skrll 	ifp->if_start = sunxi_emac_start;
   1374  1.4.6.2  skrll 	ifp->if_ioctl = sunxi_emac_ioctl;
   1375  1.4.6.2  skrll 	ifp->if_init = sunxi_emac_init;
   1376  1.4.6.2  skrll 	ifp->if_stop = sunxi_emac_stop;
   1377  1.4.6.2  skrll 	ifp->if_capabilities = IFCAP_CSUM_IPv4_Rx |
   1378  1.4.6.2  skrll 			       IFCAP_CSUM_IPv4_Tx |
   1379  1.4.6.2  skrll 			       IFCAP_CSUM_TCPv4_Rx |
   1380  1.4.6.2  skrll 			       IFCAP_CSUM_TCPv4_Tx |
   1381  1.4.6.2  skrll 			       IFCAP_CSUM_UDPv4_Rx |
   1382  1.4.6.2  skrll 			       IFCAP_CSUM_UDPv4_Tx;
   1383  1.4.6.2  skrll 	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
   1384  1.4.6.2  skrll 	IFQ_SET_READY(&ifp->if_snd);
   1385  1.4.6.2  skrll 
   1386  1.4.6.2  skrll 	/* 802.1Q VLAN-sized frames are supported */
   1387  1.4.6.2  skrll 	sc->ec.ec_capabilities |= ETHERCAP_VLAN_MTU;
   1388  1.4.6.2  skrll 
   1389  1.4.6.2  skrll 	/* Attach MII driver */
   1390  1.4.6.2  skrll 	sc->ec.ec_mii = mii;
   1391  1.4.6.2  skrll 	ifmedia_init(&mii->mii_media, 0, ether_mediachange, ether_mediastatus);
   1392  1.4.6.2  skrll 	mii->mii_ifp = ifp;
   1393  1.4.6.2  skrll 	mii->mii_readreg = sunxi_emac_mii_readreg;
   1394  1.4.6.2  skrll 	mii->mii_writereg = sunxi_emac_mii_writereg;
   1395  1.4.6.2  skrll 	mii->mii_statchg = sunxi_emac_mii_statchg;
   1396  1.4.6.2  skrll 	mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY,
   1397  1.4.6.2  skrll 	    MIIF_DOPAUSE);
   1398  1.4.6.2  skrll 
   1399  1.4.6.2  skrll 	if (LIST_EMPTY(&mii->mii_phys)) {
   1400  1.4.6.2  skrll 		aprint_error_dev(self, "no PHY found!\n");
   1401  1.4.6.2  skrll 		return;
   1402  1.4.6.2  skrll 	}
   1403  1.4.6.2  skrll 	ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_AUTO);
   1404  1.4.6.2  skrll 
   1405  1.4.6.2  skrll 	/* Attach interface */
   1406  1.4.6.2  skrll 	if_attach(ifp);
   1407  1.4.6.2  skrll 	if_deferred_start_init(ifp, NULL);
   1408  1.4.6.2  skrll 
   1409  1.4.6.2  skrll 	/* Attach ethernet interface */
   1410  1.4.6.2  skrll 	ether_ifattach(ifp, eaddr);
   1411  1.4.6.2  skrll }
   1412  1.4.6.2  skrll 
   1413  1.4.6.2  skrll CFATTACH_DECL_NEW(sunxi_emac, sizeof(struct sunxi_emac_softc),
   1414  1.4.6.2  skrll     sunxi_emac_match, sunxi_emac_attach, NULL, NULL);
   1415