1dfb5178fSStanislav Galabov /*- 2dfb5178fSStanislav Galabov * Copyright (c) 2016 Stanislav Galabov. 3dfb5178fSStanislav Galabov * Copyright (c) 2011-2012 Stefan Bethke. 4dfb5178fSStanislav Galabov * Copyright (c) 2012 Adrian Chadd. 5dfb5178fSStanislav Galabov * All rights reserved. 6dfb5178fSStanislav Galabov * 7dfb5178fSStanislav Galabov * Redistribution and use in source and binary forms, with or without 8dfb5178fSStanislav Galabov * modification, are permitted provided that the following conditions 9dfb5178fSStanislav Galabov * are met: 10dfb5178fSStanislav Galabov * 1. Redistributions of source code must retain the above copyright 11dfb5178fSStanislav Galabov * notice, this list of conditions and the following disclaimer. 12dfb5178fSStanislav Galabov * 2. Redistributions in binary form must reproduce the above copyright 13dfb5178fSStanislav Galabov * notice, this list of conditions and the following disclaimer in the 14dfb5178fSStanislav Galabov * documentation and/or other materials provided with the distribution. 15dfb5178fSStanislav Galabov * 16dfb5178fSStanislav Galabov * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17dfb5178fSStanislav Galabov * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18dfb5178fSStanislav Galabov * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19dfb5178fSStanislav Galabov * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20dfb5178fSStanislav Galabov * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21dfb5178fSStanislav Galabov * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22dfb5178fSStanislav Galabov * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23dfb5178fSStanislav Galabov * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24dfb5178fSStanislav Galabov * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25dfb5178fSStanislav Galabov * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26dfb5178fSStanislav Galabov * SUCH DAMAGE. 27dfb5178fSStanislav Galabov * 28dfb5178fSStanislav Galabov * $FreeBSD$ 29dfb5178fSStanislav Galabov */ 30dfb5178fSStanislav Galabov 31dfb5178fSStanislav Galabov #include <sys/param.h> 32dfb5178fSStanislav Galabov #include <sys/bus.h> 33dfb5178fSStanislav Galabov #include <sys/errno.h> 34dfb5178fSStanislav Galabov #include <sys/kernel.h> 35dfb5178fSStanislav Galabov #include <sys/lock.h> 36dfb5178fSStanislav Galabov #include <sys/malloc.h> 37dfb5178fSStanislav Galabov #include <sys/module.h> 38dfb5178fSStanislav Galabov #include <sys/mutex.h> 39dfb5178fSStanislav Galabov #include <sys/socket.h> 40dfb5178fSStanislav Galabov #include <sys/sockio.h> 41dfb5178fSStanislav Galabov #include <sys/sysctl.h> 42dfb5178fSStanislav Galabov #include <sys/systm.h> 43dfb5178fSStanislav Galabov 44dfb5178fSStanislav Galabov #include <net/if.h> 45dfb5178fSStanislav Galabov #include <net/if_var.h> 46dfb5178fSStanislav Galabov #include <net/ethernet.h> 47dfb5178fSStanislav Galabov #include <net/if_media.h> 48dfb5178fSStanislav Galabov #include <net/if_types.h> 49dfb5178fSStanislav Galabov 50dfb5178fSStanislav Galabov #include <machine/bus.h> 51dfb5178fSStanislav Galabov #include <dev/mii/mii.h> 52dfb5178fSStanislav Galabov #include <dev/mii/miivar.h> 53dfb5178fSStanislav Galabov #include <dev/mdio/mdio.h> 54dfb5178fSStanislav Galabov 55dfb5178fSStanislav Galabov #include <dev/etherswitch/etherswitch.h> 56dfb5178fSStanislav Galabov #include <dev/etherswitch/mtkswitch/mtkswitchvar.h> 57dfb5178fSStanislav Galabov 58dfb5178fSStanislav Galabov #include <dev/ofw/ofw_bus_subr.h> 59dfb5178fSStanislav Galabov 60dfb5178fSStanislav Galabov #include "mdio_if.h" 61dfb5178fSStanislav Galabov #include "miibus_if.h" 62dfb5178fSStanislav Galabov #include "etherswitch_if.h" 63dfb5178fSStanislav Galabov 64dfb5178fSStanislav Galabov #define DEBUG 65dfb5178fSStanislav Galabov 66dfb5178fSStanislav Galabov #if defined(DEBUG) 677029da5cSPawel Biernacki static SYSCTL_NODE(_debug, OID_AUTO, mtkswitch, CTLFLAG_RD | CTLFLAG_MPSAFE, 0, 687029da5cSPawel Biernacki "mtkswitch"); 69dfb5178fSStanislav Galabov #endif 70dfb5178fSStanislav Galabov 71dfb5178fSStanislav Galabov static inline int mtkswitch_portforphy(int phy); 72dfb5178fSStanislav Galabov static int mtkswitch_ifmedia_upd(struct ifnet *ifp); 73dfb5178fSStanislav Galabov static void mtkswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr); 74dfb5178fSStanislav Galabov static void mtkswitch_tick(void *arg); 75dfb5178fSStanislav Galabov 76dfb5178fSStanislav Galabov static const struct ofw_compat_data compat_data[] = { 77dfb5178fSStanislav Galabov { "ralink,rt3050-esw", MTK_SWITCH_RT3050 }, 78dfb5178fSStanislav Galabov { "ralink,rt3352-esw", MTK_SWITCH_RT3352 }, 79dfb5178fSStanislav Galabov { "ralink,rt5350-esw", MTK_SWITCH_RT5350 }, 80dfb5178fSStanislav Galabov { "mediatek,mt7620-gsw", MTK_SWITCH_MT7620 }, 81dfb5178fSStanislav Galabov { "mediatek,mt7621-gsw", MTK_SWITCH_MT7621 }, 82dfb5178fSStanislav Galabov { "mediatek,mt7628-esw", MTK_SWITCH_MT7628 }, 83dfb5178fSStanislav Galabov 84dfb5178fSStanislav Galabov /* Sentinel */ 85dfb5178fSStanislav Galabov { NULL, MTK_SWITCH_NONE } 86dfb5178fSStanislav Galabov }; 87dfb5178fSStanislav Galabov 88dfb5178fSStanislav Galabov static int 89dfb5178fSStanislav Galabov mtkswitch_probe(device_t dev) 90dfb5178fSStanislav Galabov { 91dfb5178fSStanislav Galabov struct mtkswitch_softc *sc; 92dfb5178fSStanislav Galabov mtk_switch_type switch_type; 93dfb5178fSStanislav Galabov 94dfb5178fSStanislav Galabov if (!ofw_bus_status_okay(dev)) 95dfb5178fSStanislav Galabov return (ENXIO); 96dfb5178fSStanislav Galabov 97dfb5178fSStanislav Galabov switch_type = ofw_bus_search_compatible(dev, compat_data)->ocd_data; 98dfb5178fSStanislav Galabov if (switch_type == MTK_SWITCH_NONE) 99dfb5178fSStanislav Galabov return (ENXIO); 100dfb5178fSStanislav Galabov 101dfb5178fSStanislav Galabov sc = device_get_softc(dev); 102dfb5178fSStanislav Galabov bzero(sc, sizeof(*sc)); 103dfb5178fSStanislav Galabov sc->sc_switchtype = switch_type; 104dfb5178fSStanislav Galabov 105dfb5178fSStanislav Galabov device_set_desc_copy(dev, "MTK Switch Driver"); 106dfb5178fSStanislav Galabov 107dfb5178fSStanislav Galabov return (0); 108dfb5178fSStanislav Galabov } 109dfb5178fSStanislav Galabov 110dfb5178fSStanislav Galabov static int 111dfb5178fSStanislav Galabov mtkswitch_attach_phys(struct mtkswitch_softc *sc) 112dfb5178fSStanislav Galabov { 113dfb5178fSStanislav Galabov int phy, err = 0; 114dfb5178fSStanislav Galabov char name[IFNAMSIZ]; 115dfb5178fSStanislav Galabov 116dfb5178fSStanislav Galabov /* PHYs need an interface, so we generate a dummy one */ 117dfb5178fSStanislav Galabov snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev)); 118dfb5178fSStanislav Galabov for (phy = 0; phy < sc->numphys; phy++) { 119dfb5178fSStanislav Galabov if ((sc->phymap & (1u << phy)) == 0) { 120dfb5178fSStanislav Galabov sc->ifp[phy] = NULL; 121dfb5178fSStanislav Galabov sc->ifname[phy] = NULL; 122dfb5178fSStanislav Galabov sc->miibus[phy] = NULL; 123dfb5178fSStanislav Galabov continue; 124dfb5178fSStanislav Galabov } 125dfb5178fSStanislav Galabov sc->ifp[phy] = if_alloc(IFT_ETHER); 1260774131eSMichael Zhilin if (sc->ifp[phy] == NULL) { 1270774131eSMichael Zhilin device_printf(sc->sc_dev, "couldn't allocate ifnet structure\n"); 1280774131eSMichael Zhilin err = ENOMEM; 1290774131eSMichael Zhilin break; 1300774131eSMichael Zhilin } 1310774131eSMichael Zhilin 132dfb5178fSStanislav Galabov sc->ifp[phy]->if_softc = sc; 133dfb5178fSStanislav Galabov sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST | 134dfb5178fSStanislav Galabov IFF_DRV_RUNNING | IFF_SIMPLEX; 135dfb5178fSStanislav Galabov sc->ifname[phy] = malloc(strlen(name) + 1, M_DEVBUF, M_WAITOK); 136dfb5178fSStanislav Galabov bcopy(name, sc->ifname[phy], strlen(name) + 1); 137dfb5178fSStanislav Galabov if_initname(sc->ifp[phy], sc->ifname[phy], 138dfb5178fSStanislav Galabov mtkswitch_portforphy(phy)); 139dfb5178fSStanislav Galabov err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy], 140dfb5178fSStanislav Galabov mtkswitch_ifmedia_upd, mtkswitch_ifmedia_sts, 141dfb5178fSStanislav Galabov BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0); 142dfb5178fSStanislav Galabov if (err != 0) { 143dfb5178fSStanislav Galabov device_printf(sc->sc_dev, 144dfb5178fSStanislav Galabov "attaching PHY %d failed\n", 145dfb5178fSStanislav Galabov phy); 146dfb5178fSStanislav Galabov } else { 147dfb5178fSStanislav Galabov DPRINTF(sc->sc_dev, "%s attached to pseudo interface " 148dfb5178fSStanislav Galabov "%s\n", device_get_nameunit(sc->miibus[phy]), 149dfb5178fSStanislav Galabov sc->ifp[phy]->if_xname); 150dfb5178fSStanislav Galabov } 151dfb5178fSStanislav Galabov } 152dfb5178fSStanislav Galabov return (err); 153dfb5178fSStanislav Galabov } 154dfb5178fSStanislav Galabov 155dfb5178fSStanislav Galabov static int 156dfb5178fSStanislav Galabov mtkswitch_set_vlan_mode(struct mtkswitch_softc *sc, uint32_t mode) 157dfb5178fSStanislav Galabov { 158dfb5178fSStanislav Galabov 159dfb5178fSStanislav Galabov /* Check for invalid modes. */ 160dfb5178fSStanislav Galabov if ((mode & sc->info.es_vlan_caps) != mode) 161dfb5178fSStanislav Galabov return (EINVAL); 162dfb5178fSStanislav Galabov 163dfb5178fSStanislav Galabov sc->vlan_mode = mode; 164dfb5178fSStanislav Galabov 165dfb5178fSStanislav Galabov /* Reset VLANs. */ 166dfb5178fSStanislav Galabov sc->hal.mtkswitch_vlan_init_hw(sc); 167dfb5178fSStanislav Galabov 168dfb5178fSStanislav Galabov return (0); 169dfb5178fSStanislav Galabov } 170dfb5178fSStanislav Galabov 171dfb5178fSStanislav Galabov static int 172dfb5178fSStanislav Galabov mtkswitch_attach(device_t dev) 173dfb5178fSStanislav Galabov { 174dfb5178fSStanislav Galabov struct mtkswitch_softc *sc; 175dfb5178fSStanislav Galabov int err = 0; 176dfb5178fSStanislav Galabov int port, rid; 177dfb5178fSStanislav Galabov 178dfb5178fSStanislav Galabov sc = device_get_softc(dev); 179dfb5178fSStanislav Galabov 180dfb5178fSStanislav Galabov /* sc->sc_switchtype is already decided in mtkswitch_probe() */ 181dfb5178fSStanislav Galabov sc->numports = MTKSWITCH_MAX_PORTS; 182dfb5178fSStanislav Galabov sc->numphys = MTKSWITCH_MAX_PHYS; 183dfb5178fSStanislav Galabov sc->cpuport = MTKSWITCH_CPU_PORT; 184dfb5178fSStanislav Galabov sc->sc_dev = dev; 185dfb5178fSStanislav Galabov 186dfb5178fSStanislav Galabov /* Attach switch related functions */ 187dfb5178fSStanislav Galabov if (sc->sc_switchtype == MTK_SWITCH_NONE) { 188dfb5178fSStanislav Galabov device_printf(dev, "Unknown switch type\n"); 189dfb5178fSStanislav Galabov return (ENXIO); 190dfb5178fSStanislav Galabov } 191dfb5178fSStanislav Galabov 192dfb5178fSStanislav Galabov if (sc->sc_switchtype == MTK_SWITCH_MT7620 || 193dfb5178fSStanislav Galabov sc->sc_switchtype == MTK_SWITCH_MT7621) 194dfb5178fSStanislav Galabov mtk_attach_switch_mt7620(sc); 195dfb5178fSStanislav Galabov else 196dfb5178fSStanislav Galabov mtk_attach_switch_rt3050(sc); 197dfb5178fSStanislav Galabov 198dfb5178fSStanislav Galabov /* Allocate resources */ 199dfb5178fSStanislav Galabov rid = 0; 200dfb5178fSStanislav Galabov sc->sc_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, 201dfb5178fSStanislav Galabov RF_ACTIVE); 202dfb5178fSStanislav Galabov if (sc->sc_res == NULL) { 203dfb5178fSStanislav Galabov device_printf(dev, "could not map memory\n"); 204dfb5178fSStanislav Galabov return (ENXIO); 205dfb5178fSStanislav Galabov } 206dfb5178fSStanislav Galabov 207dfb5178fSStanislav Galabov mtx_init(&sc->sc_mtx, "mtkswitch", NULL, MTX_DEF); 208dfb5178fSStanislav Galabov 209dfb5178fSStanislav Galabov /* Reset the switch */ 210dfb5178fSStanislav Galabov if (sc->hal.mtkswitch_reset(sc)) { 211dfb5178fSStanislav Galabov DPRINTF(dev, "%s: mtkswitch_reset: failed\n", __func__); 212dfb5178fSStanislav Galabov return (ENXIO); 213dfb5178fSStanislav Galabov } 214dfb5178fSStanislav Galabov 215dfb5178fSStanislav Galabov err = sc->hal.mtkswitch_hw_setup(sc); 216dfb5178fSStanislav Galabov DPRINTF(dev, "%s: hw_setup: err=%d\n", __func__, err); 217dfb5178fSStanislav Galabov if (err != 0) 218dfb5178fSStanislav Galabov return (err); 219dfb5178fSStanislav Galabov 220dfb5178fSStanislav Galabov err = sc->hal.mtkswitch_hw_global_setup(sc); 221dfb5178fSStanislav Galabov DPRINTF(dev, "%s: hw_global_setup: err=%d\n", __func__, err); 222dfb5178fSStanislav Galabov if (err != 0) 223dfb5178fSStanislav Galabov return (err); 224dfb5178fSStanislav Galabov 225dfb5178fSStanislav Galabov /* Initialize the switch ports */ 226dfb5178fSStanislav Galabov for (port = 0; port < sc->numports; port++) { 227dfb5178fSStanislav Galabov sc->hal.mtkswitch_port_init(sc, port); 228dfb5178fSStanislav Galabov } 229dfb5178fSStanislav Galabov 230dfb5178fSStanislav Galabov /* Attach the PHYs and complete the bus enumeration */ 231dfb5178fSStanislav Galabov err = mtkswitch_attach_phys(sc); 232dfb5178fSStanislav Galabov DPRINTF(dev, "%s: attach_phys: err=%d\n", __func__, err); 233dfb5178fSStanislav Galabov if (err != 0) 234dfb5178fSStanislav Galabov return (err); 235dfb5178fSStanislav Galabov 236dfb5178fSStanislav Galabov /* Default to ingress filters off. */ 237dfb5178fSStanislav Galabov err = mtkswitch_set_vlan_mode(sc, ETHERSWITCH_VLAN_DOT1Q); 238dfb5178fSStanislav Galabov DPRINTF(dev, "%s: set_vlan_mode: err=%d\n", __func__, err); 239dfb5178fSStanislav Galabov if (err != 0) 240dfb5178fSStanislav Galabov return (err); 241dfb5178fSStanislav Galabov 242dfb5178fSStanislav Galabov bus_generic_probe(dev); 243dfb5178fSStanislav Galabov bus_enumerate_hinted_children(dev); 244dfb5178fSStanislav Galabov err = bus_generic_attach(dev); 245dfb5178fSStanislav Galabov DPRINTF(dev, "%s: bus_generic_attach: err=%d\n", __func__, err); 246dfb5178fSStanislav Galabov if (err != 0) 247dfb5178fSStanislav Galabov return (err); 248dfb5178fSStanislav Galabov 249dfb5178fSStanislav Galabov callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0); 250dfb5178fSStanislav Galabov 251dfb5178fSStanislav Galabov MTKSWITCH_LOCK(sc); 252dfb5178fSStanislav Galabov mtkswitch_tick(sc); 253dfb5178fSStanislav Galabov MTKSWITCH_UNLOCK(sc); 254dfb5178fSStanislav Galabov 255dfb5178fSStanislav Galabov return (0); 256dfb5178fSStanislav Galabov } 257dfb5178fSStanislav Galabov 258dfb5178fSStanislav Galabov static int 259dfb5178fSStanislav Galabov mtkswitch_detach(device_t dev) 260dfb5178fSStanislav Galabov { 261dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 262dfb5178fSStanislav Galabov int phy; 263dfb5178fSStanislav Galabov 264dfb5178fSStanislav Galabov callout_drain(&sc->callout_tick); 265dfb5178fSStanislav Galabov 266dfb5178fSStanislav Galabov for (phy = 0; phy < MTKSWITCH_MAX_PHYS; phy++) { 267dfb5178fSStanislav Galabov if (sc->miibus[phy] != NULL) 268dfb5178fSStanislav Galabov device_delete_child(dev, sc->miibus[phy]); 269dfb5178fSStanislav Galabov if (sc->ifp[phy] != NULL) 270dfb5178fSStanislav Galabov if_free(sc->ifp[phy]); 271dfb5178fSStanislav Galabov free(sc->ifname[phy], M_DEVBUF); 272dfb5178fSStanislav Galabov } 273dfb5178fSStanislav Galabov 274dfb5178fSStanislav Galabov bus_generic_detach(dev); 275dfb5178fSStanislav Galabov mtx_destroy(&sc->sc_mtx); 276dfb5178fSStanislav Galabov 277dfb5178fSStanislav Galabov return (0); 278dfb5178fSStanislav Galabov } 279dfb5178fSStanislav Galabov 280dfb5178fSStanislav Galabov /* PHY <-> port mapping is currently 1:1 */ 281dfb5178fSStanislav Galabov static inline int 282dfb5178fSStanislav Galabov mtkswitch_portforphy(int phy) 283dfb5178fSStanislav Galabov { 284dfb5178fSStanislav Galabov 285dfb5178fSStanislav Galabov return (phy); 286dfb5178fSStanislav Galabov } 287dfb5178fSStanislav Galabov 288dfb5178fSStanislav Galabov static inline int 289dfb5178fSStanislav Galabov mtkswitch_phyforport(int port) 290dfb5178fSStanislav Galabov { 291dfb5178fSStanislav Galabov 292dfb5178fSStanislav Galabov return (port); 293dfb5178fSStanislav Galabov } 294dfb5178fSStanislav Galabov 295dfb5178fSStanislav Galabov static inline struct mii_data * 296dfb5178fSStanislav Galabov mtkswitch_miiforport(struct mtkswitch_softc *sc, int port) 297dfb5178fSStanislav Galabov { 298dfb5178fSStanislav Galabov int phy = mtkswitch_phyforport(port); 299dfb5178fSStanislav Galabov 300dfb5178fSStanislav Galabov if (phy < 0 || phy >= MTKSWITCH_MAX_PHYS || sc->miibus[phy] == NULL) 301dfb5178fSStanislav Galabov return (NULL); 302dfb5178fSStanislav Galabov 303dfb5178fSStanislav Galabov return (device_get_softc(sc->miibus[phy])); 304dfb5178fSStanislav Galabov } 305dfb5178fSStanislav Galabov 306dfb5178fSStanislav Galabov static inline struct ifnet * 307dfb5178fSStanislav Galabov mtkswitch_ifpforport(struct mtkswitch_softc *sc, int port) 308dfb5178fSStanislav Galabov { 309dfb5178fSStanislav Galabov int phy = mtkswitch_phyforport(port); 310dfb5178fSStanislav Galabov 311dfb5178fSStanislav Galabov if (phy < 0 || phy >= MTKSWITCH_MAX_PHYS) 312dfb5178fSStanislav Galabov return (NULL); 313dfb5178fSStanislav Galabov 314dfb5178fSStanislav Galabov return (sc->ifp[phy]); 315dfb5178fSStanislav Galabov } 316dfb5178fSStanislav Galabov 317dfb5178fSStanislav Galabov /* 318dfb5178fSStanislav Galabov * Convert port status to ifmedia. 319dfb5178fSStanislav Galabov */ 320dfb5178fSStanislav Galabov static void 321dfb5178fSStanislav Galabov mtkswitch_update_ifmedia(uint32_t portstatus, u_int *media_status, 322dfb5178fSStanislav Galabov u_int *media_active) 323dfb5178fSStanislav Galabov { 324dfb5178fSStanislav Galabov *media_active = IFM_ETHER; 325dfb5178fSStanislav Galabov *media_status = IFM_AVALID; 326dfb5178fSStanislav Galabov 327dfb5178fSStanislav Galabov if ((portstatus & MTKSWITCH_LINK_UP) != 0) 328dfb5178fSStanislav Galabov *media_status |= IFM_ACTIVE; 329dfb5178fSStanislav Galabov else { 330dfb5178fSStanislav Galabov *media_active |= IFM_NONE; 331dfb5178fSStanislav Galabov return; 332dfb5178fSStanislav Galabov } 333dfb5178fSStanislav Galabov 334dfb5178fSStanislav Galabov switch (portstatus & MTKSWITCH_SPEED_MASK) { 335dfb5178fSStanislav Galabov case MTKSWITCH_SPEED_10: 336dfb5178fSStanislav Galabov *media_active |= IFM_10_T; 337dfb5178fSStanislav Galabov break; 338dfb5178fSStanislav Galabov case MTKSWITCH_SPEED_100: 339dfb5178fSStanislav Galabov *media_active |= IFM_100_TX; 340dfb5178fSStanislav Galabov break; 341dfb5178fSStanislav Galabov case MTKSWITCH_SPEED_1000: 342dfb5178fSStanislav Galabov *media_active |= IFM_1000_T; 343dfb5178fSStanislav Galabov break; 344dfb5178fSStanislav Galabov } 345dfb5178fSStanislav Galabov 346dfb5178fSStanislav Galabov if ((portstatus & MTKSWITCH_DUPLEX) != 0) 347dfb5178fSStanislav Galabov *media_active |= IFM_FDX; 348dfb5178fSStanislav Galabov else 349dfb5178fSStanislav Galabov *media_active |= IFM_HDX; 350dfb5178fSStanislav Galabov 351dfb5178fSStanislav Galabov if ((portstatus & MTKSWITCH_TXFLOW) != 0) 352dfb5178fSStanislav Galabov *media_active |= IFM_ETH_TXPAUSE; 353dfb5178fSStanislav Galabov if ((portstatus & MTKSWITCH_RXFLOW) != 0) 354dfb5178fSStanislav Galabov *media_active |= IFM_ETH_RXPAUSE; 355dfb5178fSStanislav Galabov } 356dfb5178fSStanislav Galabov 357dfb5178fSStanislav Galabov static void 358dfb5178fSStanislav Galabov mtkswitch_miipollstat(struct mtkswitch_softc *sc) 359dfb5178fSStanislav Galabov { 360dfb5178fSStanislav Galabov struct mii_data *mii; 361dfb5178fSStanislav Galabov struct mii_softc *miisc; 362dfb5178fSStanislav Galabov uint32_t portstatus; 363dfb5178fSStanislav Galabov int i, port_flap = 0; 364dfb5178fSStanislav Galabov 365dfb5178fSStanislav Galabov MTKSWITCH_LOCK_ASSERT(sc, MA_OWNED); 366dfb5178fSStanislav Galabov 367dfb5178fSStanislav Galabov for (i = 0; i < sc->numphys; i++) { 368dfb5178fSStanislav Galabov if (sc->miibus[i] == NULL) 369dfb5178fSStanislav Galabov continue; 370dfb5178fSStanislav Galabov mii = device_get_softc(sc->miibus[i]); 371dfb5178fSStanislav Galabov portstatus = sc->hal.mtkswitch_get_port_status(sc, 372dfb5178fSStanislav Galabov mtkswitch_portforphy(i)); 373dfb5178fSStanislav Galabov 374dfb5178fSStanislav Galabov /* If a port has flapped - mark it so we can flush the ATU */ 375dfb5178fSStanislav Galabov if (((mii->mii_media_status & IFM_ACTIVE) == 0 && 376dfb5178fSStanislav Galabov (portstatus & MTKSWITCH_LINK_UP) != 0) || 377dfb5178fSStanislav Galabov ((mii->mii_media_status & IFM_ACTIVE) != 0 && 378dfb5178fSStanislav Galabov (portstatus & MTKSWITCH_LINK_UP) == 0)) { 379dfb5178fSStanislav Galabov port_flap = 1; 380dfb5178fSStanislav Galabov } 381dfb5178fSStanislav Galabov 382dfb5178fSStanislav Galabov mtkswitch_update_ifmedia(portstatus, &mii->mii_media_status, 383dfb5178fSStanislav Galabov &mii->mii_media_active); 384dfb5178fSStanislav Galabov LIST_FOREACH(miisc, &mii->mii_phys, mii_list) { 385dfb5178fSStanislav Galabov if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) != 386dfb5178fSStanislav Galabov miisc->mii_inst) 387dfb5178fSStanislav Galabov continue; 388dfb5178fSStanislav Galabov mii_phy_update(miisc, MII_POLLSTAT); 389dfb5178fSStanislav Galabov } 390dfb5178fSStanislav Galabov } 391dfb5178fSStanislav Galabov 392dfb5178fSStanislav Galabov if (port_flap) 393dfb5178fSStanislav Galabov sc->hal.mtkswitch_atu_flush(sc); 394dfb5178fSStanislav Galabov } 395dfb5178fSStanislav Galabov 396dfb5178fSStanislav Galabov static void 397dfb5178fSStanislav Galabov mtkswitch_tick(void *arg) 398dfb5178fSStanislav Galabov { 399dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = arg; 400dfb5178fSStanislav Galabov 401dfb5178fSStanislav Galabov mtkswitch_miipollstat(sc); 402dfb5178fSStanislav Galabov callout_reset(&sc->callout_tick, hz, mtkswitch_tick, sc); 403dfb5178fSStanislav Galabov } 404dfb5178fSStanislav Galabov 405dfb5178fSStanislav Galabov static void 406dfb5178fSStanislav Galabov mtkswitch_lock(device_t dev) 407dfb5178fSStanislav Galabov { 408dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 409dfb5178fSStanislav Galabov 410dfb5178fSStanislav Galabov MTKSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED); 411dfb5178fSStanislav Galabov MTKSWITCH_LOCK(sc); 412dfb5178fSStanislav Galabov } 413dfb5178fSStanislav Galabov 414dfb5178fSStanislav Galabov static void 415dfb5178fSStanislav Galabov mtkswitch_unlock(device_t dev) 416dfb5178fSStanislav Galabov { 417dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 418dfb5178fSStanislav Galabov 419dfb5178fSStanislav Galabov MTKSWITCH_LOCK_ASSERT(sc, MA_OWNED); 420dfb5178fSStanislav Galabov MTKSWITCH_UNLOCK(sc); 421dfb5178fSStanislav Galabov } 422dfb5178fSStanislav Galabov 423dfb5178fSStanislav Galabov static etherswitch_info_t * 424dfb5178fSStanislav Galabov mtkswitch_getinfo(device_t dev) 425dfb5178fSStanislav Galabov { 426dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 427dfb5178fSStanislav Galabov 428dfb5178fSStanislav Galabov return (&sc->info); 429dfb5178fSStanislav Galabov } 430dfb5178fSStanislav Galabov 431dfb5178fSStanislav Galabov static inline int 432dfb5178fSStanislav Galabov mtkswitch_is_cpuport(struct mtkswitch_softc *sc, int port) 433dfb5178fSStanislav Galabov { 434dfb5178fSStanislav Galabov 435dfb5178fSStanislav Galabov return (sc->cpuport == port); 436dfb5178fSStanislav Galabov } 437dfb5178fSStanislav Galabov 438dfb5178fSStanislav Galabov static int 439dfb5178fSStanislav Galabov mtkswitch_getport(device_t dev, etherswitch_port_t *p) 440dfb5178fSStanislav Galabov { 441dfb5178fSStanislav Galabov struct mtkswitch_softc *sc; 442dfb5178fSStanislav Galabov struct mii_data *mii; 443dfb5178fSStanislav Galabov struct ifmediareq *ifmr; 444dfb5178fSStanislav Galabov int err; 445dfb5178fSStanislav Galabov 446dfb5178fSStanislav Galabov sc = device_get_softc(dev); 447dfb5178fSStanislav Galabov if (p->es_port < 0 || p->es_port > sc->info.es_nports) 448dfb5178fSStanislav Galabov return (ENXIO); 449dfb5178fSStanislav Galabov 450dfb5178fSStanislav Galabov err = sc->hal.mtkswitch_port_vlan_get(sc, p); 451dfb5178fSStanislav Galabov if (err != 0) 452dfb5178fSStanislav Galabov return (err); 453dfb5178fSStanislav Galabov 454dfb5178fSStanislav Galabov mii = mtkswitch_miiforport(sc, p->es_port); 455dfb5178fSStanislav Galabov if (mtkswitch_is_cpuport(sc, p->es_port)) { 456dfb5178fSStanislav Galabov /* fill in fixed values for CPU port */ 457dfb5178fSStanislav Galabov /* XXX is this valid in all cases? */ 458dfb5178fSStanislav Galabov p->es_flags |= ETHERSWITCH_PORT_CPU; 459dfb5178fSStanislav Galabov ifmr = &p->es_ifmr; 460dfb5178fSStanislav Galabov ifmr->ifm_count = 0; 461dfb5178fSStanislav Galabov ifmr->ifm_current = ifmr->ifm_active = 462dfb5178fSStanislav Galabov IFM_ETHER | IFM_1000_T | IFM_FDX; 463dfb5178fSStanislav Galabov ifmr->ifm_mask = 0; 464dfb5178fSStanislav Galabov ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID; 465dfb5178fSStanislav Galabov } else if (mii != NULL) { 466dfb5178fSStanislav Galabov err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr, 467dfb5178fSStanislav Galabov &mii->mii_media, SIOCGIFMEDIA); 468dfb5178fSStanislav Galabov if (err) 469dfb5178fSStanislav Galabov return (err); 470dfb5178fSStanislav Galabov } else { 471dfb5178fSStanislav Galabov ifmr = &p->es_ifmr; 472dfb5178fSStanislav Galabov ifmr->ifm_count = 0; 473dfb5178fSStanislav Galabov ifmr->ifm_current = ifmr->ifm_active = IFM_NONE; 474dfb5178fSStanislav Galabov ifmr->ifm_mask = 0; 475dfb5178fSStanislav Galabov ifmr->ifm_status = 0; 476dfb5178fSStanislav Galabov } 477dfb5178fSStanislav Galabov return (0); 478dfb5178fSStanislav Galabov } 479dfb5178fSStanislav Galabov 480dfb5178fSStanislav Galabov static int 481dfb5178fSStanislav Galabov mtkswitch_setport(device_t dev, etherswitch_port_t *p) 482dfb5178fSStanislav Galabov { 483dfb5178fSStanislav Galabov int err; 484dfb5178fSStanislav Galabov struct mtkswitch_softc *sc; 485dfb5178fSStanislav Galabov struct ifmedia *ifm; 486dfb5178fSStanislav Galabov struct mii_data *mii; 487dfb5178fSStanislav Galabov struct ifnet *ifp; 488dfb5178fSStanislav Galabov 489dfb5178fSStanislav Galabov sc = device_get_softc(dev); 490dfb5178fSStanislav Galabov if (p->es_port < 0 || p->es_port > sc->info.es_nports) 491dfb5178fSStanislav Galabov return (ENXIO); 492dfb5178fSStanislav Galabov 493dfb5178fSStanislav Galabov /* Port flags. */ 494dfb5178fSStanislav Galabov if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) { 495dfb5178fSStanislav Galabov err = sc->hal.mtkswitch_port_vlan_setup(sc, p); 496dfb5178fSStanislav Galabov if (err) 497dfb5178fSStanislav Galabov return (err); 498dfb5178fSStanislav Galabov } 499dfb5178fSStanislav Galabov 500dfb5178fSStanislav Galabov /* Do not allow media changes on CPU port. */ 501dfb5178fSStanislav Galabov if (mtkswitch_is_cpuport(sc, p->es_port)) 502dfb5178fSStanislav Galabov return (0); 503dfb5178fSStanislav Galabov 504dfb5178fSStanislav Galabov mii = mtkswitch_miiforport(sc, p->es_port); 505dfb5178fSStanislav Galabov if (mii == NULL) 506dfb5178fSStanislav Galabov return (ENXIO); 507dfb5178fSStanislav Galabov 508dfb5178fSStanislav Galabov ifp = mtkswitch_ifpforport(sc, p->es_port); 509dfb5178fSStanislav Galabov 510dfb5178fSStanislav Galabov ifm = &mii->mii_media; 511dfb5178fSStanislav Galabov return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA)); 512dfb5178fSStanislav Galabov } 513dfb5178fSStanislav Galabov 514dfb5178fSStanislav Galabov static void 515dfb5178fSStanislav Galabov mtkswitch_statchg(device_t dev) 516dfb5178fSStanislav Galabov { 517dfb5178fSStanislav Galabov 518dfb5178fSStanislav Galabov DPRINTF(dev, "%s\n", __func__); 519dfb5178fSStanislav Galabov } 520dfb5178fSStanislav Galabov 521dfb5178fSStanislav Galabov static int 522dfb5178fSStanislav Galabov mtkswitch_ifmedia_upd(struct ifnet *ifp) 523dfb5178fSStanislav Galabov { 524dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = ifp->if_softc; 525dfb5178fSStanislav Galabov struct mii_data *mii = mtkswitch_miiforport(sc, ifp->if_dunit); 526dfb5178fSStanislav Galabov 527dfb5178fSStanislav Galabov if (mii == NULL) 528dfb5178fSStanislav Galabov return (ENXIO); 529dfb5178fSStanislav Galabov mii_mediachg(mii); 530dfb5178fSStanislav Galabov return (0); 531dfb5178fSStanislav Galabov } 532dfb5178fSStanislav Galabov 533dfb5178fSStanislav Galabov static void 534dfb5178fSStanislav Galabov mtkswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 535dfb5178fSStanislav Galabov { 536dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = ifp->if_softc; 537dfb5178fSStanislav Galabov struct mii_data *mii = mtkswitch_miiforport(sc, ifp->if_dunit); 538dfb5178fSStanislav Galabov 539dfb5178fSStanislav Galabov DPRINTF(sc->sc_dev, "%s\n", __func__); 540dfb5178fSStanislav Galabov 541dfb5178fSStanislav Galabov if (mii == NULL) 542dfb5178fSStanislav Galabov return; 543dfb5178fSStanislav Galabov mii_pollstat(mii); 544dfb5178fSStanislav Galabov ifmr->ifm_active = mii->mii_media_active; 545dfb5178fSStanislav Galabov ifmr->ifm_status = mii->mii_media_status; 546dfb5178fSStanislav Galabov } 547dfb5178fSStanislav Galabov 548dfb5178fSStanislav Galabov static int 549dfb5178fSStanislav Galabov mtkswitch_getconf(device_t dev, etherswitch_conf_t *conf) 550dfb5178fSStanislav Galabov { 551dfb5178fSStanislav Galabov struct mtkswitch_softc *sc; 552dfb5178fSStanislav Galabov 553dfb5178fSStanislav Galabov sc = device_get_softc(dev); 554dfb5178fSStanislav Galabov 555dfb5178fSStanislav Galabov /* Return the VLAN mode. */ 556dfb5178fSStanislav Galabov conf->cmd = ETHERSWITCH_CONF_VLAN_MODE; 557dfb5178fSStanislav Galabov conf->vlan_mode = sc->vlan_mode; 558dfb5178fSStanislav Galabov 559dfb5178fSStanislav Galabov return (0); 560dfb5178fSStanislav Galabov } 561dfb5178fSStanislav Galabov 562dfb5178fSStanislav Galabov static int 563dfb5178fSStanislav Galabov mtkswitch_setconf(device_t dev, etherswitch_conf_t *conf) 564dfb5178fSStanislav Galabov { 565dfb5178fSStanislav Galabov struct mtkswitch_softc *sc; 566dfb5178fSStanislav Galabov int err; 567dfb5178fSStanislav Galabov 568dfb5178fSStanislav Galabov sc = device_get_softc(dev); 569dfb5178fSStanislav Galabov 570dfb5178fSStanislav Galabov /* Set the VLAN mode. */ 571dfb5178fSStanislav Galabov if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) { 572dfb5178fSStanislav Galabov err = mtkswitch_set_vlan_mode(sc, conf->vlan_mode); 573dfb5178fSStanislav Galabov if (err != 0) 574dfb5178fSStanislav Galabov return (err); 575dfb5178fSStanislav Galabov } 576dfb5178fSStanislav Galabov 577dfb5178fSStanislav Galabov return (0); 578dfb5178fSStanislav Galabov } 579dfb5178fSStanislav Galabov 580dfb5178fSStanislav Galabov static int 581dfb5178fSStanislav Galabov mtkswitch_getvgroup(device_t dev, etherswitch_vlangroup_t *e) 582dfb5178fSStanislav Galabov { 583dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 584dfb5178fSStanislav Galabov 585dfb5178fSStanislav Galabov return (sc->hal.mtkswitch_vlan_getvgroup(sc, e)); 586dfb5178fSStanislav Galabov } 587dfb5178fSStanislav Galabov 588dfb5178fSStanislav Galabov static int 589dfb5178fSStanislav Galabov mtkswitch_setvgroup(device_t dev, etherswitch_vlangroup_t *e) 590dfb5178fSStanislav Galabov { 591dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 592dfb5178fSStanislav Galabov 593dfb5178fSStanislav Galabov return (sc->hal.mtkswitch_vlan_setvgroup(sc, e)); 594dfb5178fSStanislav Galabov } 595dfb5178fSStanislav Galabov 596dfb5178fSStanislav Galabov static int 597dfb5178fSStanislav Galabov mtkswitch_readphy(device_t dev, int phy, int reg) 598dfb5178fSStanislav Galabov { 599dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 600dfb5178fSStanislav Galabov 601dfb5178fSStanislav Galabov return (sc->hal.mtkswitch_phy_read(dev, phy, reg)); 602dfb5178fSStanislav Galabov } 603dfb5178fSStanislav Galabov 604dfb5178fSStanislav Galabov static int 605dfb5178fSStanislav Galabov mtkswitch_writephy(device_t dev, int phy, int reg, int val) 606dfb5178fSStanislav Galabov { 607dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 608dfb5178fSStanislav Galabov 609dfb5178fSStanislav Galabov return (sc->hal.mtkswitch_phy_write(dev, phy, reg, val)); 610dfb5178fSStanislav Galabov } 611dfb5178fSStanislav Galabov 612dfb5178fSStanislav Galabov static int 613dfb5178fSStanislav Galabov mtkswitch_readreg(device_t dev, int addr) 614dfb5178fSStanislav Galabov { 615dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 616dfb5178fSStanislav Galabov 617dfb5178fSStanislav Galabov return (sc->hal.mtkswitch_reg_read(dev, addr)); 618dfb5178fSStanislav Galabov } 619dfb5178fSStanislav Galabov 620dfb5178fSStanislav Galabov static int 621dfb5178fSStanislav Galabov mtkswitch_writereg(device_t dev, int addr, int value) 622dfb5178fSStanislav Galabov { 623dfb5178fSStanislav Galabov struct mtkswitch_softc *sc = device_get_softc(dev); 624dfb5178fSStanislav Galabov 625dfb5178fSStanislav Galabov return (sc->hal.mtkswitch_reg_write(dev, addr, value)); 626dfb5178fSStanislav Galabov } 627dfb5178fSStanislav Galabov 628dfb5178fSStanislav Galabov static device_method_t mtkswitch_methods[] = { 629dfb5178fSStanislav Galabov /* Device interface */ 630dfb5178fSStanislav Galabov DEVMETHOD(device_probe, mtkswitch_probe), 631dfb5178fSStanislav Galabov DEVMETHOD(device_attach, mtkswitch_attach), 632dfb5178fSStanislav Galabov DEVMETHOD(device_detach, mtkswitch_detach), 633dfb5178fSStanislav Galabov 634dfb5178fSStanislav Galabov /* bus interface */ 635dfb5178fSStanislav Galabov DEVMETHOD(bus_add_child, device_add_child_ordered), 636dfb5178fSStanislav Galabov 637dfb5178fSStanislav Galabov /* MII interface */ 638dfb5178fSStanislav Galabov DEVMETHOD(miibus_readreg, mtkswitch_readphy), 639dfb5178fSStanislav Galabov DEVMETHOD(miibus_writereg, mtkswitch_writephy), 640dfb5178fSStanislav Galabov DEVMETHOD(miibus_statchg, mtkswitch_statchg), 641dfb5178fSStanislav Galabov 642dfb5178fSStanislav Galabov /* MDIO interface */ 643dfb5178fSStanislav Galabov DEVMETHOD(mdio_readreg, mtkswitch_readphy), 644dfb5178fSStanislav Galabov DEVMETHOD(mdio_writereg, mtkswitch_writephy), 645dfb5178fSStanislav Galabov 646dfb5178fSStanislav Galabov /* ehterswitch interface */ 647dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_lock, mtkswitch_lock), 648dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_unlock, mtkswitch_unlock), 649dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_getinfo, mtkswitch_getinfo), 650dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_readreg, mtkswitch_readreg), 651dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_writereg, mtkswitch_writereg), 652dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_readphyreg, mtkswitch_readphy), 653dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_writephyreg, mtkswitch_writephy), 654dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_getport, mtkswitch_getport), 655dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_setport, mtkswitch_setport), 656dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_getvgroup, mtkswitch_getvgroup), 657dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_setvgroup, mtkswitch_setvgroup), 658dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_getconf, mtkswitch_getconf), 659dfb5178fSStanislav Galabov DEVMETHOD(etherswitch_setconf, mtkswitch_setconf), 660dfb5178fSStanislav Galabov 661dfb5178fSStanislav Galabov DEVMETHOD_END 662dfb5178fSStanislav Galabov }; 663dfb5178fSStanislav Galabov 664dfb5178fSStanislav Galabov DEFINE_CLASS_0(mtkswitch, mtkswitch_driver, mtkswitch_methods, 665dfb5178fSStanislav Galabov sizeof(struct mtkswitch_softc)); 666dfb5178fSStanislav Galabov static devclass_t mtkswitch_devclass; 667dfb5178fSStanislav Galabov 668dfb5178fSStanislav Galabov DRIVER_MODULE(mtkswitch, simplebus, mtkswitch_driver, mtkswitch_devclass, 0, 0); 6693e38757dSJohn Baldwin DRIVER_MODULE(miibus, mtkswitch, miibus_driver, 0, 0); 6708933f7d6SJohn Baldwin DRIVER_MODULE(mdio, mtkswitch, mdio_driver, 0, 0); 671dfb5178fSStanislav Galabov DRIVER_MODULE(etherswitch, mtkswitch, etherswitch_driver, etherswitch_devclass, 672dfb5178fSStanislav Galabov 0, 0); 673dfb5178fSStanislav Galabov MODULE_VERSION(mtkswitch, 1); 674dfb5178fSStanislav Galabov MODULE_DEPEND(mtkswitch, miibus, 1, 1, 1); 675dfb5178fSStanislav Galabov MODULE_DEPEND(mtkswitch, etherswitch, 1, 1, 1); 676