1d3810ff9SJared McNeill /*- 2d3810ff9SJared McNeill * Copyright (c) 2016 Jared McNeill <jmcneill@invisible.ca> 3d3810ff9SJared McNeill * All rights reserved. 4d3810ff9SJared McNeill * 5d3810ff9SJared McNeill * Redistribution and use in source and binary forms, with or without 6d3810ff9SJared McNeill * modification, are permitted provided that the following conditions 7d3810ff9SJared McNeill * are met: 8d3810ff9SJared McNeill * 1. Redistributions of source code must retain the above copyright 9d3810ff9SJared McNeill * notice, this list of conditions and the following disclaimer. 10d3810ff9SJared McNeill * 2. Redistributions in binary form must reproduce the above copyright 11d3810ff9SJared McNeill * notice, this list of conditions and the following disclaimer in the 12d3810ff9SJared McNeill * documentation and/or other materials provided with the distribution. 13d3810ff9SJared McNeill * 14d3810ff9SJared McNeill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15d3810ff9SJared McNeill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16d3810ff9SJared McNeill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17d3810ff9SJared McNeill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18d3810ff9SJared McNeill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 19d3810ff9SJared McNeill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 20d3810ff9SJared McNeill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 21d3810ff9SJared McNeill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 22d3810ff9SJared McNeill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23d3810ff9SJared McNeill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24d3810ff9SJared McNeill * SUCH DAMAGE. 25d3810ff9SJared McNeill * 26d3810ff9SJared McNeill * $FreeBSD$ 27d3810ff9SJared McNeill */ 28d3810ff9SJared McNeill 29d3810ff9SJared McNeill /* 30d3810ff9SJared McNeill * Allwinner Gigabit Ethernet MAC (EMAC) controller 31d3810ff9SJared McNeill */ 32d3810ff9SJared McNeill 3316928528SJared McNeill #include "opt_device_polling.h" 3416928528SJared McNeill 35d3810ff9SJared McNeill #include <sys/cdefs.h> 36d3810ff9SJared McNeill __FBSDID("$FreeBSD$"); 37d3810ff9SJared McNeill 38d3810ff9SJared McNeill #include <sys/param.h> 39d3810ff9SJared McNeill #include <sys/systm.h> 40d3810ff9SJared McNeill #include <sys/bus.h> 41d3810ff9SJared McNeill #include <sys/rman.h> 42d3810ff9SJared McNeill #include <sys/kernel.h> 43d3810ff9SJared McNeill #include <sys/endian.h> 44d3810ff9SJared McNeill #include <sys/mbuf.h> 45d3810ff9SJared McNeill #include <sys/socket.h> 46d3810ff9SJared McNeill #include <sys/sockio.h> 47d3810ff9SJared McNeill #include <sys/module.h> 48d3810ff9SJared McNeill #include <sys/taskqueue.h> 4901a469b8SJared McNeill #include <sys/gpio.h> 50d3810ff9SJared McNeill 51d3810ff9SJared McNeill #include <net/bpf.h> 52d3810ff9SJared McNeill #include <net/if.h> 53d3810ff9SJared McNeill #include <net/ethernet.h> 54d3810ff9SJared McNeill #include <net/if_dl.h> 55d3810ff9SJared McNeill #include <net/if_media.h> 56d3810ff9SJared McNeill #include <net/if_types.h> 57d3810ff9SJared McNeill #include <net/if_var.h> 58d3810ff9SJared McNeill 59d3810ff9SJared McNeill #include <machine/bus.h> 60d3810ff9SJared McNeill 61d3810ff9SJared McNeill #include <dev/ofw/ofw_bus.h> 62d3810ff9SJared McNeill #include <dev/ofw/ofw_bus_subr.h> 63d3810ff9SJared McNeill 64d3810ff9SJared McNeill #include <arm/allwinner/if_awgreg.h> 651403e695SJared McNeill #include <arm/allwinner/aw_sid.h> 66d3810ff9SJared McNeill #include <dev/mii/mii.h> 67d3810ff9SJared McNeill #include <dev/mii/miivar.h> 68d3810ff9SJared McNeill 69d3810ff9SJared McNeill #include <dev/extres/clk/clk.h> 70d3810ff9SJared McNeill #include <dev/extres/hwreset/hwreset.h> 71d3810ff9SJared McNeill #include <dev/extres/regulator/regulator.h> 722defb358SKyle Evans #include <dev/extres/syscon/syscon.h> 73d3810ff9SJared McNeill 742defb358SKyle Evans #include "syscon_if.h" 75d3810ff9SJared McNeill #include "miibus_if.h" 7601a469b8SJared McNeill #include "gpio_if.h" 77d3810ff9SJared McNeill 7801a469b8SJared McNeill #define RD4(sc, reg) bus_read_4((sc)->res[_RES_EMAC], (reg)) 7901a469b8SJared McNeill #define WR4(sc, reg, val) bus_write_4((sc)->res[_RES_EMAC], (reg), (val)) 80d3810ff9SJared McNeill 81d3810ff9SJared McNeill #define AWG_LOCK(sc) mtx_lock(&(sc)->mtx) 82d3810ff9SJared McNeill #define AWG_UNLOCK(sc) mtx_unlock(&(sc)->mtx); 83d3810ff9SJared McNeill #define AWG_ASSERT_LOCKED(sc) mtx_assert(&(sc)->mtx, MA_OWNED) 84d3810ff9SJared McNeill #define AWG_ASSERT_UNLOCKED(sc) mtx_assert(&(sc)->mtx, MA_NOTOWNED) 85d3810ff9SJared McNeill 86d3810ff9SJared McNeill #define DESC_ALIGN 4 8716928528SJared McNeill #define TX_DESC_COUNT 1024 88d3810ff9SJared McNeill #define TX_DESC_SIZE (sizeof(struct emac_desc) * TX_DESC_COUNT) 89d3810ff9SJared McNeill #define RX_DESC_COUNT 256 90d3810ff9SJared McNeill #define RX_DESC_SIZE (sizeof(struct emac_desc) * RX_DESC_COUNT) 91d3810ff9SJared McNeill 92d3810ff9SJared McNeill #define DESC_OFF(n) ((n) * sizeof(struct emac_desc)) 93d3810ff9SJared McNeill #define TX_NEXT(n) (((n) + 1) & (TX_DESC_COUNT - 1)) 94d3810ff9SJared McNeill #define TX_SKIP(n, o) (((n) + (o)) & (TX_DESC_COUNT - 1)) 95d3810ff9SJared McNeill #define RX_NEXT(n) (((n) + 1) & (RX_DESC_COUNT - 1)) 96d3810ff9SJared McNeill 97031d5777SOleksandr Tymoshenko #define TX_MAX_SEGS 20 98d3810ff9SJared McNeill 99d3810ff9SJared McNeill #define SOFT_RST_RETRY 1000 100d3810ff9SJared McNeill #define MII_BUSY_RETRY 1000 101d3810ff9SJared McNeill #define MDIO_FREQ 2500000 102d3810ff9SJared McNeill 103d3810ff9SJared McNeill #define BURST_LEN_DEFAULT 8 104d3810ff9SJared McNeill #define RX_TX_PRI_DEFAULT 0 105d3810ff9SJared McNeill #define PAUSE_TIME_DEFAULT 0x400 106d3810ff9SJared McNeill #define TX_INTERVAL_DEFAULT 64 10716928528SJared McNeill #define RX_BATCH_DEFAULT 64 108d3810ff9SJared McNeill 10901a469b8SJared McNeill /* syscon EMAC clock register */ 1102defb358SKyle Evans #define EMAC_CLK_REG 0x30 11101a469b8SJared McNeill #define EMAC_CLK_EPHY_ADDR (0x1f << 20) /* H3 */ 11201a469b8SJared McNeill #define EMAC_CLK_EPHY_ADDR_SHIFT 20 11301a469b8SJared McNeill #define EMAC_CLK_EPHY_LED_POL (1 << 17) /* H3 */ 11401a469b8SJared McNeill #define EMAC_CLK_EPHY_SHUTDOWN (1 << 16) /* H3 */ 11501a469b8SJared McNeill #define EMAC_CLK_EPHY_SELECT (1 << 15) /* H3 */ 11601a469b8SJared McNeill #define EMAC_CLK_RMII_EN (1 << 13) 11701a469b8SJared McNeill #define EMAC_CLK_ETXDC (0x7 << 10) 11801a469b8SJared McNeill #define EMAC_CLK_ETXDC_SHIFT 10 11901a469b8SJared McNeill #define EMAC_CLK_ERXDC (0x1f << 5) 12001a469b8SJared McNeill #define EMAC_CLK_ERXDC_SHIFT 5 12101a469b8SJared McNeill #define EMAC_CLK_PIT (0x1 << 2) 12201a469b8SJared McNeill #define EMAC_CLK_PIT_MII (0 << 2) 12301a469b8SJared McNeill #define EMAC_CLK_PIT_RGMII (1 << 2) 12401a469b8SJared McNeill #define EMAC_CLK_SRC (0x3 << 0) 12501a469b8SJared McNeill #define EMAC_CLK_SRC_MII (0 << 0) 12601a469b8SJared McNeill #define EMAC_CLK_SRC_EXT_RGMII (1 << 0) 12701a469b8SJared McNeill #define EMAC_CLK_SRC_RGMII (2 << 0) 12801a469b8SJared McNeill 129d3810ff9SJared McNeill /* Burst length of RX and TX DMA transfers */ 130d3810ff9SJared McNeill static int awg_burst_len = BURST_LEN_DEFAULT; 131d3810ff9SJared McNeill TUNABLE_INT("hw.awg.burst_len", &awg_burst_len); 132d3810ff9SJared McNeill 133d3810ff9SJared McNeill /* RX / TX DMA priority. If 1, RX DMA has priority over TX DMA. */ 134d3810ff9SJared McNeill static int awg_rx_tx_pri = RX_TX_PRI_DEFAULT; 135d3810ff9SJared McNeill TUNABLE_INT("hw.awg.rx_tx_pri", &awg_rx_tx_pri); 136d3810ff9SJared McNeill 137d3810ff9SJared McNeill /* Pause time field in the transmitted control frame */ 138d3810ff9SJared McNeill static int awg_pause_time = PAUSE_TIME_DEFAULT; 139d3810ff9SJared McNeill TUNABLE_INT("hw.awg.pause_time", &awg_pause_time); 140d3810ff9SJared McNeill 141d3810ff9SJared McNeill /* Request a TX interrupt every <n> descriptors */ 142d3810ff9SJared McNeill static int awg_tx_interval = TX_INTERVAL_DEFAULT; 143d3810ff9SJared McNeill TUNABLE_INT("hw.awg.tx_interval", &awg_tx_interval); 144d3810ff9SJared McNeill 14516928528SJared McNeill /* Maximum number of mbufs to send to if_input */ 14616928528SJared McNeill static int awg_rx_batch = RX_BATCH_DEFAULT; 14716928528SJared McNeill TUNABLE_INT("hw.awg.rx_batch", &awg_rx_batch); 14816928528SJared McNeill 14901a469b8SJared McNeill enum awg_type { 15001a469b8SJared McNeill EMAC_A83T = 1, 15101a469b8SJared McNeill EMAC_H3, 15250bb2d50SEmmanuel Vadot EMAC_A64, 15301a469b8SJared McNeill }; 15401a469b8SJared McNeill 155d3810ff9SJared McNeill static struct ofw_compat_data compat_data[] = { 15601a469b8SJared McNeill { "allwinner,sun8i-a83t-emac", EMAC_A83T }, 15701a469b8SJared McNeill { "allwinner,sun8i-h3-emac", EMAC_H3 }, 15850bb2d50SEmmanuel Vadot { "allwinner,sun50i-a64-emac", EMAC_A64 }, 159d3810ff9SJared McNeill { NULL, 0 } 160d3810ff9SJared McNeill }; 161d3810ff9SJared McNeill 162d3810ff9SJared McNeill struct awg_bufmap { 163d3810ff9SJared McNeill bus_dmamap_t map; 164d3810ff9SJared McNeill struct mbuf *mbuf; 165d3810ff9SJared McNeill }; 166d3810ff9SJared McNeill 167d3810ff9SJared McNeill struct awg_txring { 168d3810ff9SJared McNeill bus_dma_tag_t desc_tag; 169d3810ff9SJared McNeill bus_dmamap_t desc_map; 170d3810ff9SJared McNeill struct emac_desc *desc_ring; 171d3810ff9SJared McNeill bus_addr_t desc_ring_paddr; 172d3810ff9SJared McNeill bus_dma_tag_t buf_tag; 173d3810ff9SJared McNeill struct awg_bufmap buf_map[TX_DESC_COUNT]; 174d3810ff9SJared McNeill u_int cur, next, queued; 1751ee5a3d3SEmmanuel Vadot u_int segs; 176d3810ff9SJared McNeill }; 177d3810ff9SJared McNeill 178d3810ff9SJared McNeill struct awg_rxring { 179d3810ff9SJared McNeill bus_dma_tag_t desc_tag; 180d3810ff9SJared McNeill bus_dmamap_t desc_map; 181d3810ff9SJared McNeill struct emac_desc *desc_ring; 182d3810ff9SJared McNeill bus_addr_t desc_ring_paddr; 183d3810ff9SJared McNeill bus_dma_tag_t buf_tag; 184d3810ff9SJared McNeill struct awg_bufmap buf_map[RX_DESC_COUNT]; 185bd906329SEmmanuel Vadot bus_dmamap_t buf_spare_map; 186d3810ff9SJared McNeill u_int cur; 187d3810ff9SJared McNeill }; 188d3810ff9SJared McNeill 18901a469b8SJared McNeill enum { 19001a469b8SJared McNeill _RES_EMAC, 19101a469b8SJared McNeill _RES_IRQ, 19201a469b8SJared McNeill _RES_SYSCON, 19301a469b8SJared McNeill _RES_NITEMS 19401a469b8SJared McNeill }; 19501a469b8SJared McNeill 196d3810ff9SJared McNeill struct awg_softc { 19701a469b8SJared McNeill struct resource *res[_RES_NITEMS]; 198d3810ff9SJared McNeill struct mtx mtx; 199d3810ff9SJared McNeill if_t ifp; 200031d5777SOleksandr Tymoshenko device_t dev; 201d3810ff9SJared McNeill device_t miibus; 202d3810ff9SJared McNeill struct callout stat_ch; 203d3810ff9SJared McNeill struct task link_task; 204d3810ff9SJared McNeill void *ih; 205d3810ff9SJared McNeill u_int mdc_div_ratio_m; 206d3810ff9SJared McNeill int link; 207d3810ff9SJared McNeill int if_flags; 20801a469b8SJared McNeill enum awg_type type; 2092defb358SKyle Evans struct syscon *syscon; 210d3810ff9SJared McNeill 211d3810ff9SJared McNeill struct awg_txring tx; 212d3810ff9SJared McNeill struct awg_rxring rx; 213d3810ff9SJared McNeill }; 214d3810ff9SJared McNeill 215d3810ff9SJared McNeill static struct resource_spec awg_spec[] = { 216d3810ff9SJared McNeill { SYS_RES_MEMORY, 0, RF_ACTIVE }, 217d3810ff9SJared McNeill { SYS_RES_IRQ, 0, RF_ACTIVE }, 21801a469b8SJared McNeill { SYS_RES_MEMORY, 1, RF_ACTIVE | RF_OPTIONAL }, 219d3810ff9SJared McNeill { -1, 0 } 220d3810ff9SJared McNeill }; 221d3810ff9SJared McNeill 2223f9ade06SEmmanuel Vadot static void awg_txeof(struct awg_softc *sc); 2233f9ade06SEmmanuel Vadot 2242defb358SKyle Evans static uint32_t syscon_read_emac_clk_reg(device_t dev); 2252defb358SKyle Evans static void syscon_write_emac_clk_reg(device_t dev, uint32_t val); 226767754e5SKyle Evans static phandle_t awg_get_phy_node(device_t dev); 227767754e5SKyle Evans static bool awg_has_internal_phy(device_t dev); 2282defb358SKyle Evans 229d3810ff9SJared McNeill static int 230d3810ff9SJared McNeill awg_miibus_readreg(device_t dev, int phy, int reg) 231d3810ff9SJared McNeill { 232d3810ff9SJared McNeill struct awg_softc *sc; 233d3810ff9SJared McNeill int retry, val; 234d3810ff9SJared McNeill 235d3810ff9SJared McNeill sc = device_get_softc(dev); 236d3810ff9SJared McNeill val = 0; 237d3810ff9SJared McNeill 238d3810ff9SJared McNeill WR4(sc, EMAC_MII_CMD, 239d3810ff9SJared McNeill (sc->mdc_div_ratio_m << MDC_DIV_RATIO_M_SHIFT) | 240d3810ff9SJared McNeill (phy << PHY_ADDR_SHIFT) | 241d3810ff9SJared McNeill (reg << PHY_REG_ADDR_SHIFT) | 242d3810ff9SJared McNeill MII_BUSY); 243d3810ff9SJared McNeill for (retry = MII_BUSY_RETRY; retry > 0; retry--) { 244d3810ff9SJared McNeill if ((RD4(sc, EMAC_MII_CMD) & MII_BUSY) == 0) { 245d3810ff9SJared McNeill val = RD4(sc, EMAC_MII_DATA); 246d3810ff9SJared McNeill break; 247d3810ff9SJared McNeill } 248d3810ff9SJared McNeill DELAY(10); 249d3810ff9SJared McNeill } 250d3810ff9SJared McNeill 251d3810ff9SJared McNeill if (retry == 0) 252d3810ff9SJared McNeill device_printf(dev, "phy read timeout, phy=%d reg=%d\n", 253d3810ff9SJared McNeill phy, reg); 254d3810ff9SJared McNeill 255d3810ff9SJared McNeill return (val); 256d3810ff9SJared McNeill } 257d3810ff9SJared McNeill 258d3810ff9SJared McNeill static int 259d3810ff9SJared McNeill awg_miibus_writereg(device_t dev, int phy, int reg, int val) 260d3810ff9SJared McNeill { 261d3810ff9SJared McNeill struct awg_softc *sc; 262d3810ff9SJared McNeill int retry; 263d3810ff9SJared McNeill 264d3810ff9SJared McNeill sc = device_get_softc(dev); 265d3810ff9SJared McNeill 266d3810ff9SJared McNeill WR4(sc, EMAC_MII_DATA, val); 267d3810ff9SJared McNeill WR4(sc, EMAC_MII_CMD, 268d3810ff9SJared McNeill (sc->mdc_div_ratio_m << MDC_DIV_RATIO_M_SHIFT) | 269d3810ff9SJared McNeill (phy << PHY_ADDR_SHIFT) | 270d3810ff9SJared McNeill (reg << PHY_REG_ADDR_SHIFT) | 271d3810ff9SJared McNeill MII_WR | MII_BUSY); 272d3810ff9SJared McNeill for (retry = MII_BUSY_RETRY; retry > 0; retry--) { 273d3810ff9SJared McNeill if ((RD4(sc, EMAC_MII_CMD) & MII_BUSY) == 0) 274d3810ff9SJared McNeill break; 275d3810ff9SJared McNeill DELAY(10); 276d3810ff9SJared McNeill } 277d3810ff9SJared McNeill 278d3810ff9SJared McNeill if (retry == 0) 279d3810ff9SJared McNeill device_printf(dev, "phy write timeout, phy=%d reg=%d\n", 280d3810ff9SJared McNeill phy, reg); 281d3810ff9SJared McNeill 282d3810ff9SJared McNeill return (0); 283d3810ff9SJared McNeill } 284d3810ff9SJared McNeill 285d3810ff9SJared McNeill static void 286d3810ff9SJared McNeill awg_update_link_locked(struct awg_softc *sc) 287d3810ff9SJared McNeill { 288d3810ff9SJared McNeill struct mii_data *mii; 289d3810ff9SJared McNeill uint32_t val; 290d3810ff9SJared McNeill 291d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 292d3810ff9SJared McNeill 293d3810ff9SJared McNeill if ((if_getdrvflags(sc->ifp) & IFF_DRV_RUNNING) == 0) 294d3810ff9SJared McNeill return; 295d3810ff9SJared McNeill mii = device_get_softc(sc->miibus); 296d3810ff9SJared McNeill 297d3810ff9SJared McNeill if ((mii->mii_media_status & (IFM_ACTIVE | IFM_AVALID)) == 298d3810ff9SJared McNeill (IFM_ACTIVE | IFM_AVALID)) { 299d3810ff9SJared McNeill switch (IFM_SUBTYPE(mii->mii_media_active)) { 300d3810ff9SJared McNeill case IFM_1000_T: 301d3810ff9SJared McNeill case IFM_1000_SX: 302d3810ff9SJared McNeill case IFM_100_TX: 303d3810ff9SJared McNeill case IFM_10_T: 304d3810ff9SJared McNeill sc->link = 1; 305d3810ff9SJared McNeill break; 306d3810ff9SJared McNeill default: 307d3810ff9SJared McNeill sc->link = 0; 308d3810ff9SJared McNeill break; 309d3810ff9SJared McNeill } 310d3810ff9SJared McNeill } else 311d3810ff9SJared McNeill sc->link = 0; 312d3810ff9SJared McNeill 313d3810ff9SJared McNeill if (sc->link == 0) 314d3810ff9SJared McNeill return; 315d3810ff9SJared McNeill 316d3810ff9SJared McNeill val = RD4(sc, EMAC_BASIC_CTL_0); 317d3810ff9SJared McNeill val &= ~(BASIC_CTL_SPEED | BASIC_CTL_DUPLEX); 318d3810ff9SJared McNeill 319d3810ff9SJared McNeill if (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T || 320d3810ff9SJared McNeill IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_SX) 321d3810ff9SJared McNeill val |= BASIC_CTL_SPEED_1000 << BASIC_CTL_SPEED_SHIFT; 322d3810ff9SJared McNeill else if (IFM_SUBTYPE(mii->mii_media_active) == IFM_100_TX) 323d3810ff9SJared McNeill val |= BASIC_CTL_SPEED_100 << BASIC_CTL_SPEED_SHIFT; 324d3810ff9SJared McNeill else 325d3810ff9SJared McNeill val |= BASIC_CTL_SPEED_10 << BASIC_CTL_SPEED_SHIFT; 326d3810ff9SJared McNeill 327d3810ff9SJared McNeill if ((IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0) 328d3810ff9SJared McNeill val |= BASIC_CTL_DUPLEX; 329d3810ff9SJared McNeill 330d3810ff9SJared McNeill WR4(sc, EMAC_BASIC_CTL_0, val); 331d3810ff9SJared McNeill 332d3810ff9SJared McNeill val = RD4(sc, EMAC_RX_CTL_0); 333d3810ff9SJared McNeill val &= ~RX_FLOW_CTL_EN; 334d3810ff9SJared McNeill if ((IFM_OPTIONS(mii->mii_media_active) & IFM_ETH_RXPAUSE) != 0) 335d3810ff9SJared McNeill val |= RX_FLOW_CTL_EN; 336d3810ff9SJared McNeill WR4(sc, EMAC_RX_CTL_0, val); 337d3810ff9SJared McNeill 338d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_FLOW_CTL); 339d3810ff9SJared McNeill val &= ~(PAUSE_TIME|TX_FLOW_CTL_EN); 340d3810ff9SJared McNeill if ((IFM_OPTIONS(mii->mii_media_active) & IFM_ETH_TXPAUSE) != 0) 341d3810ff9SJared McNeill val |= TX_FLOW_CTL_EN; 342d3810ff9SJared McNeill if ((IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0) 343d3810ff9SJared McNeill val |= awg_pause_time << PAUSE_TIME_SHIFT; 344d3810ff9SJared McNeill WR4(sc, EMAC_TX_FLOW_CTL, val); 345d3810ff9SJared McNeill } 346d3810ff9SJared McNeill 347d3810ff9SJared McNeill static void 348d3810ff9SJared McNeill awg_link_task(void *arg, int pending) 349d3810ff9SJared McNeill { 350d3810ff9SJared McNeill struct awg_softc *sc; 351d3810ff9SJared McNeill 352d3810ff9SJared McNeill sc = arg; 353d3810ff9SJared McNeill 354d3810ff9SJared McNeill AWG_LOCK(sc); 355d3810ff9SJared McNeill awg_update_link_locked(sc); 356d3810ff9SJared McNeill AWG_UNLOCK(sc); 357d3810ff9SJared McNeill } 358d3810ff9SJared McNeill 359d3810ff9SJared McNeill static void 360d3810ff9SJared McNeill awg_miibus_statchg(device_t dev) 361d3810ff9SJared McNeill { 362d3810ff9SJared McNeill struct awg_softc *sc; 363d3810ff9SJared McNeill 364d3810ff9SJared McNeill sc = device_get_softc(dev); 365d3810ff9SJared McNeill 366d3810ff9SJared McNeill taskqueue_enqueue(taskqueue_swi, &sc->link_task); 367d3810ff9SJared McNeill } 368d3810ff9SJared McNeill 369d3810ff9SJared McNeill static void 370d3810ff9SJared McNeill awg_media_status(if_t ifp, struct ifmediareq *ifmr) 371d3810ff9SJared McNeill { 372d3810ff9SJared McNeill struct awg_softc *sc; 373d3810ff9SJared McNeill struct mii_data *mii; 374d3810ff9SJared McNeill 375d3810ff9SJared McNeill sc = if_getsoftc(ifp); 376d3810ff9SJared McNeill mii = device_get_softc(sc->miibus); 377d3810ff9SJared McNeill 378d3810ff9SJared McNeill AWG_LOCK(sc); 379d3810ff9SJared McNeill mii_pollstat(mii); 380d3810ff9SJared McNeill ifmr->ifm_active = mii->mii_media_active; 381d3810ff9SJared McNeill ifmr->ifm_status = mii->mii_media_status; 382d3810ff9SJared McNeill AWG_UNLOCK(sc); 383d3810ff9SJared McNeill } 384d3810ff9SJared McNeill 385d3810ff9SJared McNeill static int 386d3810ff9SJared McNeill awg_media_change(if_t ifp) 387d3810ff9SJared McNeill { 388d3810ff9SJared McNeill struct awg_softc *sc; 389d3810ff9SJared McNeill struct mii_data *mii; 390d3810ff9SJared McNeill int error; 391d3810ff9SJared McNeill 392d3810ff9SJared McNeill sc = if_getsoftc(ifp); 393d3810ff9SJared McNeill mii = device_get_softc(sc->miibus); 394d3810ff9SJared McNeill 395d3810ff9SJared McNeill AWG_LOCK(sc); 396d3810ff9SJared McNeill error = mii_mediachg(mii); 397d3810ff9SJared McNeill AWG_UNLOCK(sc); 398d3810ff9SJared McNeill 399d3810ff9SJared McNeill return (error); 400d3810ff9SJared McNeill } 401d3810ff9SJared McNeill 402d3810ff9SJared McNeill static int 403337c6940SEmmanuel Vadot awg_encap(struct awg_softc *sc, struct mbuf **mp) 404d3810ff9SJared McNeill { 405fce9d29fSEmmanuel Vadot bus_dmamap_t map; 406d3810ff9SJared McNeill bus_dma_segment_t segs[TX_MAX_SEGS]; 407fce9d29fSEmmanuel Vadot int error, nsegs, cur, first, last, i; 408d3810ff9SJared McNeill u_int csum_flags; 409c6110e75SEmmanuel Vadot uint32_t flags, status; 410d3810ff9SJared McNeill struct mbuf *m; 411d3810ff9SJared McNeill 412337c6940SEmmanuel Vadot cur = first = sc->tx.cur; 413fce9d29fSEmmanuel Vadot map = sc->tx.buf_map[first].map; 414c6110e75SEmmanuel Vadot 415d3810ff9SJared McNeill m = *mp; 416fce9d29fSEmmanuel Vadot error = bus_dmamap_load_mbuf_sg(sc->tx.buf_tag, map, m, segs, 417fce9d29fSEmmanuel Vadot &nsegs, BUS_DMA_NOWAIT); 418d3810ff9SJared McNeill if (error == EFBIG) { 419d3810ff9SJared McNeill m = m_collapse(m, M_NOWAIT, TX_MAX_SEGS); 420031d5777SOleksandr Tymoshenko if (m == NULL) { 421337c6940SEmmanuel Vadot device_printf(sc->dev, "awg_encap: m_collapse failed\n"); 422337c6940SEmmanuel Vadot m_freem(*mp); 423337c6940SEmmanuel Vadot *mp = NULL; 424337c6940SEmmanuel Vadot return (ENOMEM); 425031d5777SOleksandr Tymoshenko } 426d3810ff9SJared McNeill *mp = m; 427fce9d29fSEmmanuel Vadot error = bus_dmamap_load_mbuf_sg(sc->tx.buf_tag, map, m, 428fce9d29fSEmmanuel Vadot segs, &nsegs, BUS_DMA_NOWAIT); 429337c6940SEmmanuel Vadot if (error != 0) { 430337c6940SEmmanuel Vadot m_freem(*mp); 431337c6940SEmmanuel Vadot *mp = NULL; 432337c6940SEmmanuel Vadot } 433d3810ff9SJared McNeill } 434031d5777SOleksandr Tymoshenko if (error != 0) { 435337c6940SEmmanuel Vadot device_printf(sc->dev, "awg_encap: bus_dmamap_load_mbuf_sg failed\n"); 436337c6940SEmmanuel Vadot return (error); 437337c6940SEmmanuel Vadot } 438337c6940SEmmanuel Vadot if (nsegs == 0) { 439337c6940SEmmanuel Vadot m_freem(*mp); 440337c6940SEmmanuel Vadot *mp = NULL; 441337c6940SEmmanuel Vadot return (EIO); 442337c6940SEmmanuel Vadot } 443337c6940SEmmanuel Vadot 444337c6940SEmmanuel Vadot if (sc->tx.queued + nsegs > TX_DESC_COUNT) { 445337c6940SEmmanuel Vadot bus_dmamap_unload(sc->tx.buf_tag, map); 446337c6940SEmmanuel Vadot return (ENOBUFS); 447031d5777SOleksandr Tymoshenko } 448d3810ff9SJared McNeill 449fce9d29fSEmmanuel Vadot bus_dmamap_sync(sc->tx.buf_tag, map, BUS_DMASYNC_PREWRITE); 450d3810ff9SJared McNeill 451d3810ff9SJared McNeill flags = TX_FIR_DESC; 452c6110e75SEmmanuel Vadot status = 0; 453d3810ff9SJared McNeill if ((m->m_pkthdr.csum_flags & CSUM_IP) != 0) { 454d3810ff9SJared McNeill if ((m->m_pkthdr.csum_flags & (CSUM_TCP|CSUM_UDP)) != 0) 455d3810ff9SJared McNeill csum_flags = TX_CHECKSUM_CTL_FULL; 456d3810ff9SJared McNeill else 457d3810ff9SJared McNeill csum_flags = TX_CHECKSUM_CTL_IP; 458d3810ff9SJared McNeill flags |= (csum_flags << TX_CHECKSUM_CTL_SHIFT); 459d3810ff9SJared McNeill } 460d3810ff9SJared McNeill 461c6110e75SEmmanuel Vadot for (i = 0; i < nsegs; i++) { 4621ee5a3d3SEmmanuel Vadot sc->tx.segs++; 4631ee5a3d3SEmmanuel Vadot if (i == nsegs - 1) { 464d3810ff9SJared McNeill flags |= TX_LAST_DESC; 4651ee5a3d3SEmmanuel Vadot /* 4661ee5a3d3SEmmanuel Vadot * Can only request TX completion 4671ee5a3d3SEmmanuel Vadot * interrupt on last descriptor. 4681ee5a3d3SEmmanuel Vadot */ 4691ee5a3d3SEmmanuel Vadot if (sc->tx.segs >= awg_tx_interval) { 4701ee5a3d3SEmmanuel Vadot sc->tx.segs = 0; 4711ee5a3d3SEmmanuel Vadot flags |= TX_INT_CTL; 4721ee5a3d3SEmmanuel Vadot } 4731ee5a3d3SEmmanuel Vadot } 474c6110e75SEmmanuel Vadot 475c6110e75SEmmanuel Vadot sc->tx.desc_ring[cur].addr = htole32((uint32_t)segs[i].ds_addr); 476c6110e75SEmmanuel Vadot sc->tx.desc_ring[cur].size = htole32(flags | segs[i].ds_len); 477c6110e75SEmmanuel Vadot sc->tx.desc_ring[cur].status = htole32(status); 478c6110e75SEmmanuel Vadot 479d3810ff9SJared McNeill flags &= ~TX_FIR_DESC; 480c6110e75SEmmanuel Vadot /* 481c6110e75SEmmanuel Vadot * Setting of the valid bit in the first descriptor is 482c6110e75SEmmanuel Vadot * deferred until the whole chain is fully set up. 483c6110e75SEmmanuel Vadot */ 484c6110e75SEmmanuel Vadot status = TX_DESC_CTL; 485c6110e75SEmmanuel Vadot 486c6110e75SEmmanuel Vadot ++sc->tx.queued; 487d3810ff9SJared McNeill cur = TX_NEXT(cur); 488d3810ff9SJared McNeill } 489d3810ff9SJared McNeill 490337c6940SEmmanuel Vadot sc->tx.cur = cur; 491337c6940SEmmanuel Vadot 492fce9d29fSEmmanuel Vadot /* Store mapping and mbuf in the last segment */ 493fce9d29fSEmmanuel Vadot last = TX_SKIP(cur, TX_DESC_COUNT - 1); 494fce9d29fSEmmanuel Vadot sc->tx.buf_map[first].map = sc->tx.buf_map[last].map; 495fce9d29fSEmmanuel Vadot sc->tx.buf_map[last].map = map; 496fce9d29fSEmmanuel Vadot sc->tx.buf_map[last].mbuf = m; 497c6110e75SEmmanuel Vadot 498c6110e75SEmmanuel Vadot /* 499c6110e75SEmmanuel Vadot * The whole mbuf chain has been DMA mapped, 500c6110e75SEmmanuel Vadot * fix the first descriptor. 501c6110e75SEmmanuel Vadot */ 502c6110e75SEmmanuel Vadot sc->tx.desc_ring[first].status = htole32(TX_DESC_CTL); 503c6110e75SEmmanuel Vadot 504337c6940SEmmanuel Vadot return (0); 505d3810ff9SJared McNeill } 506d3810ff9SJared McNeill 507d3810ff9SJared McNeill static void 508c6110e75SEmmanuel Vadot awg_clean_txbuf(struct awg_softc *sc, int index) 509c6110e75SEmmanuel Vadot { 510c6110e75SEmmanuel Vadot struct awg_bufmap *bmap; 511c6110e75SEmmanuel Vadot 512c6110e75SEmmanuel Vadot --sc->tx.queued; 513c6110e75SEmmanuel Vadot 514c6110e75SEmmanuel Vadot bmap = &sc->tx.buf_map[index]; 515c6110e75SEmmanuel Vadot if (bmap->mbuf != NULL) { 516c6110e75SEmmanuel Vadot bus_dmamap_sync(sc->tx.buf_tag, bmap->map, 517c6110e75SEmmanuel Vadot BUS_DMASYNC_POSTWRITE); 518c6110e75SEmmanuel Vadot bus_dmamap_unload(sc->tx.buf_tag, bmap->map); 519c6110e75SEmmanuel Vadot m_freem(bmap->mbuf); 520c6110e75SEmmanuel Vadot bmap->mbuf = NULL; 521c6110e75SEmmanuel Vadot } 522c6110e75SEmmanuel Vadot } 523c6110e75SEmmanuel Vadot 524c6110e75SEmmanuel Vadot static void 525d3810ff9SJared McNeill awg_setup_rxdesc(struct awg_softc *sc, int index, bus_addr_t paddr) 526d3810ff9SJared McNeill { 527d3810ff9SJared McNeill uint32_t status, size; 528d3810ff9SJared McNeill 529d3810ff9SJared McNeill status = RX_DESC_CTL; 530d3810ff9SJared McNeill size = MCLBYTES - 1; 531d3810ff9SJared McNeill 532d3810ff9SJared McNeill sc->rx.desc_ring[index].addr = htole32((uint32_t)paddr); 533d3810ff9SJared McNeill sc->rx.desc_ring[index].size = htole32(size); 534d3810ff9SJared McNeill sc->rx.desc_ring[index].status = htole32(status); 535d3810ff9SJared McNeill } 536d3810ff9SJared McNeill 537bd906329SEmmanuel Vadot static void 538bd906329SEmmanuel Vadot awg_reuse_rxdesc(struct awg_softc *sc, int index) 539d3810ff9SJared McNeill { 540d3810ff9SJared McNeill 541bd906329SEmmanuel Vadot sc->rx.desc_ring[index].status = htole32(RX_DESC_CTL); 542bd906329SEmmanuel Vadot } 543bd906329SEmmanuel Vadot 544bd906329SEmmanuel Vadot static int 545bd906329SEmmanuel Vadot awg_newbuf_rx(struct awg_softc *sc, int index) 546bd906329SEmmanuel Vadot { 547bd906329SEmmanuel Vadot struct mbuf *m; 548bd906329SEmmanuel Vadot bus_dma_segment_t seg; 549bd906329SEmmanuel Vadot bus_dmamap_t map; 550bd906329SEmmanuel Vadot int nsegs; 551bd906329SEmmanuel Vadot 552bd906329SEmmanuel Vadot m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 553bd906329SEmmanuel Vadot if (m == NULL) 554bd906329SEmmanuel Vadot return (ENOBUFS); 555bd906329SEmmanuel Vadot 556bd906329SEmmanuel Vadot m->m_pkthdr.len = m->m_len = m->m_ext.ext_size; 557d3810ff9SJared McNeill m_adj(m, ETHER_ALIGN); 558d3810ff9SJared McNeill 559bd906329SEmmanuel Vadot if (bus_dmamap_load_mbuf_sg(sc->rx.buf_tag, sc->rx.buf_spare_map, 560bd906329SEmmanuel Vadot m, &seg, &nsegs, BUS_DMA_NOWAIT) != 0) { 561bd906329SEmmanuel Vadot m_freem(m); 562bd906329SEmmanuel Vadot return (ENOBUFS); 563bd906329SEmmanuel Vadot } 564d3810ff9SJared McNeill 565bd906329SEmmanuel Vadot if (sc->rx.buf_map[index].mbuf != NULL) { 566bd906329SEmmanuel Vadot bus_dmamap_sync(sc->rx.buf_tag, sc->rx.buf_map[index].map, 567bd906329SEmmanuel Vadot BUS_DMASYNC_POSTREAD); 568bd906329SEmmanuel Vadot bus_dmamap_unload(sc->rx.buf_tag, sc->rx.buf_map[index].map); 569bd906329SEmmanuel Vadot } 570bd906329SEmmanuel Vadot map = sc->rx.buf_map[index].map; 571bd906329SEmmanuel Vadot sc->rx.buf_map[index].map = sc->rx.buf_spare_map; 572bd906329SEmmanuel Vadot sc->rx.buf_spare_map = map; 573d3810ff9SJared McNeill bus_dmamap_sync(sc->rx.buf_tag, sc->rx.buf_map[index].map, 574d3810ff9SJared McNeill BUS_DMASYNC_PREREAD); 575d3810ff9SJared McNeill 576d3810ff9SJared McNeill sc->rx.buf_map[index].mbuf = m; 577d3810ff9SJared McNeill awg_setup_rxdesc(sc, index, seg.ds_addr); 578d3810ff9SJared McNeill 579d3810ff9SJared McNeill return (0); 580d3810ff9SJared McNeill } 581d3810ff9SJared McNeill 582d3810ff9SJared McNeill static void 583d3810ff9SJared McNeill awg_start_locked(struct awg_softc *sc) 584d3810ff9SJared McNeill { 585d3810ff9SJared McNeill struct mbuf *m; 586d3810ff9SJared McNeill uint32_t val; 587d3810ff9SJared McNeill if_t ifp; 588337c6940SEmmanuel Vadot int cnt, err; 589d3810ff9SJared McNeill 590d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 591d3810ff9SJared McNeill 592d3810ff9SJared McNeill if (!sc->link) 593d3810ff9SJared McNeill return; 594d3810ff9SJared McNeill 595d3810ff9SJared McNeill ifp = sc->ifp; 596d3810ff9SJared McNeill 597d3810ff9SJared McNeill if ((if_getdrvflags(ifp) & (IFF_DRV_RUNNING|IFF_DRV_OACTIVE)) != 598d3810ff9SJared McNeill IFF_DRV_RUNNING) 599d3810ff9SJared McNeill return; 600d3810ff9SJared McNeill 601d3810ff9SJared McNeill for (cnt = 0; ; cnt++) { 602d3810ff9SJared McNeill m = if_dequeue(ifp); 603d3810ff9SJared McNeill if (m == NULL) 604d3810ff9SJared McNeill break; 605d3810ff9SJared McNeill 606337c6940SEmmanuel Vadot err = awg_encap(sc, &m); 607337c6940SEmmanuel Vadot if (err != 0) { 608337c6940SEmmanuel Vadot if (err == ENOBUFS) 609337c6940SEmmanuel Vadot if_setdrvflagbits(ifp, IFF_DRV_OACTIVE, 0); 610337c6940SEmmanuel Vadot if (m != NULL) 611d3810ff9SJared McNeill if_sendq_prepend(ifp, m); 612d3810ff9SJared McNeill break; 613d3810ff9SJared McNeill } 614d3810ff9SJared McNeill if_bpfmtap(ifp, m); 615d3810ff9SJared McNeill } 616d3810ff9SJared McNeill 617d3810ff9SJared McNeill if (cnt != 0) { 618d3810ff9SJared McNeill bus_dmamap_sync(sc->tx.desc_tag, sc->tx.desc_map, 619d3810ff9SJared McNeill BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE); 620d3810ff9SJared McNeill 621d3810ff9SJared McNeill /* Start and run TX DMA */ 622d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_CTL_1); 623d3810ff9SJared McNeill WR4(sc, EMAC_TX_CTL_1, val | TX_DMA_START); 624d3810ff9SJared McNeill } 625d3810ff9SJared McNeill } 626d3810ff9SJared McNeill 627d3810ff9SJared McNeill static void 628d3810ff9SJared McNeill awg_start(if_t ifp) 629d3810ff9SJared McNeill { 630d3810ff9SJared McNeill struct awg_softc *sc; 631d3810ff9SJared McNeill 632d3810ff9SJared McNeill sc = if_getsoftc(ifp); 633d3810ff9SJared McNeill 634d3810ff9SJared McNeill AWG_LOCK(sc); 635d3810ff9SJared McNeill awg_start_locked(sc); 636d3810ff9SJared McNeill AWG_UNLOCK(sc); 637d3810ff9SJared McNeill } 638d3810ff9SJared McNeill 639d3810ff9SJared McNeill static void 640d3810ff9SJared McNeill awg_tick(void *softc) 641d3810ff9SJared McNeill { 642d3810ff9SJared McNeill struct awg_softc *sc; 643d3810ff9SJared McNeill struct mii_data *mii; 644d3810ff9SJared McNeill if_t ifp; 645d3810ff9SJared McNeill int link; 646d3810ff9SJared McNeill 647d3810ff9SJared McNeill sc = softc; 648d3810ff9SJared McNeill ifp = sc->ifp; 649d3810ff9SJared McNeill mii = device_get_softc(sc->miibus); 650d3810ff9SJared McNeill 651d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 652d3810ff9SJared McNeill 653d3810ff9SJared McNeill if ((if_getdrvflags(ifp) & IFF_DRV_RUNNING) == 0) 654d3810ff9SJared McNeill return; 655d3810ff9SJared McNeill 656d3810ff9SJared McNeill link = sc->link; 657d3810ff9SJared McNeill mii_tick(mii); 658d3810ff9SJared McNeill if (sc->link && !link) 659d3810ff9SJared McNeill awg_start_locked(sc); 660d3810ff9SJared McNeill 661d3810ff9SJared McNeill callout_reset(&sc->stat_ch, hz, awg_tick, sc); 662d3810ff9SJared McNeill } 663d3810ff9SJared McNeill 664d3810ff9SJared McNeill /* Bit Reversal - http://aggregate.org/MAGIC/#Bit%20Reversal */ 665d3810ff9SJared McNeill static uint32_t 666d3810ff9SJared McNeill bitrev32(uint32_t x) 667d3810ff9SJared McNeill { 668d3810ff9SJared McNeill x = (((x & 0xaaaaaaaa) >> 1) | ((x & 0x55555555) << 1)); 669d3810ff9SJared McNeill x = (((x & 0xcccccccc) >> 2) | ((x & 0x33333333) << 2)); 670d3810ff9SJared McNeill x = (((x & 0xf0f0f0f0) >> 4) | ((x & 0x0f0f0f0f) << 4)); 671d3810ff9SJared McNeill x = (((x & 0xff00ff00) >> 8) | ((x & 0x00ff00ff) << 8)); 672d3810ff9SJared McNeill 673d3810ff9SJared McNeill return (x >> 16) | (x << 16); 674d3810ff9SJared McNeill } 675d3810ff9SJared McNeill 676d3810ff9SJared McNeill static void 677d3810ff9SJared McNeill awg_setup_rxfilter(struct awg_softc *sc) 678d3810ff9SJared McNeill { 679d3810ff9SJared McNeill uint32_t val, crc, hashreg, hashbit, hash[2], machi, maclo; 680d3810ff9SJared McNeill int mc_count, mcnt, i; 681d3810ff9SJared McNeill uint8_t *eaddr, *mta; 682d3810ff9SJared McNeill if_t ifp; 683d3810ff9SJared McNeill 684d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 685d3810ff9SJared McNeill 686d3810ff9SJared McNeill ifp = sc->ifp; 687d3810ff9SJared McNeill val = 0; 688d3810ff9SJared McNeill hash[0] = hash[1] = 0; 689d3810ff9SJared McNeill 690d3810ff9SJared McNeill mc_count = if_multiaddr_count(ifp, -1); 691d3810ff9SJared McNeill 692d3810ff9SJared McNeill if (if_getflags(ifp) & IFF_PROMISC) 693d3810ff9SJared McNeill val |= DIS_ADDR_FILTER; 694d3810ff9SJared McNeill else if (if_getflags(ifp) & IFF_ALLMULTI) { 695d3810ff9SJared McNeill val |= RX_ALL_MULTICAST; 696d3810ff9SJared McNeill hash[0] = hash[1] = ~0; 697d3810ff9SJared McNeill } else if (mc_count > 0) { 698d3810ff9SJared McNeill val |= HASH_MULTICAST; 699d3810ff9SJared McNeill 700d3810ff9SJared McNeill mta = malloc(sizeof(unsigned char) * ETHER_ADDR_LEN * mc_count, 701d3810ff9SJared McNeill M_DEVBUF, M_NOWAIT); 702d3810ff9SJared McNeill if (mta == NULL) { 703d3810ff9SJared McNeill if_printf(ifp, 704d3810ff9SJared McNeill "failed to allocate temporary multicast list\n"); 705d3810ff9SJared McNeill return; 706d3810ff9SJared McNeill } 707d3810ff9SJared McNeill 708d3810ff9SJared McNeill if_multiaddr_array(ifp, mta, &mcnt, mc_count); 709d3810ff9SJared McNeill for (i = 0; i < mcnt; i++) { 710d3810ff9SJared McNeill crc = ether_crc32_le(mta + (i * ETHER_ADDR_LEN), 711d3810ff9SJared McNeill ETHER_ADDR_LEN) & 0x7f; 712d3810ff9SJared McNeill crc = bitrev32(~crc) >> 26; 713d3810ff9SJared McNeill hashreg = (crc >> 5); 714d3810ff9SJared McNeill hashbit = (crc & 0x1f); 715d3810ff9SJared McNeill hash[hashreg] |= (1 << hashbit); 716d3810ff9SJared McNeill } 717d3810ff9SJared McNeill 718d3810ff9SJared McNeill free(mta, M_DEVBUF); 719d3810ff9SJared McNeill } 720d3810ff9SJared McNeill 721d3810ff9SJared McNeill /* Write our unicast address */ 722d3810ff9SJared McNeill eaddr = IF_LLADDR(ifp); 723d3810ff9SJared McNeill machi = (eaddr[5] << 8) | eaddr[4]; 724d3810ff9SJared McNeill maclo = (eaddr[3] << 24) | (eaddr[2] << 16) | (eaddr[1] << 8) | 725d3810ff9SJared McNeill (eaddr[0] << 0); 726d3810ff9SJared McNeill WR4(sc, EMAC_ADDR_HIGH(0), machi); 727d3810ff9SJared McNeill WR4(sc, EMAC_ADDR_LOW(0), maclo); 728d3810ff9SJared McNeill 729d3810ff9SJared McNeill /* Multicast hash filters */ 730d3810ff9SJared McNeill WR4(sc, EMAC_RX_HASH_0, hash[1]); 731d3810ff9SJared McNeill WR4(sc, EMAC_RX_HASH_1, hash[0]); 732d3810ff9SJared McNeill 733d3810ff9SJared McNeill /* RX frame filter config */ 734d3810ff9SJared McNeill WR4(sc, EMAC_RX_FRM_FLT, val); 735d3810ff9SJared McNeill } 736d3810ff9SJared McNeill 737d3810ff9SJared McNeill static void 73816928528SJared McNeill awg_enable_intr(struct awg_softc *sc) 73916928528SJared McNeill { 74016928528SJared McNeill /* Enable interrupts */ 74116928528SJared McNeill WR4(sc, EMAC_INT_EN, RX_INT_EN | TX_INT_EN | TX_BUF_UA_INT_EN); 74216928528SJared McNeill } 74316928528SJared McNeill 74416928528SJared McNeill static void 74516928528SJared McNeill awg_disable_intr(struct awg_softc *sc) 74616928528SJared McNeill { 74716928528SJared McNeill /* Disable interrupts */ 74816928528SJared McNeill WR4(sc, EMAC_INT_EN, 0); 74916928528SJared McNeill } 75016928528SJared McNeill 75116928528SJared McNeill static void 752d3810ff9SJared McNeill awg_init_locked(struct awg_softc *sc) 753d3810ff9SJared McNeill { 754d3810ff9SJared McNeill struct mii_data *mii; 755d3810ff9SJared McNeill uint32_t val; 756d3810ff9SJared McNeill if_t ifp; 757d3810ff9SJared McNeill 758d3810ff9SJared McNeill mii = device_get_softc(sc->miibus); 759d3810ff9SJared McNeill ifp = sc->ifp; 760d3810ff9SJared McNeill 761d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 762d3810ff9SJared McNeill 763d3810ff9SJared McNeill if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) 764d3810ff9SJared McNeill return; 765d3810ff9SJared McNeill 766d3810ff9SJared McNeill awg_setup_rxfilter(sc); 767d3810ff9SJared McNeill 768d3810ff9SJared McNeill /* Configure DMA burst length and priorities */ 769d3810ff9SJared McNeill val = awg_burst_len << BASIC_CTL_BURST_LEN_SHIFT; 770d3810ff9SJared McNeill if (awg_rx_tx_pri) 771d3810ff9SJared McNeill val |= BASIC_CTL_RX_TX_PRI; 772d3810ff9SJared McNeill WR4(sc, EMAC_BASIC_CTL_1, val); 773d3810ff9SJared McNeill 774d3810ff9SJared McNeill /* Enable interrupts */ 77516928528SJared McNeill #ifdef DEVICE_POLLING 77616928528SJared McNeill if ((if_getcapenable(ifp) & IFCAP_POLLING) == 0) 77716928528SJared McNeill awg_enable_intr(sc); 77816928528SJared McNeill else 77916928528SJared McNeill awg_disable_intr(sc); 78016928528SJared McNeill #else 78116928528SJared McNeill awg_enable_intr(sc); 78216928528SJared McNeill #endif 783d3810ff9SJared McNeill 784d3810ff9SJared McNeill /* Enable transmit DMA */ 785d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_CTL_1); 78616928528SJared McNeill WR4(sc, EMAC_TX_CTL_1, val | TX_DMA_EN | TX_MD | TX_NEXT_FRAME); 787d3810ff9SJared McNeill 788d3810ff9SJared McNeill /* Enable receive DMA */ 789d3810ff9SJared McNeill val = RD4(sc, EMAC_RX_CTL_1); 790d3810ff9SJared McNeill WR4(sc, EMAC_RX_CTL_1, val | RX_DMA_EN | RX_MD); 791d3810ff9SJared McNeill 792d3810ff9SJared McNeill /* Enable transmitter */ 793d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_CTL_0); 794d3810ff9SJared McNeill WR4(sc, EMAC_TX_CTL_0, val | TX_EN); 795d3810ff9SJared McNeill 796d3810ff9SJared McNeill /* Enable receiver */ 797d3810ff9SJared McNeill val = RD4(sc, EMAC_RX_CTL_0); 798d3810ff9SJared McNeill WR4(sc, EMAC_RX_CTL_0, val | RX_EN | CHECK_CRC); 799d3810ff9SJared McNeill 800d3810ff9SJared McNeill if_setdrvflagbits(ifp, IFF_DRV_RUNNING, IFF_DRV_OACTIVE); 801d3810ff9SJared McNeill 802d3810ff9SJared McNeill mii_mediachg(mii); 803d3810ff9SJared McNeill callout_reset(&sc->stat_ch, hz, awg_tick, sc); 804d3810ff9SJared McNeill } 805d3810ff9SJared McNeill 806d3810ff9SJared McNeill static void 807d3810ff9SJared McNeill awg_init(void *softc) 808d3810ff9SJared McNeill { 809d3810ff9SJared McNeill struct awg_softc *sc; 810d3810ff9SJared McNeill 811d3810ff9SJared McNeill sc = softc; 812d3810ff9SJared McNeill 813d3810ff9SJared McNeill AWG_LOCK(sc); 814d3810ff9SJared McNeill awg_init_locked(sc); 815d3810ff9SJared McNeill AWG_UNLOCK(sc); 816d3810ff9SJared McNeill } 817d3810ff9SJared McNeill 818d3810ff9SJared McNeill static void 819d3810ff9SJared McNeill awg_stop(struct awg_softc *sc) 820d3810ff9SJared McNeill { 821d3810ff9SJared McNeill if_t ifp; 822d3810ff9SJared McNeill uint32_t val; 8233f9ade06SEmmanuel Vadot int i; 824d3810ff9SJared McNeill 825d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 826d3810ff9SJared McNeill 827d3810ff9SJared McNeill ifp = sc->ifp; 828d3810ff9SJared McNeill 829d3810ff9SJared McNeill callout_stop(&sc->stat_ch); 830d3810ff9SJared McNeill 831d3810ff9SJared McNeill /* Stop transmit DMA and flush data in the TX FIFO */ 832d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_CTL_1); 833d3810ff9SJared McNeill val &= ~TX_DMA_EN; 834d3810ff9SJared McNeill val |= FLUSH_TX_FIFO; 835d3810ff9SJared McNeill WR4(sc, EMAC_TX_CTL_1, val); 836d3810ff9SJared McNeill 837d3810ff9SJared McNeill /* Disable transmitter */ 838d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_CTL_0); 839d3810ff9SJared McNeill WR4(sc, EMAC_TX_CTL_0, val & ~TX_EN); 840d3810ff9SJared McNeill 841d3810ff9SJared McNeill /* Disable receiver */ 842d3810ff9SJared McNeill val = RD4(sc, EMAC_RX_CTL_0); 843d3810ff9SJared McNeill WR4(sc, EMAC_RX_CTL_0, val & ~RX_EN); 844d3810ff9SJared McNeill 845d3810ff9SJared McNeill /* Disable interrupts */ 84616928528SJared McNeill awg_disable_intr(sc); 847d3810ff9SJared McNeill 848d3810ff9SJared McNeill /* Disable transmit DMA */ 849d3810ff9SJared McNeill val = RD4(sc, EMAC_TX_CTL_1); 850d3810ff9SJared McNeill WR4(sc, EMAC_TX_CTL_1, val & ~TX_DMA_EN); 851d3810ff9SJared McNeill 852d3810ff9SJared McNeill /* Disable receive DMA */ 853d3810ff9SJared McNeill val = RD4(sc, EMAC_RX_CTL_1); 854d3810ff9SJared McNeill WR4(sc, EMAC_RX_CTL_1, val & ~RX_DMA_EN); 855d3810ff9SJared McNeill 856d3810ff9SJared McNeill sc->link = 0; 857d3810ff9SJared McNeill 8583f9ade06SEmmanuel Vadot /* Finish handling transmitted buffers */ 8593f9ade06SEmmanuel Vadot awg_txeof(sc); 8603f9ade06SEmmanuel Vadot 8613f9ade06SEmmanuel Vadot /* Release any untransmitted buffers. */ 8623f9ade06SEmmanuel Vadot for (i = sc->tx.next; sc->tx.queued > 0; i = TX_NEXT(i)) { 8633f9ade06SEmmanuel Vadot val = le32toh(sc->tx.desc_ring[i].status); 8643f9ade06SEmmanuel Vadot if ((val & TX_DESC_CTL) != 0) 8653f9ade06SEmmanuel Vadot break; 8663f9ade06SEmmanuel Vadot awg_clean_txbuf(sc, i); 8673f9ade06SEmmanuel Vadot } 8683f9ade06SEmmanuel Vadot sc->tx.next = i; 8693f9ade06SEmmanuel Vadot for (; sc->tx.queued > 0; i = TX_NEXT(i)) { 8703f9ade06SEmmanuel Vadot sc->tx.desc_ring[i].status = 0; 8713f9ade06SEmmanuel Vadot awg_clean_txbuf(sc, i); 8723f9ade06SEmmanuel Vadot } 8733f9ade06SEmmanuel Vadot sc->tx.cur = sc->tx.next; 8743f9ade06SEmmanuel Vadot bus_dmamap_sync(sc->tx.desc_tag, sc->tx.desc_map, 8753f9ade06SEmmanuel Vadot BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 8763f9ade06SEmmanuel Vadot 8773f9ade06SEmmanuel Vadot /* Setup RX buffers for reuse */ 8783f9ade06SEmmanuel Vadot bus_dmamap_sync(sc->rx.desc_tag, sc->rx.desc_map, 8793f9ade06SEmmanuel Vadot BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 8803f9ade06SEmmanuel Vadot 8813f9ade06SEmmanuel Vadot for (i = sc->rx.cur; ; i = RX_NEXT(i)) { 8823f9ade06SEmmanuel Vadot val = le32toh(sc->rx.desc_ring[i].status); 8833f9ade06SEmmanuel Vadot if ((val & RX_DESC_CTL) != 0) 8843f9ade06SEmmanuel Vadot break; 8853f9ade06SEmmanuel Vadot awg_reuse_rxdesc(sc, i); 8863f9ade06SEmmanuel Vadot } 8873f9ade06SEmmanuel Vadot sc->rx.cur = i; 8883f9ade06SEmmanuel Vadot bus_dmamap_sync(sc->rx.desc_tag, sc->rx.desc_map, 8893f9ade06SEmmanuel Vadot BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 8903f9ade06SEmmanuel Vadot 891d3810ff9SJared McNeill if_setdrvflagbits(ifp, 0, IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 892d3810ff9SJared McNeill } 893d3810ff9SJared McNeill 89416928528SJared McNeill static int 895d3810ff9SJared McNeill awg_rxintr(struct awg_softc *sc) 896d3810ff9SJared McNeill { 897d3810ff9SJared McNeill if_t ifp; 898bd906329SEmmanuel Vadot struct mbuf *m, *mh, *mt; 89916928528SJared McNeill int error, index, len, cnt, npkt; 900d3810ff9SJared McNeill uint32_t status; 901d3810ff9SJared McNeill 902d3810ff9SJared McNeill ifp = sc->ifp; 90316928528SJared McNeill mh = mt = NULL; 90416928528SJared McNeill cnt = 0; 90516928528SJared McNeill npkt = 0; 906d3810ff9SJared McNeill 907d3810ff9SJared McNeill bus_dmamap_sync(sc->rx.desc_tag, sc->rx.desc_map, 908d3810ff9SJared McNeill BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 909d3810ff9SJared McNeill 910d3810ff9SJared McNeill for (index = sc->rx.cur; ; index = RX_NEXT(index)) { 911d3810ff9SJared McNeill status = le32toh(sc->rx.desc_ring[index].status); 912d3810ff9SJared McNeill if ((status & RX_DESC_CTL) != 0) 913d3810ff9SJared McNeill break; 914d3810ff9SJared McNeill 915d3810ff9SJared McNeill len = (status & RX_FRM_LEN) >> RX_FRM_LEN_SHIFT; 916bd906329SEmmanuel Vadot 917bd906329SEmmanuel Vadot if (len == 0) { 918bd906329SEmmanuel Vadot if ((status & (RX_NO_ENOUGH_BUF_ERR | RX_OVERFLOW_ERR)) != 0) 919bd906329SEmmanuel Vadot if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 920bd906329SEmmanuel Vadot awg_reuse_rxdesc(sc, index); 921bd906329SEmmanuel Vadot continue; 922bd906329SEmmanuel Vadot } 923bd906329SEmmanuel Vadot 924d3810ff9SJared McNeill m = sc->rx.buf_map[index].mbuf; 925bd906329SEmmanuel Vadot 926bd906329SEmmanuel Vadot error = awg_newbuf_rx(sc, index); 927bd906329SEmmanuel Vadot if (error != 0) { 928bd906329SEmmanuel Vadot if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1); 929bd906329SEmmanuel Vadot awg_reuse_rxdesc(sc, index); 930bd906329SEmmanuel Vadot continue; 931bd906329SEmmanuel Vadot } 932bd906329SEmmanuel Vadot 933d3810ff9SJared McNeill m->m_pkthdr.rcvif = ifp; 934d3810ff9SJared McNeill m->m_pkthdr.len = len; 935d3810ff9SJared McNeill m->m_len = len; 936d3810ff9SJared McNeill if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1); 937d3810ff9SJared McNeill 938d3810ff9SJared McNeill if ((if_getcapenable(ifp) & IFCAP_RXCSUM) != 0 && 939d3810ff9SJared McNeill (status & RX_FRM_TYPE) != 0) { 940d3810ff9SJared McNeill m->m_pkthdr.csum_flags = CSUM_IP_CHECKED; 941d3810ff9SJared McNeill if ((status & RX_HEADER_ERR) == 0) 942d3810ff9SJared McNeill m->m_pkthdr.csum_flags |= CSUM_IP_VALID; 943d3810ff9SJared McNeill if ((status & RX_PAYLOAD_ERR) == 0) { 944d3810ff9SJared McNeill m->m_pkthdr.csum_flags |= 945d3810ff9SJared McNeill CSUM_DATA_VALID | CSUM_PSEUDO_HDR; 946d3810ff9SJared McNeill m->m_pkthdr.csum_data = 0xffff; 947d3810ff9SJared McNeill } 948d3810ff9SJared McNeill } 949d3810ff9SJared McNeill 95016928528SJared McNeill m->m_nextpkt = NULL; 95116928528SJared McNeill if (mh == NULL) 95216928528SJared McNeill mh = m; 95316928528SJared McNeill else 95416928528SJared McNeill mt->m_nextpkt = m; 95516928528SJared McNeill mt = m; 95616928528SJared McNeill ++cnt; 95716928528SJared McNeill ++npkt; 95816928528SJared McNeill 95916928528SJared McNeill if (cnt == awg_rx_batch) { 960d3810ff9SJared McNeill AWG_UNLOCK(sc); 96116928528SJared McNeill if_input(ifp, mh); 962d3810ff9SJared McNeill AWG_LOCK(sc); 96316928528SJared McNeill mh = mt = NULL; 96416928528SJared McNeill cnt = 0; 96516928528SJared McNeill } 966d3810ff9SJared McNeill } 967d3810ff9SJared McNeill 968d3810ff9SJared McNeill if (index != sc->rx.cur) { 969d3810ff9SJared McNeill bus_dmamap_sync(sc->rx.desc_tag, sc->rx.desc_map, 970bd906329SEmmanuel Vadot BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 971d3810ff9SJared McNeill } 972d3810ff9SJared McNeill 97316928528SJared McNeill if (mh != NULL) { 97416928528SJared McNeill AWG_UNLOCK(sc); 97516928528SJared McNeill if_input(ifp, mh); 97616928528SJared McNeill AWG_LOCK(sc); 97716928528SJared McNeill } 97816928528SJared McNeill 979d3810ff9SJared McNeill sc->rx.cur = index; 98016928528SJared McNeill 98116928528SJared McNeill return (npkt); 982d3810ff9SJared McNeill } 983d3810ff9SJared McNeill 984d3810ff9SJared McNeill static void 985337c6940SEmmanuel Vadot awg_txeof(struct awg_softc *sc) 986d3810ff9SJared McNeill { 987d3810ff9SJared McNeill struct emac_desc *desc; 98809e2285cSEmmanuel Vadot uint32_t status, size; 989d3810ff9SJared McNeill if_t ifp; 990f179ed05SEmmanuel Vadot int i, prog; 991d3810ff9SJared McNeill 992d3810ff9SJared McNeill AWG_ASSERT_LOCKED(sc); 993d3810ff9SJared McNeill 994d3810ff9SJared McNeill bus_dmamap_sync(sc->tx.desc_tag, sc->tx.desc_map, 995d3810ff9SJared McNeill BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 996d3810ff9SJared McNeill 997d3810ff9SJared McNeill ifp = sc->ifp; 998f179ed05SEmmanuel Vadot 999f179ed05SEmmanuel Vadot prog = 0; 1000d3810ff9SJared McNeill for (i = sc->tx.next; sc->tx.queued > 0; i = TX_NEXT(i)) { 1001d3810ff9SJared McNeill desc = &sc->tx.desc_ring[i]; 1002d3810ff9SJared McNeill status = le32toh(desc->status); 1003d3810ff9SJared McNeill if ((status & TX_DESC_CTL) != 0) 1004d3810ff9SJared McNeill break; 100509e2285cSEmmanuel Vadot size = le32toh(desc->size); 100609e2285cSEmmanuel Vadot if (size & TX_LAST_DESC) { 100709e2285cSEmmanuel Vadot if ((status & (TX_HEADER_ERR | TX_PAYLOAD_ERR)) != 0) 100809e2285cSEmmanuel Vadot if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 100909e2285cSEmmanuel Vadot else 101009e2285cSEmmanuel Vadot if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 101109e2285cSEmmanuel Vadot } 1012f179ed05SEmmanuel Vadot prog++; 1013c6110e75SEmmanuel Vadot awg_clean_txbuf(sc, i); 1014d3810ff9SJared McNeill } 1015d3810ff9SJared McNeill 1016f179ed05SEmmanuel Vadot if (prog > 0) { 1017d3810ff9SJared McNeill sc->tx.next = i; 1018f179ed05SEmmanuel Vadot if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE); 1019f179ed05SEmmanuel Vadot } 1020d3810ff9SJared McNeill } 1021d3810ff9SJared McNeill 1022d3810ff9SJared McNeill static void 1023d3810ff9SJared McNeill awg_intr(void *arg) 1024d3810ff9SJared McNeill { 1025d3810ff9SJared McNeill struct awg_softc *sc; 1026d3810ff9SJared McNeill uint32_t val; 1027d3810ff9SJared McNeill 1028d3810ff9SJared McNeill sc = arg; 1029d3810ff9SJared McNeill 1030d3810ff9SJared McNeill AWG_LOCK(sc); 1031d3810ff9SJared McNeill val = RD4(sc, EMAC_INT_STA); 1032d3810ff9SJared McNeill WR4(sc, EMAC_INT_STA, val); 1033d3810ff9SJared McNeill 1034d3810ff9SJared McNeill if (val & RX_INT) 1035d3810ff9SJared McNeill awg_rxintr(sc); 1036d3810ff9SJared McNeill 10370d2abe1eSEmmanuel Vadot if (val & TX_INT) 1038337c6940SEmmanuel Vadot awg_txeof(sc); 10390d2abe1eSEmmanuel Vadot 10400d2abe1eSEmmanuel Vadot if (val & (TX_INT | TX_BUF_UA_INT)) { 1041d3810ff9SJared McNeill if (!if_sendq_empty(sc->ifp)) 1042d3810ff9SJared McNeill awg_start_locked(sc); 1043d3810ff9SJared McNeill } 1044d3810ff9SJared McNeill 1045d3810ff9SJared McNeill AWG_UNLOCK(sc); 1046d3810ff9SJared McNeill } 1047d3810ff9SJared McNeill 104816928528SJared McNeill #ifdef DEVICE_POLLING 104916928528SJared McNeill static int 105016928528SJared McNeill awg_poll(if_t ifp, enum poll_cmd cmd, int count) 105116928528SJared McNeill { 105216928528SJared McNeill struct awg_softc *sc; 105316928528SJared McNeill uint32_t val; 105416928528SJared McNeill int rx_npkts; 105516928528SJared McNeill 105616928528SJared McNeill sc = if_getsoftc(ifp); 105716928528SJared McNeill rx_npkts = 0; 105816928528SJared McNeill 105916928528SJared McNeill AWG_LOCK(sc); 106016928528SJared McNeill 106116928528SJared McNeill if ((if_getdrvflags(ifp) & IFF_DRV_RUNNING) == 0) { 106216928528SJared McNeill AWG_UNLOCK(sc); 106316928528SJared McNeill return (0); 106416928528SJared McNeill } 106516928528SJared McNeill 106616928528SJared McNeill rx_npkts = awg_rxintr(sc); 1067337c6940SEmmanuel Vadot awg_txeof(sc); 106816928528SJared McNeill if (!if_sendq_empty(ifp)) 106916928528SJared McNeill awg_start_locked(sc); 107016928528SJared McNeill 107116928528SJared McNeill if (cmd == POLL_AND_CHECK_STATUS) { 107216928528SJared McNeill val = RD4(sc, EMAC_INT_STA); 107316928528SJared McNeill if (val != 0) 107416928528SJared McNeill WR4(sc, EMAC_INT_STA, val); 107516928528SJared McNeill } 107616928528SJared McNeill 107716928528SJared McNeill AWG_UNLOCK(sc); 107816928528SJared McNeill 107916928528SJared McNeill return (rx_npkts); 108016928528SJared McNeill } 108116928528SJared McNeill #endif 108216928528SJared McNeill 1083d3810ff9SJared McNeill static int 1084d3810ff9SJared McNeill awg_ioctl(if_t ifp, u_long cmd, caddr_t data) 1085d3810ff9SJared McNeill { 1086d3810ff9SJared McNeill struct awg_softc *sc; 1087d3810ff9SJared McNeill struct mii_data *mii; 1088d3810ff9SJared McNeill struct ifreq *ifr; 1089d3810ff9SJared McNeill int flags, mask, error; 1090d3810ff9SJared McNeill 1091d3810ff9SJared McNeill sc = if_getsoftc(ifp); 1092d3810ff9SJared McNeill mii = device_get_softc(sc->miibus); 1093d3810ff9SJared McNeill ifr = (struct ifreq *)data; 1094d3810ff9SJared McNeill error = 0; 1095d3810ff9SJared McNeill 1096d3810ff9SJared McNeill switch (cmd) { 1097d3810ff9SJared McNeill case SIOCSIFFLAGS: 1098d3810ff9SJared McNeill AWG_LOCK(sc); 1099d3810ff9SJared McNeill if (if_getflags(ifp) & IFF_UP) { 1100d3810ff9SJared McNeill if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) { 1101d3810ff9SJared McNeill flags = if_getflags(ifp) ^ sc->if_flags; 1102d3810ff9SJared McNeill if ((flags & (IFF_PROMISC|IFF_ALLMULTI)) != 0) 1103d3810ff9SJared McNeill awg_setup_rxfilter(sc); 1104d3810ff9SJared McNeill } else 1105d3810ff9SJared McNeill awg_init_locked(sc); 1106d3810ff9SJared McNeill } else { 1107d3810ff9SJared McNeill if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) 1108d3810ff9SJared McNeill awg_stop(sc); 1109d3810ff9SJared McNeill } 1110d3810ff9SJared McNeill sc->if_flags = if_getflags(ifp); 1111d3810ff9SJared McNeill AWG_UNLOCK(sc); 1112d3810ff9SJared McNeill break; 1113d3810ff9SJared McNeill case SIOCADDMULTI: 1114d3810ff9SJared McNeill case SIOCDELMULTI: 1115d3810ff9SJared McNeill if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) { 1116d3810ff9SJared McNeill AWG_LOCK(sc); 1117d3810ff9SJared McNeill awg_setup_rxfilter(sc); 1118d3810ff9SJared McNeill AWG_UNLOCK(sc); 1119d3810ff9SJared McNeill } 1120d3810ff9SJared McNeill break; 1121d3810ff9SJared McNeill case SIOCSIFMEDIA: 1122d3810ff9SJared McNeill case SIOCGIFMEDIA: 1123d3810ff9SJared McNeill error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, cmd); 1124d3810ff9SJared McNeill break; 1125d3810ff9SJared McNeill case SIOCSIFCAP: 1126d3810ff9SJared McNeill mask = ifr->ifr_reqcap ^ if_getcapenable(ifp); 112716928528SJared McNeill #ifdef DEVICE_POLLING 112816928528SJared McNeill if (mask & IFCAP_POLLING) { 112916928528SJared McNeill if ((ifr->ifr_reqcap & IFCAP_POLLING) != 0) { 113016928528SJared McNeill error = ether_poll_register(awg_poll, ifp); 113116928528SJared McNeill if (error != 0) 113216928528SJared McNeill break; 113316928528SJared McNeill AWG_LOCK(sc); 113416928528SJared McNeill awg_disable_intr(sc); 113516928528SJared McNeill if_setcapenablebit(ifp, IFCAP_POLLING, 0); 113616928528SJared McNeill AWG_UNLOCK(sc); 113716928528SJared McNeill } else { 113816928528SJared McNeill error = ether_poll_deregister(ifp); 113916928528SJared McNeill AWG_LOCK(sc); 114016928528SJared McNeill awg_enable_intr(sc); 114116928528SJared McNeill if_setcapenablebit(ifp, 0, IFCAP_POLLING); 114216928528SJared McNeill AWG_UNLOCK(sc); 114316928528SJared McNeill } 114416928528SJared McNeill } 114516928528SJared McNeill #endif 1146d3810ff9SJared McNeill if (mask & IFCAP_VLAN_MTU) 1147d3810ff9SJared McNeill if_togglecapenable(ifp, IFCAP_VLAN_MTU); 1148d3810ff9SJared McNeill if (mask & IFCAP_RXCSUM) 1149d3810ff9SJared McNeill if_togglecapenable(ifp, IFCAP_RXCSUM); 1150d3810ff9SJared McNeill if (mask & IFCAP_TXCSUM) 1151d3810ff9SJared McNeill if_togglecapenable(ifp, IFCAP_TXCSUM); 11522a811fc0SJared McNeill if ((if_getcapenable(ifp) & IFCAP_TXCSUM) != 0) 11532a811fc0SJared McNeill if_sethwassistbits(ifp, CSUM_IP | CSUM_UDP | CSUM_TCP, 0); 1154d3810ff9SJared McNeill else 11552a811fc0SJared McNeill if_sethwassistbits(ifp, 0, CSUM_IP | CSUM_UDP | CSUM_TCP); 1156d3810ff9SJared McNeill break; 1157d3810ff9SJared McNeill default: 1158d3810ff9SJared McNeill error = ether_ioctl(ifp, cmd, data); 1159d3810ff9SJared McNeill break; 1160d3810ff9SJared McNeill } 1161d3810ff9SJared McNeill 1162d3810ff9SJared McNeill return (error); 1163d3810ff9SJared McNeill } 1164d3810ff9SJared McNeill 11652defb358SKyle Evans static uint32_t 11662defb358SKyle Evans syscon_read_emac_clk_reg(device_t dev) 11672defb358SKyle Evans { 11682defb358SKyle Evans struct awg_softc *sc; 11692defb358SKyle Evans 11702defb358SKyle Evans sc = device_get_softc(dev); 11712defb358SKyle Evans if (sc->syscon != NULL) 11722defb358SKyle Evans return (SYSCON_READ_4(sc->syscon, EMAC_CLK_REG)); 11732defb358SKyle Evans else if (sc->res[_RES_SYSCON] != NULL) 11742defb358SKyle Evans return (bus_read_4(sc->res[_RES_SYSCON], 0)); 11752defb358SKyle Evans 11762defb358SKyle Evans return (0); 11772defb358SKyle Evans } 11782defb358SKyle Evans 11792defb358SKyle Evans static void 11802defb358SKyle Evans syscon_write_emac_clk_reg(device_t dev, uint32_t val) 11812defb358SKyle Evans { 11822defb358SKyle Evans struct awg_softc *sc; 11832defb358SKyle Evans 11842defb358SKyle Evans sc = device_get_softc(dev); 11852defb358SKyle Evans if (sc->syscon != NULL) 11862defb358SKyle Evans SYSCON_WRITE_4(sc->syscon, EMAC_CLK_REG, val); 11872defb358SKyle Evans else if (sc->res[_RES_SYSCON] != NULL) 11882defb358SKyle Evans bus_write_4(sc->res[_RES_SYSCON], 0, val); 11892defb358SKyle Evans } 11902defb358SKyle Evans 1191767754e5SKyle Evans static phandle_t 1192767754e5SKyle Evans awg_get_phy_node(device_t dev) 1193767754e5SKyle Evans { 1194767754e5SKyle Evans phandle_t node; 1195767754e5SKyle Evans pcell_t phy_handle; 1196767754e5SKyle Evans 1197767754e5SKyle Evans node = ofw_bus_get_node(dev); 1198767754e5SKyle Evans if (OF_getencprop(node, "phy-handle", (void *)&phy_handle, 1199767754e5SKyle Evans sizeof(phy_handle)) <= 0) 1200767754e5SKyle Evans return (0); 1201767754e5SKyle Evans 1202767754e5SKyle Evans return (OF_node_from_xref(phy_handle)); 1203767754e5SKyle Evans } 1204767754e5SKyle Evans 1205767754e5SKyle Evans static bool 1206767754e5SKyle Evans awg_has_internal_phy(device_t dev) 1207767754e5SKyle Evans { 1208767754e5SKyle Evans phandle_t node, phy_node; 1209767754e5SKyle Evans 1210767754e5SKyle Evans node = ofw_bus_get_node(dev); 1211767754e5SKyle Evans /* Legacy binding */ 1212767754e5SKyle Evans if (OF_hasprop(node, "allwinner,use-internal-phy")) 1213767754e5SKyle Evans return (true); 1214767754e5SKyle Evans 1215767754e5SKyle Evans phy_node = awg_get_phy_node(dev); 1216767754e5SKyle Evans return (phy_node != 0 && ofw_bus_node_is_compatible(OF_parent(phy_node), 1217767754e5SKyle Evans "allwinner,sun8i-h3-mdio-internal") != 0); 1218767754e5SKyle Evans } 1219767754e5SKyle Evans 1220d3810ff9SJared McNeill static int 122101a469b8SJared McNeill awg_setup_phy(device_t dev) 1222d3810ff9SJared McNeill { 1223d3810ff9SJared McNeill struct awg_softc *sc; 122401a469b8SJared McNeill clk_t clk_tx, clk_tx_parent; 1225d3810ff9SJared McNeill const char *tx_parent_name; 1226d3810ff9SJared McNeill char *phy_type; 1227d3810ff9SJared McNeill phandle_t node; 122801a469b8SJared McNeill uint32_t reg, tx_delay, rx_delay; 122901a469b8SJared McNeill int error; 12302defb358SKyle Evans bool use_syscon; 1231d3810ff9SJared McNeill 1232d3810ff9SJared McNeill sc = device_get_softc(dev); 1233d3810ff9SJared McNeill node = ofw_bus_get_node(dev); 12342defb358SKyle Evans use_syscon = false; 1235d3810ff9SJared McNeill 1236*217d17bcSOleksandr Tymoshenko if (OF_getprop_alloc(node, "phy-mode", (void **)&phy_type) == 0) 123701a469b8SJared McNeill return (0); 1238d3810ff9SJared McNeill 12392defb358SKyle Evans if (sc->syscon != NULL || sc->res[_RES_SYSCON] != NULL) 12402defb358SKyle Evans use_syscon = true; 12412defb358SKyle Evans 1242d3810ff9SJared McNeill if (bootverbose) 124301a469b8SJared McNeill device_printf(dev, "PHY type: %s, conf mode: %s\n", phy_type, 12442defb358SKyle Evans use_syscon ? "reg" : "clk"); 1245d3810ff9SJared McNeill 12462defb358SKyle Evans if (use_syscon) { 12472defb358SKyle Evans /* 12482defb358SKyle Evans * Abstract away writing to syscon for devices like the pine64. 12492defb358SKyle Evans * For the pine64, we get dtb from U-Boot and it still uses the 12502defb358SKyle Evans * legacy setup of specifying syscon register in emac node 12512defb358SKyle Evans * rather than as its own node and using an xref in emac. 12522defb358SKyle Evans * These abstractions can go away once U-Boot dts is up-to-date. 12532defb358SKyle Evans */ 12542defb358SKyle Evans reg = syscon_read_emac_clk_reg(dev); 125501a469b8SJared McNeill reg &= ~(EMAC_CLK_PIT | EMAC_CLK_SRC | EMAC_CLK_RMII_EN); 1256858f2466SKyle Evans if (strncmp(phy_type, "rgmii", 5) == 0) 125701a469b8SJared McNeill reg |= EMAC_CLK_PIT_RGMII | EMAC_CLK_SRC_RGMII; 125801a469b8SJared McNeill else if (strcmp(phy_type, "rmii") == 0) 125901a469b8SJared McNeill reg |= EMAC_CLK_RMII_EN; 126001a469b8SJared McNeill else 126101a469b8SJared McNeill reg |= EMAC_CLK_PIT_MII | EMAC_CLK_SRC_MII; 126201a469b8SJared McNeill 126301a469b8SJared McNeill if (OF_getencprop(node, "tx-delay", &tx_delay, 126401a469b8SJared McNeill sizeof(tx_delay)) > 0) { 126501a469b8SJared McNeill reg &= ~EMAC_CLK_ETXDC; 126601a469b8SJared McNeill reg |= (tx_delay << EMAC_CLK_ETXDC_SHIFT); 126701a469b8SJared McNeill } 126801a469b8SJared McNeill if (OF_getencprop(node, "rx-delay", &rx_delay, 126901a469b8SJared McNeill sizeof(rx_delay)) > 0) { 127001a469b8SJared McNeill reg &= ~EMAC_CLK_ERXDC; 127101a469b8SJared McNeill reg |= (rx_delay << EMAC_CLK_ERXDC_SHIFT); 127201a469b8SJared McNeill } 127301a469b8SJared McNeill 127401a469b8SJared McNeill if (sc->type == EMAC_H3) { 1275767754e5SKyle Evans if (awg_has_internal_phy(dev)) { 127601a469b8SJared McNeill reg |= EMAC_CLK_EPHY_SELECT; 127701a469b8SJared McNeill reg &= ~EMAC_CLK_EPHY_SHUTDOWN; 127801a469b8SJared McNeill if (OF_hasprop(node, 127901a469b8SJared McNeill "allwinner,leds-active-low")) 128001a469b8SJared McNeill reg |= EMAC_CLK_EPHY_LED_POL; 128101a469b8SJared McNeill else 128201a469b8SJared McNeill reg &= ~EMAC_CLK_EPHY_LED_POL; 128301a469b8SJared McNeill 128401a469b8SJared McNeill /* Set internal PHY addr to 1 */ 128501a469b8SJared McNeill reg &= ~EMAC_CLK_EPHY_ADDR; 128601a469b8SJared McNeill reg |= (1 << EMAC_CLK_EPHY_ADDR_SHIFT); 128701a469b8SJared McNeill } else { 128801a469b8SJared McNeill reg &= ~EMAC_CLK_EPHY_SELECT; 128901a469b8SJared McNeill } 129001a469b8SJared McNeill } 129101a469b8SJared McNeill 129201a469b8SJared McNeill if (bootverbose) 129301a469b8SJared McNeill device_printf(dev, "EMAC clock: 0x%08x\n", reg); 12942defb358SKyle Evans syscon_write_emac_clk_reg(dev, reg); 129501a469b8SJared McNeill } else { 1296858f2466SKyle Evans if (strncmp(phy_type, "rgmii", 5) == 0) 1297d3810ff9SJared McNeill tx_parent_name = "emac_int_tx"; 1298d3810ff9SJared McNeill else 1299d3810ff9SJared McNeill tx_parent_name = "mii_phy_tx"; 1300d3810ff9SJared McNeill 1301d3810ff9SJared McNeill /* Get the TX clock */ 1302dac93553SMichal Meloun error = clk_get_by_ofw_name(dev, 0, "tx", &clk_tx); 1303d3810ff9SJared McNeill if (error != 0) { 1304d3810ff9SJared McNeill device_printf(dev, "cannot get tx clock\n"); 1305d3810ff9SJared McNeill goto fail; 1306d3810ff9SJared McNeill } 1307d3810ff9SJared McNeill 1308d3810ff9SJared McNeill /* Find the desired parent clock based on phy-mode property */ 1309d3810ff9SJared McNeill error = clk_get_by_name(dev, tx_parent_name, &clk_tx_parent); 1310d3810ff9SJared McNeill if (error != 0) { 1311d3810ff9SJared McNeill device_printf(dev, "cannot get clock '%s'\n", 1312d3810ff9SJared McNeill tx_parent_name); 1313d3810ff9SJared McNeill goto fail; 1314d3810ff9SJared McNeill } 1315d3810ff9SJared McNeill 1316d3810ff9SJared McNeill /* Set TX clock parent */ 1317d3810ff9SJared McNeill error = clk_set_parent_by_clk(clk_tx, clk_tx_parent); 1318d3810ff9SJared McNeill if (error != 0) { 1319d3810ff9SJared McNeill device_printf(dev, "cannot set tx clock parent\n"); 1320d3810ff9SJared McNeill goto fail; 1321d3810ff9SJared McNeill } 1322d3810ff9SJared McNeill 1323d3810ff9SJared McNeill /* Enable TX clock */ 1324d3810ff9SJared McNeill error = clk_enable(clk_tx); 1325d3810ff9SJared McNeill if (error != 0) { 1326d3810ff9SJared McNeill device_printf(dev, "cannot enable tx clock\n"); 1327d3810ff9SJared McNeill goto fail; 1328d3810ff9SJared McNeill } 1329d3810ff9SJared McNeill } 1330d3810ff9SJared McNeill 133101a469b8SJared McNeill error = 0; 133201a469b8SJared McNeill 133301a469b8SJared McNeill fail: 133401a469b8SJared McNeill OF_prop_free(phy_type); 133501a469b8SJared McNeill return (error); 133601a469b8SJared McNeill } 133701a469b8SJared McNeill 133801a469b8SJared McNeill static int 133901a469b8SJared McNeill awg_setup_extres(device_t dev) 134001a469b8SJared McNeill { 134101a469b8SJared McNeill struct awg_softc *sc; 1342767754e5SKyle Evans phandle_t node, phy_node; 134301a469b8SJared McNeill hwreset_t rst_ahb, rst_ephy; 134401a469b8SJared McNeill clk_t clk_ahb, clk_ephy; 134501a469b8SJared McNeill regulator_t reg; 134601a469b8SJared McNeill uint64_t freq; 134701a469b8SJared McNeill int error, div; 134801a469b8SJared McNeill 134901a469b8SJared McNeill sc = device_get_softc(dev); 135001a469b8SJared McNeill rst_ahb = rst_ephy = NULL; 135101a469b8SJared McNeill clk_ahb = clk_ephy = NULL; 135201a469b8SJared McNeill reg = NULL; 13532defb358SKyle Evans node = ofw_bus_get_node(dev); 1354767754e5SKyle Evans phy_node = awg_get_phy_node(dev); 1355767754e5SKyle Evans 1356767754e5SKyle Evans if (phy_node == 0 && OF_hasprop(node, "phy-handle")) { 1357767754e5SKyle Evans error = ENXIO; 1358767754e5SKyle Evans device_printf(dev, "cannot get phy handle\n"); 1359767754e5SKyle Evans goto fail; 1360767754e5SKyle Evans } 136101a469b8SJared McNeill 136201a469b8SJared McNeill /* Get AHB clock and reset resources */ 1363767754e5SKyle Evans error = hwreset_get_by_ofw_name(dev, 0, "stmmaceth", &rst_ahb); 1364767754e5SKyle Evans if (error != 0) 136501a469b8SJared McNeill error = hwreset_get_by_ofw_name(dev, 0, "ahb", &rst_ahb); 136601a469b8SJared McNeill if (error != 0) { 136701a469b8SJared McNeill device_printf(dev, "cannot get ahb reset\n"); 136801a469b8SJared McNeill goto fail; 136901a469b8SJared McNeill } 137001a469b8SJared McNeill if (hwreset_get_by_ofw_name(dev, 0, "ephy", &rst_ephy) != 0) 1371767754e5SKyle Evans if (phy_node == 0 || hwreset_get_by_ofw_idx(dev, phy_node, 0, 1372767754e5SKyle Evans &rst_ephy) != 0) 137301a469b8SJared McNeill rst_ephy = NULL; 1374767754e5SKyle Evans error = clk_get_by_ofw_name(dev, 0, "stmmaceth", &clk_ahb); 1375767754e5SKyle Evans if (error != 0) 137601a469b8SJared McNeill error = clk_get_by_ofw_name(dev, 0, "ahb", &clk_ahb); 137701a469b8SJared McNeill if (error != 0) { 137801a469b8SJared McNeill device_printf(dev, "cannot get ahb clock\n"); 137901a469b8SJared McNeill goto fail; 138001a469b8SJared McNeill } 138101a469b8SJared McNeill if (clk_get_by_ofw_name(dev, 0, "ephy", &clk_ephy) != 0) 1382767754e5SKyle Evans if (phy_node == 0 || clk_get_by_ofw_index(dev, phy_node, 0, 1383767754e5SKyle Evans &clk_ephy) != 0) 138401a469b8SJared McNeill clk_ephy = NULL; 138501a469b8SJared McNeill 13862defb358SKyle Evans if (OF_hasprop(node, "syscon") && syscon_get_by_ofw_property(dev, node, 13872defb358SKyle Evans "syscon", &sc->syscon) != 0) { 13882defb358SKyle Evans device_printf(dev, "cannot get syscon driver handle\n"); 13892defb358SKyle Evans goto fail; 13902defb358SKyle Evans } 13912defb358SKyle Evans 139201a469b8SJared McNeill /* Configure PHY for MII or RGMII mode */ 139301a469b8SJared McNeill if (awg_setup_phy(dev) != 0) 139401a469b8SJared McNeill goto fail; 139501a469b8SJared McNeill 139601a469b8SJared McNeill /* Enable clocks */ 1397d3810ff9SJared McNeill error = clk_enable(clk_ahb); 1398d3810ff9SJared McNeill if (error != 0) { 1399d3810ff9SJared McNeill device_printf(dev, "cannot enable ahb clock\n"); 1400d3810ff9SJared McNeill goto fail; 1401d3810ff9SJared McNeill } 140201a469b8SJared McNeill if (clk_ephy != NULL) { 140301a469b8SJared McNeill error = clk_enable(clk_ephy); 140401a469b8SJared McNeill if (error != 0) { 140501a469b8SJared McNeill device_printf(dev, "cannot enable ephy clock\n"); 140601a469b8SJared McNeill goto fail; 140701a469b8SJared McNeill } 140801a469b8SJared McNeill } 1409d3810ff9SJared McNeill 1410d3810ff9SJared McNeill /* De-assert reset */ 1411d3810ff9SJared McNeill error = hwreset_deassert(rst_ahb); 1412d3810ff9SJared McNeill if (error != 0) { 1413d3810ff9SJared McNeill device_printf(dev, "cannot de-assert ahb reset\n"); 1414d3810ff9SJared McNeill goto fail; 1415d3810ff9SJared McNeill } 141601a469b8SJared McNeill if (rst_ephy != NULL) { 141701a469b8SJared McNeill error = hwreset_deassert(rst_ephy); 141801a469b8SJared McNeill if (error != 0) { 141901a469b8SJared McNeill device_printf(dev, "cannot de-assert ephy reset\n"); 142001a469b8SJared McNeill goto fail; 142101a469b8SJared McNeill } 142201a469b8SJared McNeill } 1423d3810ff9SJared McNeill 1424d3810ff9SJared McNeill /* Enable PHY regulator if applicable */ 1425dac93553SMichal Meloun if (regulator_get_by_ofw_property(dev, 0, "phy-supply", ®) == 0) { 1426d3810ff9SJared McNeill error = regulator_enable(reg); 1427d3810ff9SJared McNeill if (error != 0) { 1428d3810ff9SJared McNeill device_printf(dev, "cannot enable PHY regulator\n"); 1429d3810ff9SJared McNeill goto fail; 1430d3810ff9SJared McNeill } 1431d3810ff9SJared McNeill } 1432d3810ff9SJared McNeill 1433d3810ff9SJared McNeill /* Determine MDC clock divide ratio based on AHB clock */ 1434d3810ff9SJared McNeill error = clk_get_freq(clk_ahb, &freq); 1435d3810ff9SJared McNeill if (error != 0) { 1436d3810ff9SJared McNeill device_printf(dev, "cannot get AHB clock frequency\n"); 1437d3810ff9SJared McNeill goto fail; 1438d3810ff9SJared McNeill } 1439d3810ff9SJared McNeill div = freq / MDIO_FREQ; 1440d3810ff9SJared McNeill if (div <= 16) 1441d3810ff9SJared McNeill sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_16; 1442d3810ff9SJared McNeill else if (div <= 32) 1443d3810ff9SJared McNeill sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_32; 1444d3810ff9SJared McNeill else if (div <= 64) 1445d3810ff9SJared McNeill sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_64; 1446d3810ff9SJared McNeill else if (div <= 128) 1447d3810ff9SJared McNeill sc->mdc_div_ratio_m = MDC_DIV_RATIO_M_128; 1448d3810ff9SJared McNeill else { 1449d3810ff9SJared McNeill device_printf(dev, "cannot determine MDC clock divide ratio\n"); 1450d3810ff9SJared McNeill error = ENXIO; 1451d3810ff9SJared McNeill goto fail; 1452d3810ff9SJared McNeill } 1453d3810ff9SJared McNeill 1454d3810ff9SJared McNeill if (bootverbose) 145501a469b8SJared McNeill device_printf(dev, "AHB frequency %ju Hz, MDC div: 0x%x\n", 145601a469b8SJared McNeill (uintmax_t)freq, sc->mdc_div_ratio_m); 1457d3810ff9SJared McNeill 1458d3810ff9SJared McNeill return (0); 1459d3810ff9SJared McNeill 1460d3810ff9SJared McNeill fail: 1461d3810ff9SJared McNeill if (reg != NULL) 1462d3810ff9SJared McNeill regulator_release(reg); 146301a469b8SJared McNeill if (clk_ephy != NULL) 146401a469b8SJared McNeill clk_release(clk_ephy); 1465d3810ff9SJared McNeill if (clk_ahb != NULL) 1466d3810ff9SJared McNeill clk_release(clk_ahb); 146701a469b8SJared McNeill if (rst_ephy != NULL) 146801a469b8SJared McNeill hwreset_release(rst_ephy); 1469d3810ff9SJared McNeill if (rst_ahb != NULL) 1470d3810ff9SJared McNeill hwreset_release(rst_ahb); 1471d3810ff9SJared McNeill return (error); 1472d3810ff9SJared McNeill } 1473d3810ff9SJared McNeill 1474d3810ff9SJared McNeill static void 1475d3810ff9SJared McNeill awg_get_eaddr(device_t dev, uint8_t *eaddr) 1476d3810ff9SJared McNeill { 1477d3810ff9SJared McNeill struct awg_softc *sc; 1478d3810ff9SJared McNeill uint32_t maclo, machi, rnd; 14791403e695SJared McNeill u_char rootkey[16]; 1480d3810ff9SJared McNeill 1481d3810ff9SJared McNeill sc = device_get_softc(dev); 1482d3810ff9SJared McNeill 1483d3810ff9SJared McNeill machi = RD4(sc, EMAC_ADDR_HIGH(0)) & 0xffff; 1484d3810ff9SJared McNeill maclo = RD4(sc, EMAC_ADDR_LOW(0)); 1485d3810ff9SJared McNeill 1486d3810ff9SJared McNeill if (maclo == 0xffffffff && machi == 0xffff) { 1487d3810ff9SJared McNeill /* MAC address in hardware is invalid, create one */ 14881403e695SJared McNeill if (aw_sid_get_rootkey(rootkey) == 0 && 14891403e695SJared McNeill (rootkey[3] | rootkey[12] | rootkey[13] | rootkey[14] | 14901403e695SJared McNeill rootkey[15]) != 0) { 14911403e695SJared McNeill /* MAC address is derived from the root key in SID */ 14921403e695SJared McNeill maclo = (rootkey[13] << 24) | (rootkey[12] << 16) | 14931403e695SJared McNeill (rootkey[3] << 8) | 0x02; 14941403e695SJared McNeill machi = (rootkey[15] << 8) | rootkey[14]; 14951403e695SJared McNeill } else { 14961403e695SJared McNeill /* Create one */ 1497d3810ff9SJared McNeill rnd = arc4random(); 1498d3810ff9SJared McNeill maclo = 0x00f2 | (rnd & 0xffff0000); 1499d3810ff9SJared McNeill machi = rnd & 0xffff; 1500d3810ff9SJared McNeill } 15011403e695SJared McNeill } 1502d3810ff9SJared McNeill 1503d3810ff9SJared McNeill eaddr[0] = maclo & 0xff; 1504d3810ff9SJared McNeill eaddr[1] = (maclo >> 8) & 0xff; 1505d3810ff9SJared McNeill eaddr[2] = (maclo >> 16) & 0xff; 1506d3810ff9SJared McNeill eaddr[3] = (maclo >> 24) & 0xff; 1507d3810ff9SJared McNeill eaddr[4] = machi & 0xff; 1508d3810ff9SJared McNeill eaddr[5] = (machi >> 8) & 0xff; 1509d3810ff9SJared McNeill } 1510d3810ff9SJared McNeill 1511d3810ff9SJared McNeill #ifdef AWG_DEBUG 1512d3810ff9SJared McNeill static void 1513d3810ff9SJared McNeill awg_dump_regs(device_t dev) 1514d3810ff9SJared McNeill { 1515d3810ff9SJared McNeill static const struct { 1516d3810ff9SJared McNeill const char *name; 1517d3810ff9SJared McNeill u_int reg; 1518d3810ff9SJared McNeill } regs[] = { 1519d3810ff9SJared McNeill { "BASIC_CTL_0", EMAC_BASIC_CTL_0 }, 1520d3810ff9SJared McNeill { "BASIC_CTL_1", EMAC_BASIC_CTL_1 }, 1521d3810ff9SJared McNeill { "INT_STA", EMAC_INT_STA }, 1522d3810ff9SJared McNeill { "INT_EN", EMAC_INT_EN }, 1523d3810ff9SJared McNeill { "TX_CTL_0", EMAC_TX_CTL_0 }, 1524d3810ff9SJared McNeill { "TX_CTL_1", EMAC_TX_CTL_1 }, 1525d3810ff9SJared McNeill { "TX_FLOW_CTL", EMAC_TX_FLOW_CTL }, 1526d3810ff9SJared McNeill { "TX_DMA_LIST", EMAC_TX_DMA_LIST }, 1527d3810ff9SJared McNeill { "RX_CTL_0", EMAC_RX_CTL_0 }, 1528d3810ff9SJared McNeill { "RX_CTL_1", EMAC_RX_CTL_1 }, 1529d3810ff9SJared McNeill { "RX_DMA_LIST", EMAC_RX_DMA_LIST }, 1530d3810ff9SJared McNeill { "RX_FRM_FLT", EMAC_RX_FRM_FLT }, 1531d3810ff9SJared McNeill { "RX_HASH_0", EMAC_RX_HASH_0 }, 1532d3810ff9SJared McNeill { "RX_HASH_1", EMAC_RX_HASH_1 }, 1533d3810ff9SJared McNeill { "MII_CMD", EMAC_MII_CMD }, 1534d3810ff9SJared McNeill { "ADDR_HIGH0", EMAC_ADDR_HIGH(0) }, 1535d3810ff9SJared McNeill { "ADDR_LOW0", EMAC_ADDR_LOW(0) }, 1536d3810ff9SJared McNeill { "TX_DMA_STA", EMAC_TX_DMA_STA }, 1537d3810ff9SJared McNeill { "TX_DMA_CUR_DESC", EMAC_TX_DMA_CUR_DESC }, 1538d3810ff9SJared McNeill { "TX_DMA_CUR_BUF", EMAC_TX_DMA_CUR_BUF }, 1539d3810ff9SJared McNeill { "RX_DMA_STA", EMAC_RX_DMA_STA }, 1540d3810ff9SJared McNeill { "RX_DMA_CUR_DESC", EMAC_RX_DMA_CUR_DESC }, 1541d3810ff9SJared McNeill { "RX_DMA_CUR_BUF", EMAC_RX_DMA_CUR_BUF }, 1542d3810ff9SJared McNeill { "RGMII_STA", EMAC_RGMII_STA }, 1543d3810ff9SJared McNeill }; 1544d3810ff9SJared McNeill struct awg_softc *sc; 1545d3810ff9SJared McNeill unsigned int n; 1546d3810ff9SJared McNeill 1547d3810ff9SJared McNeill sc = device_get_softc(dev); 1548d3810ff9SJared McNeill 1549d3810ff9SJared McNeill for (n = 0; n < nitems(regs); n++) 1550d3810ff9SJared McNeill device_printf(dev, " %-20s %08x\n", regs[n].name, 1551d3810ff9SJared McNeill RD4(sc, regs[n].reg)); 1552d3810ff9SJared McNeill } 1553d3810ff9SJared McNeill #endif 1554d3810ff9SJared McNeill 155501a469b8SJared McNeill #define GPIO_ACTIVE_LOW 1 155601a469b8SJared McNeill 155701a469b8SJared McNeill static int 155801a469b8SJared McNeill awg_phy_reset(device_t dev) 155901a469b8SJared McNeill { 156001a469b8SJared McNeill pcell_t gpio_prop[4], delay_prop[3]; 156101a469b8SJared McNeill phandle_t node, gpio_node; 156201a469b8SJared McNeill device_t gpio; 156301a469b8SJared McNeill uint32_t pin, flags; 156401a469b8SJared McNeill uint32_t pin_value; 156501a469b8SJared McNeill 156601a469b8SJared McNeill node = ofw_bus_get_node(dev); 156701a469b8SJared McNeill if (OF_getencprop(node, "allwinner,reset-gpio", gpio_prop, 156801a469b8SJared McNeill sizeof(gpio_prop)) <= 0) 156901a469b8SJared McNeill return (0); 157001a469b8SJared McNeill 157101a469b8SJared McNeill if (OF_getencprop(node, "allwinner,reset-delays-us", delay_prop, 157201a469b8SJared McNeill sizeof(delay_prop)) <= 0) 157301a469b8SJared McNeill return (ENXIO); 157401a469b8SJared McNeill 157501a469b8SJared McNeill gpio_node = OF_node_from_xref(gpio_prop[0]); 157601a469b8SJared McNeill if ((gpio = OF_device_from_xref(gpio_prop[0])) == NULL) 157701a469b8SJared McNeill return (ENXIO); 157801a469b8SJared McNeill 157901a469b8SJared McNeill if (GPIO_MAP_GPIOS(gpio, node, gpio_node, nitems(gpio_prop) - 1, 158001a469b8SJared McNeill gpio_prop + 1, &pin, &flags) != 0) 158101a469b8SJared McNeill return (ENXIO); 158201a469b8SJared McNeill 158301a469b8SJared McNeill pin_value = GPIO_PIN_LOW; 158401a469b8SJared McNeill if (OF_hasprop(node, "allwinner,reset-active-low")) 158501a469b8SJared McNeill pin_value = GPIO_PIN_HIGH; 158601a469b8SJared McNeill 158701a469b8SJared McNeill if (flags & GPIO_ACTIVE_LOW) 158801a469b8SJared McNeill pin_value = !pin_value; 158901a469b8SJared McNeill 159001a469b8SJared McNeill GPIO_PIN_SETFLAGS(gpio, pin, GPIO_PIN_OUTPUT); 159101a469b8SJared McNeill GPIO_PIN_SET(gpio, pin, pin_value); 159201a469b8SJared McNeill DELAY(delay_prop[0]); 159301a469b8SJared McNeill GPIO_PIN_SET(gpio, pin, !pin_value); 159401a469b8SJared McNeill DELAY(delay_prop[1]); 159501a469b8SJared McNeill GPIO_PIN_SET(gpio, pin, pin_value); 159601a469b8SJared McNeill DELAY(delay_prop[2]); 159701a469b8SJared McNeill 159801a469b8SJared McNeill return (0); 159901a469b8SJared McNeill } 160001a469b8SJared McNeill 1601d3810ff9SJared McNeill static int 1602d3810ff9SJared McNeill awg_reset(device_t dev) 1603d3810ff9SJared McNeill { 1604d3810ff9SJared McNeill struct awg_softc *sc; 1605d3810ff9SJared McNeill int retry; 1606d3810ff9SJared McNeill 1607d3810ff9SJared McNeill sc = device_get_softc(dev); 1608d3810ff9SJared McNeill 160901a469b8SJared McNeill /* Reset PHY if necessary */ 161001a469b8SJared McNeill if (awg_phy_reset(dev) != 0) { 161101a469b8SJared McNeill device_printf(dev, "failed to reset PHY\n"); 161201a469b8SJared McNeill return (ENXIO); 161301a469b8SJared McNeill } 161401a469b8SJared McNeill 1615d3810ff9SJared McNeill /* Soft reset all registers and logic */ 1616d3810ff9SJared McNeill WR4(sc, EMAC_BASIC_CTL_1, BASIC_CTL_SOFT_RST); 1617d3810ff9SJared McNeill 1618d3810ff9SJared McNeill /* Wait for soft reset bit to self-clear */ 1619d3810ff9SJared McNeill for (retry = SOFT_RST_RETRY; retry > 0; retry--) { 1620d3810ff9SJared McNeill if ((RD4(sc, EMAC_BASIC_CTL_1) & BASIC_CTL_SOFT_RST) == 0) 1621d3810ff9SJared McNeill break; 1622d3810ff9SJared McNeill DELAY(10); 1623d3810ff9SJared McNeill } 1624d3810ff9SJared McNeill if (retry == 0) { 1625d3810ff9SJared McNeill device_printf(dev, "soft reset timed out\n"); 1626d3810ff9SJared McNeill #ifdef AWG_DEBUG 1627d3810ff9SJared McNeill awg_dump_regs(dev); 1628d3810ff9SJared McNeill #endif 1629d3810ff9SJared McNeill return (ETIMEDOUT); 1630d3810ff9SJared McNeill } 1631d3810ff9SJared McNeill 1632d3810ff9SJared McNeill return (0); 1633d3810ff9SJared McNeill } 1634d3810ff9SJared McNeill 1635d3810ff9SJared McNeill static void 1636d3810ff9SJared McNeill awg_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error) 1637d3810ff9SJared McNeill { 1638d3810ff9SJared McNeill if (error != 0) 1639d3810ff9SJared McNeill return; 1640d3810ff9SJared McNeill *(bus_addr_t *)arg = segs[0].ds_addr; 1641d3810ff9SJared McNeill } 1642d3810ff9SJared McNeill 1643d3810ff9SJared McNeill static int 1644d3810ff9SJared McNeill awg_setup_dma(device_t dev) 1645d3810ff9SJared McNeill { 1646d3810ff9SJared McNeill struct awg_softc *sc; 1647d3810ff9SJared McNeill int error, i; 1648d3810ff9SJared McNeill 1649d3810ff9SJared McNeill sc = device_get_softc(dev); 1650d3810ff9SJared McNeill 1651d3810ff9SJared McNeill /* Setup TX ring */ 1652d3810ff9SJared McNeill error = bus_dma_tag_create( 1653d3810ff9SJared McNeill bus_get_dma_tag(dev), /* Parent tag */ 1654d3810ff9SJared McNeill DESC_ALIGN, 0, /* alignment, boundary */ 1655d3810ff9SJared McNeill BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 1656d3810ff9SJared McNeill BUS_SPACE_MAXADDR, /* highaddr */ 1657d3810ff9SJared McNeill NULL, NULL, /* filter, filterarg */ 1658d3810ff9SJared McNeill TX_DESC_SIZE, 1, /* maxsize, nsegs */ 1659d3810ff9SJared McNeill TX_DESC_SIZE, /* maxsegsize */ 1660d3810ff9SJared McNeill 0, /* flags */ 1661d3810ff9SJared McNeill NULL, NULL, /* lockfunc, lockarg */ 1662d3810ff9SJared McNeill &sc->tx.desc_tag); 1663d3810ff9SJared McNeill if (error != 0) { 1664d3810ff9SJared McNeill device_printf(dev, "cannot create TX descriptor ring tag\n"); 1665d3810ff9SJared McNeill return (error); 1666d3810ff9SJared McNeill } 1667d3810ff9SJared McNeill 1668d3810ff9SJared McNeill error = bus_dmamem_alloc(sc->tx.desc_tag, (void **)&sc->tx.desc_ring, 1669d3810ff9SJared McNeill BUS_DMA_COHERENT | BUS_DMA_WAITOK | BUS_DMA_ZERO, &sc->tx.desc_map); 1670d3810ff9SJared McNeill if (error != 0) { 1671d3810ff9SJared McNeill device_printf(dev, "cannot allocate TX descriptor ring\n"); 1672d3810ff9SJared McNeill return (error); 1673d3810ff9SJared McNeill } 1674d3810ff9SJared McNeill 1675d3810ff9SJared McNeill error = bus_dmamap_load(sc->tx.desc_tag, sc->tx.desc_map, 1676d3810ff9SJared McNeill sc->tx.desc_ring, TX_DESC_SIZE, awg_dmamap_cb, 1677d3810ff9SJared McNeill &sc->tx.desc_ring_paddr, 0); 1678d3810ff9SJared McNeill if (error != 0) { 1679d3810ff9SJared McNeill device_printf(dev, "cannot load TX descriptor ring\n"); 1680d3810ff9SJared McNeill return (error); 1681d3810ff9SJared McNeill } 1682d3810ff9SJared McNeill 1683d3810ff9SJared McNeill for (i = 0; i < TX_DESC_COUNT; i++) 1684d3810ff9SJared McNeill sc->tx.desc_ring[i].next = 1685d3810ff9SJared McNeill htole32(sc->tx.desc_ring_paddr + DESC_OFF(TX_NEXT(i))); 1686d3810ff9SJared McNeill 1687d3810ff9SJared McNeill error = bus_dma_tag_create( 1688d3810ff9SJared McNeill bus_get_dma_tag(dev), /* Parent tag */ 1689d3810ff9SJared McNeill 1, 0, /* alignment, boundary */ 1690d3810ff9SJared McNeill BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 1691d3810ff9SJared McNeill BUS_SPACE_MAXADDR, /* highaddr */ 1692d3810ff9SJared McNeill NULL, NULL, /* filter, filterarg */ 1693d3810ff9SJared McNeill MCLBYTES, TX_MAX_SEGS, /* maxsize, nsegs */ 1694d3810ff9SJared McNeill MCLBYTES, /* maxsegsize */ 1695d3810ff9SJared McNeill 0, /* flags */ 1696d3810ff9SJared McNeill NULL, NULL, /* lockfunc, lockarg */ 1697d3810ff9SJared McNeill &sc->tx.buf_tag); 1698d3810ff9SJared McNeill if (error != 0) { 1699d3810ff9SJared McNeill device_printf(dev, "cannot create TX buffer tag\n"); 1700d3810ff9SJared McNeill return (error); 1701d3810ff9SJared McNeill } 1702d3810ff9SJared McNeill 1703c6110e75SEmmanuel Vadot sc->tx.queued = 0; 1704d3810ff9SJared McNeill for (i = 0; i < TX_DESC_COUNT; i++) { 1705d3810ff9SJared McNeill error = bus_dmamap_create(sc->tx.buf_tag, 0, 1706d3810ff9SJared McNeill &sc->tx.buf_map[i].map); 1707d3810ff9SJared McNeill if (error != 0) { 1708d3810ff9SJared McNeill device_printf(dev, "cannot create TX buffer map\n"); 1709d3810ff9SJared McNeill return (error); 1710d3810ff9SJared McNeill } 1711d3810ff9SJared McNeill } 1712d3810ff9SJared McNeill 1713d3810ff9SJared McNeill /* Setup RX ring */ 1714d3810ff9SJared McNeill error = bus_dma_tag_create( 1715d3810ff9SJared McNeill bus_get_dma_tag(dev), /* Parent tag */ 1716d3810ff9SJared McNeill DESC_ALIGN, 0, /* alignment, boundary */ 1717d3810ff9SJared McNeill BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 1718d3810ff9SJared McNeill BUS_SPACE_MAXADDR, /* highaddr */ 1719d3810ff9SJared McNeill NULL, NULL, /* filter, filterarg */ 1720d3810ff9SJared McNeill RX_DESC_SIZE, 1, /* maxsize, nsegs */ 1721d3810ff9SJared McNeill RX_DESC_SIZE, /* maxsegsize */ 1722d3810ff9SJared McNeill 0, /* flags */ 1723d3810ff9SJared McNeill NULL, NULL, /* lockfunc, lockarg */ 1724d3810ff9SJared McNeill &sc->rx.desc_tag); 1725d3810ff9SJared McNeill if (error != 0) { 1726d3810ff9SJared McNeill device_printf(dev, "cannot create RX descriptor ring tag\n"); 1727d3810ff9SJared McNeill return (error); 1728d3810ff9SJared McNeill } 1729d3810ff9SJared McNeill 1730d3810ff9SJared McNeill error = bus_dmamem_alloc(sc->rx.desc_tag, (void **)&sc->rx.desc_ring, 1731d3810ff9SJared McNeill BUS_DMA_COHERENT | BUS_DMA_WAITOK | BUS_DMA_ZERO, &sc->rx.desc_map); 1732d3810ff9SJared McNeill if (error != 0) { 1733d3810ff9SJared McNeill device_printf(dev, "cannot allocate RX descriptor ring\n"); 1734d3810ff9SJared McNeill return (error); 1735d3810ff9SJared McNeill } 1736d3810ff9SJared McNeill 1737d3810ff9SJared McNeill error = bus_dmamap_load(sc->rx.desc_tag, sc->rx.desc_map, 1738d3810ff9SJared McNeill sc->rx.desc_ring, RX_DESC_SIZE, awg_dmamap_cb, 1739d3810ff9SJared McNeill &sc->rx.desc_ring_paddr, 0); 1740d3810ff9SJared McNeill if (error != 0) { 1741d3810ff9SJared McNeill device_printf(dev, "cannot load RX descriptor ring\n"); 1742d3810ff9SJared McNeill return (error); 1743d3810ff9SJared McNeill } 1744d3810ff9SJared McNeill 1745d3810ff9SJared McNeill error = bus_dma_tag_create( 1746d3810ff9SJared McNeill bus_get_dma_tag(dev), /* Parent tag */ 1747d3810ff9SJared McNeill 1, 0, /* alignment, boundary */ 1748d3810ff9SJared McNeill BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 1749d3810ff9SJared McNeill BUS_SPACE_MAXADDR, /* highaddr */ 1750d3810ff9SJared McNeill NULL, NULL, /* filter, filterarg */ 1751d3810ff9SJared McNeill MCLBYTES, 1, /* maxsize, nsegs */ 1752d3810ff9SJared McNeill MCLBYTES, /* maxsegsize */ 1753d3810ff9SJared McNeill 0, /* flags */ 1754d3810ff9SJared McNeill NULL, NULL, /* lockfunc, lockarg */ 1755d3810ff9SJared McNeill &sc->rx.buf_tag); 1756d3810ff9SJared McNeill if (error != 0) { 1757d3810ff9SJared McNeill device_printf(dev, "cannot create RX buffer tag\n"); 1758d3810ff9SJared McNeill return (error); 1759d3810ff9SJared McNeill } 1760d3810ff9SJared McNeill 1761bd906329SEmmanuel Vadot error = bus_dmamap_create(sc->rx.buf_tag, 0, &sc->rx.buf_spare_map); 1762bd906329SEmmanuel Vadot if (error != 0) { 1763bd906329SEmmanuel Vadot device_printf(dev, 1764bd906329SEmmanuel Vadot "cannot create RX buffer spare map\n"); 1765bd906329SEmmanuel Vadot return (error); 1766bd906329SEmmanuel Vadot } 1767bd906329SEmmanuel Vadot 1768d3810ff9SJared McNeill for (i = 0; i < RX_DESC_COUNT; i++) { 1769bd906329SEmmanuel Vadot sc->rx.desc_ring[i].next = 1770bd906329SEmmanuel Vadot htole32(sc->rx.desc_ring_paddr + DESC_OFF(RX_NEXT(i))); 1771bd906329SEmmanuel Vadot 1772d3810ff9SJared McNeill error = bus_dmamap_create(sc->rx.buf_tag, 0, 1773d3810ff9SJared McNeill &sc->rx.buf_map[i].map); 1774d3810ff9SJared McNeill if (error != 0) { 1775d3810ff9SJared McNeill device_printf(dev, "cannot create RX buffer map\n"); 1776d3810ff9SJared McNeill return (error); 1777d3810ff9SJared McNeill } 1778bd906329SEmmanuel Vadot sc->rx.buf_map[i].mbuf = NULL; 1779bd906329SEmmanuel Vadot error = awg_newbuf_rx(sc, i); 1780d3810ff9SJared McNeill if (error != 0) { 1781d3810ff9SJared McNeill device_printf(dev, "cannot create RX buffer\n"); 1782d3810ff9SJared McNeill return (error); 1783d3810ff9SJared McNeill } 1784d3810ff9SJared McNeill } 1785d3810ff9SJared McNeill bus_dmamap_sync(sc->rx.desc_tag, sc->rx.desc_map, 1786d3810ff9SJared McNeill BUS_DMASYNC_PREWRITE); 1787d3810ff9SJared McNeill 1788d3810ff9SJared McNeill /* Write transmit and receive descriptor base address registers */ 1789d3810ff9SJared McNeill WR4(sc, EMAC_TX_DMA_LIST, sc->tx.desc_ring_paddr); 1790d3810ff9SJared McNeill WR4(sc, EMAC_RX_DMA_LIST, sc->rx.desc_ring_paddr); 1791d3810ff9SJared McNeill 1792d3810ff9SJared McNeill return (0); 1793d3810ff9SJared McNeill } 1794d3810ff9SJared McNeill 1795d3810ff9SJared McNeill static int 1796d3810ff9SJared McNeill awg_probe(device_t dev) 1797d3810ff9SJared McNeill { 1798d3810ff9SJared McNeill if (!ofw_bus_status_okay(dev)) 1799d3810ff9SJared McNeill return (ENXIO); 1800d3810ff9SJared McNeill 1801d3810ff9SJared McNeill if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 0) 1802d3810ff9SJared McNeill return (ENXIO); 1803d3810ff9SJared McNeill 1804d3810ff9SJared McNeill device_set_desc(dev, "Allwinner Gigabit Ethernet"); 1805d3810ff9SJared McNeill return (BUS_PROBE_DEFAULT); 1806d3810ff9SJared McNeill } 1807d3810ff9SJared McNeill 1808d3810ff9SJared McNeill static int 1809d3810ff9SJared McNeill awg_attach(device_t dev) 1810d3810ff9SJared McNeill { 1811d3810ff9SJared McNeill uint8_t eaddr[ETHER_ADDR_LEN]; 1812d3810ff9SJared McNeill struct awg_softc *sc; 1813d3810ff9SJared McNeill int error; 1814d3810ff9SJared McNeill 1815d3810ff9SJared McNeill sc = device_get_softc(dev); 1816031d5777SOleksandr Tymoshenko sc->dev = dev; 181701a469b8SJared McNeill sc->type = ofw_bus_search_compatible(dev, compat_data)->ocd_data; 1818d3810ff9SJared McNeill 1819d3810ff9SJared McNeill if (bus_alloc_resources(dev, awg_spec, sc->res) != 0) { 1820d3810ff9SJared McNeill device_printf(dev, "cannot allocate resources for device\n"); 1821d3810ff9SJared McNeill return (ENXIO); 1822d3810ff9SJared McNeill } 1823d3810ff9SJared McNeill 1824d3810ff9SJared McNeill mtx_init(&sc->mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, MTX_DEF); 1825d3810ff9SJared McNeill callout_init_mtx(&sc->stat_ch, &sc->mtx, 0); 1826d3810ff9SJared McNeill TASK_INIT(&sc->link_task, 0, awg_link_task, sc); 1827d3810ff9SJared McNeill 1828d3810ff9SJared McNeill /* Setup clocks and regulators */ 1829d3810ff9SJared McNeill error = awg_setup_extres(dev); 1830d3810ff9SJared McNeill if (error != 0) 1831d3810ff9SJared McNeill return (error); 1832d3810ff9SJared McNeill 1833d3810ff9SJared McNeill /* Read MAC address before resetting the chip */ 1834d3810ff9SJared McNeill awg_get_eaddr(dev, eaddr); 1835d3810ff9SJared McNeill 1836d3810ff9SJared McNeill /* Soft reset EMAC core */ 1837d3810ff9SJared McNeill error = awg_reset(dev); 1838d3810ff9SJared McNeill if (error != 0) 1839d3810ff9SJared McNeill return (error); 1840d3810ff9SJared McNeill 1841d3810ff9SJared McNeill /* Setup DMA descriptors */ 1842d3810ff9SJared McNeill error = awg_setup_dma(dev); 1843d3810ff9SJared McNeill if (error != 0) 1844d3810ff9SJared McNeill return (error); 1845d3810ff9SJared McNeill 1846d3810ff9SJared McNeill /* Install interrupt handler */ 184701a469b8SJared McNeill error = bus_setup_intr(dev, sc->res[_RES_IRQ], 184801a469b8SJared McNeill INTR_TYPE_NET | INTR_MPSAFE, NULL, awg_intr, sc, &sc->ih); 1849d3810ff9SJared McNeill if (error != 0) { 1850d3810ff9SJared McNeill device_printf(dev, "cannot setup interrupt handler\n"); 1851d3810ff9SJared McNeill return (error); 1852d3810ff9SJared McNeill } 1853d3810ff9SJared McNeill 1854d3810ff9SJared McNeill /* Setup ethernet interface */ 1855d3810ff9SJared McNeill sc->ifp = if_alloc(IFT_ETHER); 1856d3810ff9SJared McNeill if_setsoftc(sc->ifp, sc); 1857d3810ff9SJared McNeill if_initname(sc->ifp, device_get_name(dev), device_get_unit(dev)); 1858d3810ff9SJared McNeill if_setflags(sc->ifp, IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST); 1859d3810ff9SJared McNeill if_setstartfn(sc->ifp, awg_start); 1860d3810ff9SJared McNeill if_setioctlfn(sc->ifp, awg_ioctl); 1861d3810ff9SJared McNeill if_setinitfn(sc->ifp, awg_init); 1862d3810ff9SJared McNeill if_setsendqlen(sc->ifp, TX_DESC_COUNT - 1); 1863d3810ff9SJared McNeill if_setsendqready(sc->ifp); 1864d3810ff9SJared McNeill if_sethwassist(sc->ifp, CSUM_IP | CSUM_UDP | CSUM_TCP); 1865d3810ff9SJared McNeill if_setcapabilities(sc->ifp, IFCAP_VLAN_MTU | IFCAP_HWCSUM); 1866d3810ff9SJared McNeill if_setcapenable(sc->ifp, if_getcapabilities(sc->ifp)); 186716928528SJared McNeill #ifdef DEVICE_POLLING 186816928528SJared McNeill if_setcapabilitiesbit(sc->ifp, IFCAP_POLLING, 0); 186916928528SJared McNeill #endif 1870d3810ff9SJared McNeill 1871d3810ff9SJared McNeill /* Attach MII driver */ 1872d3810ff9SJared McNeill error = mii_attach(dev, &sc->miibus, sc->ifp, awg_media_change, 1873d3810ff9SJared McNeill awg_media_status, BMSR_DEFCAPMASK, MII_PHY_ANY, MII_OFFSET_ANY, 1874d3810ff9SJared McNeill MIIF_DOPAUSE); 1875d3810ff9SJared McNeill if (error != 0) { 1876d3810ff9SJared McNeill device_printf(dev, "cannot attach PHY\n"); 1877d3810ff9SJared McNeill return (error); 1878d3810ff9SJared McNeill } 1879d3810ff9SJared McNeill 1880d3810ff9SJared McNeill /* Attach ethernet interface */ 1881d3810ff9SJared McNeill ether_ifattach(sc->ifp, eaddr); 1882d3810ff9SJared McNeill 1883d3810ff9SJared McNeill return (0); 1884d3810ff9SJared McNeill } 1885d3810ff9SJared McNeill 1886d3810ff9SJared McNeill static device_method_t awg_methods[] = { 1887d3810ff9SJared McNeill /* Device interface */ 1888d3810ff9SJared McNeill DEVMETHOD(device_probe, awg_probe), 1889d3810ff9SJared McNeill DEVMETHOD(device_attach, awg_attach), 1890d3810ff9SJared McNeill 1891d3810ff9SJared McNeill /* MII interface */ 1892d3810ff9SJared McNeill DEVMETHOD(miibus_readreg, awg_miibus_readreg), 1893d3810ff9SJared McNeill DEVMETHOD(miibus_writereg, awg_miibus_writereg), 1894d3810ff9SJared McNeill DEVMETHOD(miibus_statchg, awg_miibus_statchg), 1895d3810ff9SJared McNeill 1896d3810ff9SJared McNeill DEVMETHOD_END 1897d3810ff9SJared McNeill }; 1898d3810ff9SJared McNeill 1899d3810ff9SJared McNeill static driver_t awg_driver = { 1900d3810ff9SJared McNeill "awg", 1901d3810ff9SJared McNeill awg_methods, 1902d3810ff9SJared McNeill sizeof(struct awg_softc), 1903d3810ff9SJared McNeill }; 1904d3810ff9SJared McNeill 1905d3810ff9SJared McNeill static devclass_t awg_devclass; 1906d3810ff9SJared McNeill 1907d3810ff9SJared McNeill DRIVER_MODULE(awg, simplebus, awg_driver, awg_devclass, 0, 0); 1908d3810ff9SJared McNeill DRIVER_MODULE(miibus, awg, miibus_driver, miibus_devclass, 0, 0); 1909d3810ff9SJared McNeill 1910d3810ff9SJared McNeill MODULE_DEPEND(awg, ether, 1, 1, 1); 1911d3810ff9SJared McNeill MODULE_DEPEND(awg, miibus, 1, 1, 1); 1912