1a043e8c7SAdrian Chadd /*- 2a043e8c7SAdrian Chadd * Copyright (c) 2011-2012 Stefan Bethke. 3a043e8c7SAdrian Chadd * Copyright (c) 2012 Adrian Chadd. 4a043e8c7SAdrian Chadd * All rights reserved. 5a043e8c7SAdrian Chadd * 6a043e8c7SAdrian Chadd * Redistribution and use in source and binary forms, with or without 7a043e8c7SAdrian Chadd * modification, are permitted provided that the following conditions 8a043e8c7SAdrian Chadd * are met: 9a043e8c7SAdrian Chadd * 1. Redistributions of source code must retain the above copyright 10a043e8c7SAdrian Chadd * notice, this list of conditions and the following disclaimer. 11a043e8c7SAdrian Chadd * 2. Redistributions in binary form must reproduce the above copyright 12a043e8c7SAdrian Chadd * notice, this list of conditions and the following disclaimer in the 13a043e8c7SAdrian Chadd * documentation and/or other materials provided with the distribution. 14a043e8c7SAdrian Chadd * 15a043e8c7SAdrian Chadd * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16a043e8c7SAdrian Chadd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17a043e8c7SAdrian Chadd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18a043e8c7SAdrian Chadd * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19a043e8c7SAdrian Chadd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20a043e8c7SAdrian Chadd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21a043e8c7SAdrian Chadd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22a043e8c7SAdrian Chadd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23a043e8c7SAdrian Chadd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24a043e8c7SAdrian Chadd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25a043e8c7SAdrian Chadd * SUCH DAMAGE. 26a043e8c7SAdrian Chadd * 27a043e8c7SAdrian Chadd * $FreeBSD$ 28a043e8c7SAdrian Chadd */ 29a043e8c7SAdrian Chadd 30a043e8c7SAdrian Chadd #include <sys/param.h> 31a043e8c7SAdrian Chadd #include <sys/bus.h> 32a043e8c7SAdrian Chadd #include <sys/errno.h> 33a043e8c7SAdrian Chadd #include <sys/kernel.h> 34a043e8c7SAdrian Chadd #include <sys/module.h> 35a043e8c7SAdrian Chadd #include <sys/socket.h> 36a043e8c7SAdrian Chadd #include <sys/sockio.h> 37a043e8c7SAdrian Chadd #include <sys/sysctl.h> 38a043e8c7SAdrian Chadd #include <sys/systm.h> 39a043e8c7SAdrian Chadd 40a043e8c7SAdrian Chadd #include <net/if.h> 41a043e8c7SAdrian Chadd #include <net/if_arp.h> 42a043e8c7SAdrian Chadd #include <net/ethernet.h> 43a043e8c7SAdrian Chadd #include <net/if_dl.h> 44a043e8c7SAdrian Chadd #include <net/if_media.h> 45a043e8c7SAdrian Chadd #include <net/if_types.h> 46a043e8c7SAdrian Chadd 47a043e8c7SAdrian Chadd #include <machine/bus.h> 48a043e8c7SAdrian Chadd #include <dev/iicbus/iic.h> 49a043e8c7SAdrian Chadd #include <dev/iicbus/iiconf.h> 50a043e8c7SAdrian Chadd #include <dev/iicbus/iicbus.h> 51a043e8c7SAdrian Chadd #include <dev/mii/mii.h> 52a043e8c7SAdrian Chadd #include <dev/mii/miivar.h> 53a043e8c7SAdrian Chadd #include <dev/etherswitch/mdio.h> 54a043e8c7SAdrian Chadd 55a043e8c7SAdrian Chadd #include <dev/etherswitch/etherswitch.h> 56a043e8c7SAdrian Chadd 57a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitchreg.h> 58a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitchvar.h> 59a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_reg.h> 60a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_phy.h> 61b9f07b86SLuiz Otavio O Souza #include <dev/etherswitch/arswitch/arswitch_vlans.h> 62a043e8c7SAdrian Chadd 6327a2ecaaSAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_7240.h> 64a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_8216.h> 65a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_8226.h> 66a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_8316.h> 67*b2152161SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_9340.h> 68a043e8c7SAdrian Chadd 69a043e8c7SAdrian Chadd #include "mdio_if.h" 70a043e8c7SAdrian Chadd #include "miibus_if.h" 71a043e8c7SAdrian Chadd #include "etherswitch_if.h" 72a043e8c7SAdrian Chadd 73a043e8c7SAdrian Chadd #if defined(DEBUG) 74a043e8c7SAdrian Chadd static SYSCTL_NODE(_debug, OID_AUTO, arswitch, CTLFLAG_RD, 0, "arswitch"); 75a043e8c7SAdrian Chadd #endif 76a043e8c7SAdrian Chadd 77a043e8c7SAdrian Chadd static inline int arswitch_portforphy(int phy); 78a043e8c7SAdrian Chadd static void arswitch_tick(void *arg); 79a043e8c7SAdrian Chadd static int arswitch_ifmedia_upd(struct ifnet *); 80a043e8c7SAdrian Chadd static void arswitch_ifmedia_sts(struct ifnet *, struct ifmediareq *); 81a043e8c7SAdrian Chadd 82a043e8c7SAdrian Chadd static int 83a043e8c7SAdrian Chadd arswitch_probe(device_t dev) 84a043e8c7SAdrian Chadd { 85a043e8c7SAdrian Chadd struct arswitch_softc *sc; 86a043e8c7SAdrian Chadd uint32_t id; 87a043e8c7SAdrian Chadd char *chipname, desc[256]; 88a043e8c7SAdrian Chadd 89a043e8c7SAdrian Chadd sc = device_get_softc(dev); 90a043e8c7SAdrian Chadd bzero(sc, sizeof(*sc)); 91a043e8c7SAdrian Chadd sc->page = -1; 9227a2ecaaSAdrian Chadd 9327a2ecaaSAdrian Chadd /* AR7240 probe */ 9427a2ecaaSAdrian Chadd if (ar7240_probe(dev) == 0) { 9527a2ecaaSAdrian Chadd chipname = "AR7240"; 9627a2ecaaSAdrian Chadd sc->sc_switchtype = AR8X16_SWITCH_AR7240; 97*b2152161SAdrian Chadd sc->is_internal_switch = 1; 98*b2152161SAdrian Chadd id = 0; 99*b2152161SAdrian Chadd goto done; 100*b2152161SAdrian Chadd } 101*b2152161SAdrian Chadd 102*b2152161SAdrian Chadd /* AR9340 probe */ 103*b2152161SAdrian Chadd if (ar9340_probe(dev) == 0) { 104*b2152161SAdrian Chadd chipname = "AR9340"; 105*b2152161SAdrian Chadd sc->sc_switchtype = AR8X16_SWITCH_AR9340; 106*b2152161SAdrian Chadd sc->is_internal_switch = 1; 107daa4deacSAleksandr Rybalko id = 0; 10827a2ecaaSAdrian Chadd goto done; 10927a2ecaaSAdrian Chadd } 11027a2ecaaSAdrian Chadd 11127a2ecaaSAdrian Chadd /* AR8xxx probe */ 112a043e8c7SAdrian Chadd id = arswitch_readreg(dev, AR8X16_REG_MASK_CTRL); 113*b2152161SAdrian Chadd switch (id & (AR8X16_MASK_CTRL_VER_MASK | AR8X16_MASK_CTRL_REV_MASK)) { 114*b2152161SAdrian Chadd case 0x0101: 115a043e8c7SAdrian Chadd chipname = "AR8216"; 116a043e8c7SAdrian Chadd sc->sc_switchtype = AR8X16_SWITCH_AR8216; 117a043e8c7SAdrian Chadd break; 118*b2152161SAdrian Chadd case 0x0201: 119a043e8c7SAdrian Chadd chipname = "AR8226"; 120a043e8c7SAdrian Chadd sc->sc_switchtype = AR8X16_SWITCH_AR8226; 121a043e8c7SAdrian Chadd break; 122*b2152161SAdrian Chadd /* 0x0301 - AR8236 */ 123*b2152161SAdrian Chadd case 0x1000: 124*b2152161SAdrian Chadd case 0x1001: 125a043e8c7SAdrian Chadd chipname = "AR8316"; 126a043e8c7SAdrian Chadd sc->sc_switchtype = AR8X16_SWITCH_AR8316; 127a043e8c7SAdrian Chadd break; 128a043e8c7SAdrian Chadd default: 129a043e8c7SAdrian Chadd chipname = NULL; 130a043e8c7SAdrian Chadd } 13127a2ecaaSAdrian Chadd 13227a2ecaaSAdrian Chadd done: 133*b2152161SAdrian Chadd 134*b2152161SAdrian Chadd DPRINTF(dev, "chipname=%s, id=%08x\n", chipname, id); 135a043e8c7SAdrian Chadd if (chipname != NULL) { 136a043e8c7SAdrian Chadd snprintf(desc, sizeof(desc), 137a043e8c7SAdrian Chadd "Atheros %s Ethernet Switch", 138a043e8c7SAdrian Chadd chipname); 139a043e8c7SAdrian Chadd device_set_desc_copy(dev, desc); 140a043e8c7SAdrian Chadd return (BUS_PROBE_DEFAULT); 141a043e8c7SAdrian Chadd } 142a043e8c7SAdrian Chadd return (ENXIO); 143a043e8c7SAdrian Chadd } 144a043e8c7SAdrian Chadd 145a043e8c7SAdrian Chadd static int 146a043e8c7SAdrian Chadd arswitch_attach_phys(struct arswitch_softc *sc) 147a043e8c7SAdrian Chadd { 148a043e8c7SAdrian Chadd int phy, err = 0; 149a043e8c7SAdrian Chadd char name[IFNAMSIZ]; 150a043e8c7SAdrian Chadd 151a043e8c7SAdrian Chadd /* PHYs need an interface, so we generate a dummy one */ 152a043e8c7SAdrian Chadd snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev)); 153a043e8c7SAdrian Chadd for (phy = 0; phy < sc->numphys; phy++) { 154a043e8c7SAdrian Chadd sc->ifp[phy] = if_alloc(IFT_ETHER); 155a043e8c7SAdrian Chadd sc->ifp[phy]->if_softc = sc; 156a043e8c7SAdrian Chadd sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST | 157a043e8c7SAdrian Chadd IFF_DRV_RUNNING | IFF_SIMPLEX; 158a043e8c7SAdrian Chadd sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK); 159a043e8c7SAdrian Chadd bcopy(name, sc->ifname[phy], strlen(name)+1); 160a043e8c7SAdrian Chadd if_initname(sc->ifp[phy], sc->ifname[phy], 161a043e8c7SAdrian Chadd arswitch_portforphy(phy)); 162a043e8c7SAdrian Chadd err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy], 163a043e8c7SAdrian Chadd arswitch_ifmedia_upd, arswitch_ifmedia_sts, \ 164a043e8c7SAdrian Chadd BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0); 165a043e8c7SAdrian Chadd DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n", 166a043e8c7SAdrian Chadd device_get_nameunit(sc->miibus[phy]), 167a043e8c7SAdrian Chadd sc->ifp[phy]->if_xname); 168a043e8c7SAdrian Chadd if (err != 0) { 169a043e8c7SAdrian Chadd device_printf(sc->sc_dev, 170a043e8c7SAdrian Chadd "attaching PHY %d failed\n", 171a043e8c7SAdrian Chadd phy); 172a043e8c7SAdrian Chadd } 173a043e8c7SAdrian Chadd } 174a043e8c7SAdrian Chadd return (err); 175a043e8c7SAdrian Chadd } 176a043e8c7SAdrian Chadd 177a043e8c7SAdrian Chadd static int 178b9f07b86SLuiz Otavio O Souza arswitch_reset(device_t dev) 179b9f07b86SLuiz Otavio O Souza { 180b9f07b86SLuiz Otavio O Souza 181b9f07b86SLuiz Otavio O Souza arswitch_writereg(dev, AR8X16_REG_MASK_CTRL, 182b9f07b86SLuiz Otavio O Souza AR8X16_MASK_CTRL_SOFT_RESET); 183b9f07b86SLuiz Otavio O Souza DELAY(1000); 184b9f07b86SLuiz Otavio O Souza if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) & 185b9f07b86SLuiz Otavio O Souza AR8X16_MASK_CTRL_SOFT_RESET) { 186b9f07b86SLuiz Otavio O Souza device_printf(dev, "unable to reset switch\n"); 187b9f07b86SLuiz Otavio O Souza return (-1); 188b9f07b86SLuiz Otavio O Souza } 189b9f07b86SLuiz Otavio O Souza return (0); 190b9f07b86SLuiz Otavio O Souza } 191b9f07b86SLuiz Otavio O Souza 192b9f07b86SLuiz Otavio O Souza static int 193b9f07b86SLuiz Otavio O Souza arswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode) 194b9f07b86SLuiz Otavio O Souza { 195b9f07b86SLuiz Otavio O Souza 196b9f07b86SLuiz Otavio O Souza /* Check for invalid modes. */ 197b9f07b86SLuiz Otavio O Souza if ((mode & sc->info.es_vlan_caps) != mode) 198b9f07b86SLuiz Otavio O Souza return (EINVAL); 199b9f07b86SLuiz Otavio O Souza 200b9f07b86SLuiz Otavio O Souza switch (mode) { 201b9f07b86SLuiz Otavio O Souza case ETHERSWITCH_VLAN_DOT1Q: 202b9f07b86SLuiz Otavio O Souza sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q; 203b9f07b86SLuiz Otavio O Souza break; 204b9f07b86SLuiz Otavio O Souza case ETHERSWITCH_VLAN_PORT: 205b9f07b86SLuiz Otavio O Souza sc->vlan_mode = ETHERSWITCH_VLAN_PORT; 206b9f07b86SLuiz Otavio O Souza break; 207b9f07b86SLuiz Otavio O Souza default: 208b9f07b86SLuiz Otavio O Souza sc->vlan_mode = 0; 209b9f07b86SLuiz Otavio O Souza }; 210b9f07b86SLuiz Otavio O Souza 211b9f07b86SLuiz Otavio O Souza /* Reset VLANs. */ 212b9f07b86SLuiz Otavio O Souza arswitch_reset_vlans(sc); 213b9f07b86SLuiz Otavio O Souza 214b9f07b86SLuiz Otavio O Souza return (0); 215b9f07b86SLuiz Otavio O Souza } 216b9f07b86SLuiz Otavio O Souza 217b9f07b86SLuiz Otavio O Souza static void 218b9f07b86SLuiz Otavio O Souza arswitch_ports_init(struct arswitch_softc *sc) 219b9f07b86SLuiz Otavio O Souza { 220b9f07b86SLuiz Otavio O Souza int port; 221b9f07b86SLuiz Otavio O Souza 222b9f07b86SLuiz Otavio O Souza /* Port0 - CPU */ 223b9f07b86SLuiz Otavio O Souza arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0), 224b9f07b86SLuiz Otavio O Souza (AR8X16_IS_SWITCH(sc, AR8216) ? 225b9f07b86SLuiz Otavio O Souza AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) | 226b9f07b86SLuiz Otavio O Souza (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) | 227b9f07b86SLuiz Otavio O Souza (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) | 228b9f07b86SLuiz Otavio O Souza AR8X16_PORT_STS_RXMAC | 229b9f07b86SLuiz Otavio O Souza AR8X16_PORT_STS_TXMAC | 230b9f07b86SLuiz Otavio O Souza AR8X16_PORT_STS_DUPLEX); 231b9f07b86SLuiz Otavio O Souza arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0), 232b9f07b86SLuiz Otavio O Souza arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) & 233b9f07b86SLuiz Otavio O Souza ~AR8X16_PORT_CTRL_HEADER); 234b9f07b86SLuiz Otavio O Souza 235b9f07b86SLuiz Otavio O Souza for (port = 1; port <= sc->numphys; port++) { 236b9f07b86SLuiz Otavio O Souza /* Set ports to auto negotiation. */ 237b9f07b86SLuiz Otavio O Souza arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port), 238b9f07b86SLuiz Otavio O Souza AR8X16_PORT_STS_LINK_AUTO); 239b9f07b86SLuiz Otavio O Souza arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port), 240b9f07b86SLuiz Otavio O Souza arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) & 241b9f07b86SLuiz Otavio O Souza ~AR8X16_PORT_CTRL_HEADER); 242b9f07b86SLuiz Otavio O Souza } 243b9f07b86SLuiz Otavio O Souza } 244b9f07b86SLuiz Otavio O Souza 245b9f07b86SLuiz Otavio O Souza static int 246a043e8c7SAdrian Chadd arswitch_attach(device_t dev) 247a043e8c7SAdrian Chadd { 248a043e8c7SAdrian Chadd struct arswitch_softc *sc; 249a043e8c7SAdrian Chadd int err = 0; 250a043e8c7SAdrian Chadd 251a043e8c7SAdrian Chadd sc = device_get_softc(dev); 252a043e8c7SAdrian Chadd 253a043e8c7SAdrian Chadd /* sc->sc_switchtype is already decided in arswitch_probe() */ 254a043e8c7SAdrian Chadd sc->sc_dev = dev; 255a043e8c7SAdrian Chadd mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF); 256a043e8c7SAdrian Chadd sc->page = -1; 257a043e8c7SAdrian Chadd strlcpy(sc->info.es_name, device_get_desc(dev), 258a043e8c7SAdrian Chadd sizeof(sc->info.es_name)); 259a043e8c7SAdrian Chadd 260a043e8c7SAdrian Chadd /* 261a043e8c7SAdrian Chadd * Attach switch related functions 262a043e8c7SAdrian Chadd */ 26327a2ecaaSAdrian Chadd if (AR8X16_IS_SWITCH(sc, AR7240)) 26427a2ecaaSAdrian Chadd ar7240_attach(sc); 265*b2152161SAdrian Chadd else if (AR8X16_IS_SWITCH(sc, AR9340)) 266*b2152161SAdrian Chadd ar9340_attach(sc); 26727a2ecaaSAdrian Chadd else if (AR8X16_IS_SWITCH(sc, AR8216)) 268a043e8c7SAdrian Chadd ar8216_attach(sc); 269a043e8c7SAdrian Chadd else if (AR8X16_IS_SWITCH(sc, AR8226)) 270a043e8c7SAdrian Chadd ar8226_attach(sc); 271a043e8c7SAdrian Chadd else if (AR8X16_IS_SWITCH(sc, AR8316)) 272a043e8c7SAdrian Chadd ar8316_attach(sc); 273a043e8c7SAdrian Chadd else 274a043e8c7SAdrian Chadd return (ENXIO); 275a043e8c7SAdrian Chadd 276b9f07b86SLuiz Otavio O Souza /* Common defaults. */ 277a043e8c7SAdrian Chadd sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */ 278a043e8c7SAdrian Chadd 279a043e8c7SAdrian Chadd /* XXX Defaults for externally connected AR8316 */ 280a043e8c7SAdrian Chadd sc->numphys = 4; 281a043e8c7SAdrian Chadd sc->phy4cpu = 1; 282a043e8c7SAdrian Chadd sc->is_rgmii = 1; 283a043e8c7SAdrian Chadd sc->is_gmii = 0; 284*b2152161SAdrian Chadd sc->is_mii = 0; 285a043e8c7SAdrian Chadd 286a043e8c7SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 287a043e8c7SAdrian Chadd "numphys", &sc->numphys); 288a043e8c7SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 289a043e8c7SAdrian Chadd "phy4cpu", &sc->phy4cpu); 290a043e8c7SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 291a043e8c7SAdrian Chadd "is_rgmii", &sc->is_rgmii); 292a043e8c7SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 293a043e8c7SAdrian Chadd "is_gmii", &sc->is_gmii); 294*b2152161SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 295*b2152161SAdrian Chadd "is_mii", &sc->is_mii); 296a043e8c7SAdrian Chadd 297b9f07b86SLuiz Otavio O Souza if (sc->numphys > AR8X16_NUM_PHYS) 298b9f07b86SLuiz Otavio O Souza sc->numphys = AR8X16_NUM_PHYS; 299a043e8c7SAdrian Chadd 300b9f07b86SLuiz Otavio O Souza /* Reset the switch. */ 301b9f07b86SLuiz Otavio O Souza if (arswitch_reset(dev)) 302b9f07b86SLuiz Otavio O Souza return (ENXIO); 303a043e8c7SAdrian Chadd 304*b2152161SAdrian Chadd err = sc->hal.arswitch_hw_setup(sc); 305*b2152161SAdrian Chadd if (err != 0) 306*b2152161SAdrian Chadd return (err); 307*b2152161SAdrian Chadd 308a043e8c7SAdrian Chadd err = sc->hal.arswitch_hw_global_setup(sc); 309a043e8c7SAdrian Chadd if (err != 0) 310a043e8c7SAdrian Chadd return (err); 311a043e8c7SAdrian Chadd 312b9f07b86SLuiz Otavio O Souza /* Initialize the switch ports. */ 313b9f07b86SLuiz Otavio O Souza arswitch_ports_init(sc); 314b9f07b86SLuiz Otavio O Souza 315a043e8c7SAdrian Chadd /* 316a043e8c7SAdrian Chadd * Attach the PHYs and complete the bus enumeration. 317a043e8c7SAdrian Chadd */ 318a043e8c7SAdrian Chadd err = arswitch_attach_phys(sc); 319a043e8c7SAdrian Chadd if (err != 0) 320a043e8c7SAdrian Chadd return (err); 321a043e8c7SAdrian Chadd 322b9f07b86SLuiz Otavio O Souza /* Default to ingress filters off. */ 323b9f07b86SLuiz Otavio O Souza err = arswitch_set_vlan_mode(sc, 0); 324b9f07b86SLuiz Otavio O Souza if (err != 0) 325b9f07b86SLuiz Otavio O Souza return (err); 326b9f07b86SLuiz Otavio O Souza 327a043e8c7SAdrian Chadd bus_generic_probe(dev); 328a043e8c7SAdrian Chadd bus_enumerate_hinted_children(dev); 329a043e8c7SAdrian Chadd err = bus_generic_attach(dev); 330a043e8c7SAdrian Chadd if (err != 0) 331a043e8c7SAdrian Chadd return (err); 332a043e8c7SAdrian Chadd 333a043e8c7SAdrian Chadd callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0); 334454d507aSAleksandr Rybalko 335454d507aSAleksandr Rybalko ARSWITCH_LOCK(sc); 336a043e8c7SAdrian Chadd arswitch_tick(sc); 337454d507aSAleksandr Rybalko ARSWITCH_UNLOCK(sc); 338a043e8c7SAdrian Chadd 339a043e8c7SAdrian Chadd return (err); 340a043e8c7SAdrian Chadd } 341a043e8c7SAdrian Chadd 342a043e8c7SAdrian Chadd static int 343a043e8c7SAdrian Chadd arswitch_detach(device_t dev) 344a043e8c7SAdrian Chadd { 345a043e8c7SAdrian Chadd struct arswitch_softc *sc = device_get_softc(dev); 346a043e8c7SAdrian Chadd int i; 347a043e8c7SAdrian Chadd 348a043e8c7SAdrian Chadd callout_drain(&sc->callout_tick); 349a043e8c7SAdrian Chadd 350a043e8c7SAdrian Chadd for (i=0; i < sc->numphys; i++) { 351a043e8c7SAdrian Chadd if (sc->miibus[i] != NULL) 352a043e8c7SAdrian Chadd device_delete_child(dev, sc->miibus[i]); 353a043e8c7SAdrian Chadd if (sc->ifp[i] != NULL) 354a043e8c7SAdrian Chadd if_free(sc->ifp[i]); 355a043e8c7SAdrian Chadd free(sc->ifname[i], M_DEVBUF); 356a043e8c7SAdrian Chadd } 357a043e8c7SAdrian Chadd 358a043e8c7SAdrian Chadd bus_generic_detach(dev); 359a043e8c7SAdrian Chadd mtx_destroy(&sc->sc_mtx); 360a043e8c7SAdrian Chadd 361a043e8c7SAdrian Chadd return (0); 362a043e8c7SAdrian Chadd } 363a043e8c7SAdrian Chadd 364a043e8c7SAdrian Chadd /* 365a043e8c7SAdrian Chadd * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to 366a043e8c7SAdrian Chadd * port 2, etc. 367a043e8c7SAdrian Chadd */ 368a043e8c7SAdrian Chadd static inline int 369a043e8c7SAdrian Chadd arswitch_portforphy(int phy) 370a043e8c7SAdrian Chadd { 371a043e8c7SAdrian Chadd return (phy+1); 372a043e8c7SAdrian Chadd } 373a043e8c7SAdrian Chadd 374a043e8c7SAdrian Chadd static inline struct mii_data * 375a043e8c7SAdrian Chadd arswitch_miiforport(struct arswitch_softc *sc, int port) 376a043e8c7SAdrian Chadd { 377a043e8c7SAdrian Chadd int phy = port-1; 378a043e8c7SAdrian Chadd 379a043e8c7SAdrian Chadd if (phy < 0 || phy >= sc->numphys) 380a043e8c7SAdrian Chadd return (NULL); 381a043e8c7SAdrian Chadd return (device_get_softc(sc->miibus[phy])); 382a043e8c7SAdrian Chadd } 383a043e8c7SAdrian Chadd 384a043e8c7SAdrian Chadd static inline struct ifnet * 385a043e8c7SAdrian Chadd arswitch_ifpforport(struct arswitch_softc *sc, int port) 386a043e8c7SAdrian Chadd { 387a043e8c7SAdrian Chadd int phy = port-1; 388a043e8c7SAdrian Chadd 389a043e8c7SAdrian Chadd if (phy < 0 || phy >= sc->numphys) 390a043e8c7SAdrian Chadd return (NULL); 391a043e8c7SAdrian Chadd return (sc->ifp[phy]); 392a043e8c7SAdrian Chadd } 393a043e8c7SAdrian Chadd 394a043e8c7SAdrian Chadd /* 395a043e8c7SAdrian Chadd * Convert port status to ifmedia. 396a043e8c7SAdrian Chadd */ 397a043e8c7SAdrian Chadd static void 398a043e8c7SAdrian Chadd arswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active) 399a043e8c7SAdrian Chadd { 400a043e8c7SAdrian Chadd *media_active = IFM_ETHER; 401a043e8c7SAdrian Chadd *media_status = IFM_AVALID; 402a043e8c7SAdrian Chadd 403a043e8c7SAdrian Chadd if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0) 404a043e8c7SAdrian Chadd *media_status |= IFM_ACTIVE; 405a043e8c7SAdrian Chadd else { 406a043e8c7SAdrian Chadd *media_active |= IFM_NONE; 407a043e8c7SAdrian Chadd return; 408a043e8c7SAdrian Chadd } 409a043e8c7SAdrian Chadd switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) { 410a043e8c7SAdrian Chadd case AR8X16_PORT_STS_SPEED_10: 411a043e8c7SAdrian Chadd *media_active |= IFM_10_T; 412a043e8c7SAdrian Chadd break; 413a043e8c7SAdrian Chadd case AR8X16_PORT_STS_SPEED_100: 414a043e8c7SAdrian Chadd *media_active |= IFM_100_TX; 415a043e8c7SAdrian Chadd break; 416a043e8c7SAdrian Chadd case AR8X16_PORT_STS_SPEED_1000: 417a043e8c7SAdrian Chadd *media_active |= IFM_1000_T; 418a043e8c7SAdrian Chadd break; 419a043e8c7SAdrian Chadd } 420a043e8c7SAdrian Chadd if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0) 421a043e8c7SAdrian Chadd *media_active |= IFM_FDX; 422a043e8c7SAdrian Chadd else 423a043e8c7SAdrian Chadd *media_active |= IFM_HDX; 424a043e8c7SAdrian Chadd if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0) 425a043e8c7SAdrian Chadd *media_active |= IFM_ETH_TXPAUSE; 426a043e8c7SAdrian Chadd if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0) 427a043e8c7SAdrian Chadd *media_active |= IFM_ETH_RXPAUSE; 428a043e8c7SAdrian Chadd } 429a043e8c7SAdrian Chadd 430a043e8c7SAdrian Chadd /* 431a043e8c7SAdrian Chadd * Poll the status for all PHYs. We're using the switch port status because 432a043e8c7SAdrian Chadd * thats a lot quicker to read than talking to all the PHYs. Care must be 433a043e8c7SAdrian Chadd * taken that the resulting ifmedia_active is identical to what the PHY will 434a043e8c7SAdrian Chadd * compute, or gratuitous link status changes will occur whenever the PHYs 435a043e8c7SAdrian Chadd * update function is called. 436a043e8c7SAdrian Chadd */ 437a043e8c7SAdrian Chadd static void 438a043e8c7SAdrian Chadd arswitch_miipollstat(struct arswitch_softc *sc) 439a043e8c7SAdrian Chadd { 440a043e8c7SAdrian Chadd int i; 441a043e8c7SAdrian Chadd struct mii_data *mii; 442a043e8c7SAdrian Chadd struct mii_softc *miisc; 443a043e8c7SAdrian Chadd int portstatus; 444a043e8c7SAdrian Chadd 445454d507aSAleksandr Rybalko ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 446454d507aSAleksandr Rybalko 447a043e8c7SAdrian Chadd for (i = 0; i < sc->numphys; i++) { 448a043e8c7SAdrian Chadd if (sc->miibus[i] == NULL) 449a043e8c7SAdrian Chadd continue; 450a043e8c7SAdrian Chadd mii = device_get_softc(sc->miibus[i]); 451a043e8c7SAdrian Chadd portstatus = arswitch_readreg(sc->sc_dev, 452a043e8c7SAdrian Chadd AR8X16_REG_PORT_STS(arswitch_portforphy(i))); 453a043e8c7SAdrian Chadd #if 0 454a043e8c7SAdrian Chadd DPRINTF(sc->sc_dev, "p[%d]=%b\n", 455*b2152161SAdrian Chadd i, 456a043e8c7SAdrian Chadd portstatus, 457a043e8c7SAdrian Chadd "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7" 458a043e8c7SAdrian Chadd "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE"); 459a043e8c7SAdrian Chadd #endif 460a043e8c7SAdrian Chadd arswitch_update_ifmedia(portstatus, &mii->mii_media_status, 461a043e8c7SAdrian Chadd &mii->mii_media_active); 462a043e8c7SAdrian Chadd LIST_FOREACH(miisc, &mii->mii_phys, mii_list) { 463a043e8c7SAdrian Chadd if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) != 464a043e8c7SAdrian Chadd miisc->mii_inst) 465a043e8c7SAdrian Chadd continue; 466a043e8c7SAdrian Chadd mii_phy_update(miisc, MII_POLLSTAT); 467a043e8c7SAdrian Chadd } 468a043e8c7SAdrian Chadd } 469a043e8c7SAdrian Chadd } 470a043e8c7SAdrian Chadd 471a043e8c7SAdrian Chadd static void 472a043e8c7SAdrian Chadd arswitch_tick(void *arg) 473a043e8c7SAdrian Chadd { 474a043e8c7SAdrian Chadd struct arswitch_softc *sc = arg; 475a043e8c7SAdrian Chadd 476a043e8c7SAdrian Chadd arswitch_miipollstat(sc); 477a043e8c7SAdrian Chadd callout_reset(&sc->callout_tick, hz, arswitch_tick, sc); 478a043e8c7SAdrian Chadd } 479a043e8c7SAdrian Chadd 480454d507aSAleksandr Rybalko static void 481454d507aSAleksandr Rybalko arswitch_lock(device_t dev) 482454d507aSAleksandr Rybalko { 483454d507aSAleksandr Rybalko struct arswitch_softc *sc = device_get_softc(dev); 484454d507aSAleksandr Rybalko 485454d507aSAleksandr Rybalko ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED); 486454d507aSAleksandr Rybalko ARSWITCH_LOCK(sc); 487454d507aSAleksandr Rybalko } 488454d507aSAleksandr Rybalko 489454d507aSAleksandr Rybalko static void 490454d507aSAleksandr Rybalko arswitch_unlock(device_t dev) 491454d507aSAleksandr Rybalko { 492454d507aSAleksandr Rybalko struct arswitch_softc *sc = device_get_softc(dev); 493454d507aSAleksandr Rybalko 494454d507aSAleksandr Rybalko ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 495454d507aSAleksandr Rybalko ARSWITCH_UNLOCK(sc); 496454d507aSAleksandr Rybalko } 497454d507aSAleksandr Rybalko 498a043e8c7SAdrian Chadd static etherswitch_info_t * 499a043e8c7SAdrian Chadd arswitch_getinfo(device_t dev) 500a043e8c7SAdrian Chadd { 501a043e8c7SAdrian Chadd struct arswitch_softc *sc = device_get_softc(dev); 502a043e8c7SAdrian Chadd 503a043e8c7SAdrian Chadd return (&sc->info); 504a043e8c7SAdrian Chadd } 505a043e8c7SAdrian Chadd 506a043e8c7SAdrian Chadd static int 507a043e8c7SAdrian Chadd arswitch_getport(device_t dev, etherswitch_port_t *p) 508a043e8c7SAdrian Chadd { 509b9f07b86SLuiz Otavio O Souza struct arswitch_softc *sc; 510b9f07b86SLuiz Otavio O Souza struct ifmediareq *ifmr; 511a043e8c7SAdrian Chadd struct mii_data *mii; 512b9f07b86SLuiz Otavio O Souza uint32_t reg; 513a043e8c7SAdrian Chadd int err; 514a043e8c7SAdrian Chadd 515b9f07b86SLuiz Otavio O Souza sc = device_get_softc(dev); 516b9f07b86SLuiz Otavio O Souza if (p->es_port < 0 || p->es_port > sc->numphys) 517a043e8c7SAdrian Chadd return (ENXIO); 518b9f07b86SLuiz Otavio O Souza 519b9f07b86SLuiz Otavio O Souza ARSWITCH_LOCK(sc); 520b9f07b86SLuiz Otavio O Souza 521b9f07b86SLuiz Otavio O Souza /* Retrieve the PVID. */ 522b9f07b86SLuiz Otavio O Souza arswitch_get_pvid(sc, p->es_port, &p->es_pvid); 523b9f07b86SLuiz Otavio O Souza 524b9f07b86SLuiz Otavio O Souza /* Port flags. */ 525b9f07b86SLuiz Otavio O Souza reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port)); 526b9f07b86SLuiz Otavio O Souza if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG) 527b9f07b86SLuiz Otavio O Souza p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG; 528b9f07b86SLuiz Otavio O Souza reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 529b9f07b86SLuiz Otavio O Souza if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD) 530b9f07b86SLuiz Otavio O Souza p->es_flags |= ETHERSWITCH_PORT_ADDTAG; 531b9f07b86SLuiz Otavio O Souza if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP) 532b9f07b86SLuiz Otavio O Souza p->es_flags |= ETHERSWITCH_PORT_STRIPTAG; 533b9f07b86SLuiz Otavio O Souza ARSWITCH_UNLOCK(sc); 534a043e8c7SAdrian Chadd 535a043e8c7SAdrian Chadd mii = arswitch_miiforport(sc, p->es_port); 536a043e8c7SAdrian Chadd if (p->es_port == 0) { 537a043e8c7SAdrian Chadd /* fill in fixed values for CPU port */ 538f47857dcSAdrian Chadd p->es_flags |= ETHERSWITCH_PORT_CPU; 539b9f07b86SLuiz Otavio O Souza ifmr = &p->es_ifmr; 540a043e8c7SAdrian Chadd ifmr->ifm_count = 0; 541a043e8c7SAdrian Chadd ifmr->ifm_current = ifmr->ifm_active = 542a043e8c7SAdrian Chadd IFM_ETHER | IFM_1000_T | IFM_FDX; 543a043e8c7SAdrian Chadd ifmr->ifm_mask = 0; 544a043e8c7SAdrian Chadd ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID; 545a043e8c7SAdrian Chadd } else if (mii != NULL) { 546a043e8c7SAdrian Chadd err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr, 547a043e8c7SAdrian Chadd &mii->mii_media, SIOCGIFMEDIA); 548a043e8c7SAdrian Chadd if (err) 549a043e8c7SAdrian Chadd return (err); 550a043e8c7SAdrian Chadd } else { 551a043e8c7SAdrian Chadd return (ENXIO); 552a043e8c7SAdrian Chadd } 553a043e8c7SAdrian Chadd return (0); 554a043e8c7SAdrian Chadd } 555a043e8c7SAdrian Chadd 556a043e8c7SAdrian Chadd static int 557a043e8c7SAdrian Chadd arswitch_setport(device_t dev, etherswitch_port_t *p) 558a043e8c7SAdrian Chadd { 559a043e8c7SAdrian Chadd int err; 560b9f07b86SLuiz Otavio O Souza uint32_t reg; 561a043e8c7SAdrian Chadd struct arswitch_softc *sc; 562a043e8c7SAdrian Chadd struct ifmedia *ifm; 563a043e8c7SAdrian Chadd struct mii_data *mii; 564a043e8c7SAdrian Chadd struct ifnet *ifp; 565a043e8c7SAdrian Chadd 566b9f07b86SLuiz Otavio O Souza sc = device_get_softc(dev); 567b9f07b86SLuiz Otavio O Souza if (p->es_port < 0 || p->es_port > sc->numphys) 568a043e8c7SAdrian Chadd return (ENXIO); 569a043e8c7SAdrian Chadd 570b9f07b86SLuiz Otavio O Souza /* Port flags. */ 571b9f07b86SLuiz Otavio O Souza if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) { 572a043e8c7SAdrian Chadd 573b9f07b86SLuiz Otavio O Souza ARSWITCH_LOCK(sc); 574b9f07b86SLuiz Otavio O Souza /* Set the PVID. */ 575b9f07b86SLuiz Otavio O Souza if (p->es_pvid != 0) 576b9f07b86SLuiz Otavio O Souza arswitch_set_pvid(sc, p->es_port, p->es_pvid); 577b9f07b86SLuiz Otavio O Souza 578b9f07b86SLuiz Otavio O Souza /* Mutually exclusive. */ 579b9f07b86SLuiz Otavio O Souza if (p->es_flags & ETHERSWITCH_PORT_ADDTAG && 580b9f07b86SLuiz Otavio O Souza p->es_flags & ETHERSWITCH_PORT_STRIPTAG) { 581b9f07b86SLuiz Otavio O Souza ARSWITCH_UNLOCK(sc); 582b9f07b86SLuiz Otavio O Souza return (EINVAL); 583b9f07b86SLuiz Otavio O Souza } 584b9f07b86SLuiz Otavio O Souza 585b9f07b86SLuiz Otavio O Souza reg = 0; 586b9f07b86SLuiz Otavio O Souza if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG) 587b9f07b86SLuiz Otavio O Souza reg |= AR8X16_PORT_CTRL_DOUBLE_TAG; 588b9f07b86SLuiz Otavio O Souza if (p->es_flags & ETHERSWITCH_PORT_ADDTAG) 589b9f07b86SLuiz Otavio O Souza reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD << 590b9f07b86SLuiz Otavio O Souza AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 591b9f07b86SLuiz Otavio O Souza if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG) 592b9f07b86SLuiz Otavio O Souza reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP << 593b9f07b86SLuiz Otavio O Souza AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 594b9f07b86SLuiz Otavio O Souza 595b9f07b86SLuiz Otavio O Souza err = arswitch_modifyreg(sc->sc_dev, 596b9f07b86SLuiz Otavio O Souza AR8X16_REG_PORT_CTRL(p->es_port), 597b9f07b86SLuiz Otavio O Souza 0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT | 598b9f07b86SLuiz Otavio O Souza AR8X16_PORT_CTRL_DOUBLE_TAG, reg); 599b9f07b86SLuiz Otavio O Souza 600b9f07b86SLuiz Otavio O Souza ARSWITCH_UNLOCK(sc); 601b9f07b86SLuiz Otavio O Souza if (err) 602b9f07b86SLuiz Otavio O Souza return (err); 603b9f07b86SLuiz Otavio O Souza } 604b9f07b86SLuiz Otavio O Souza 605b9f07b86SLuiz Otavio O Souza /* Do not allow media changes on CPU port. */ 606b9f07b86SLuiz Otavio O Souza if (p->es_port == AR8X16_PORT_CPU) 607b9f07b86SLuiz Otavio O Souza return (0); 608a043e8c7SAdrian Chadd 609a043e8c7SAdrian Chadd mii = arswitch_miiforport(sc, p->es_port); 610a043e8c7SAdrian Chadd if (mii == NULL) 611a043e8c7SAdrian Chadd return (ENXIO); 612a043e8c7SAdrian Chadd 613a043e8c7SAdrian Chadd ifp = arswitch_ifpforport(sc, p->es_port); 614a043e8c7SAdrian Chadd 615a043e8c7SAdrian Chadd ifm = &mii->mii_media; 616b9f07b86SLuiz Otavio O Souza return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA)); 617a043e8c7SAdrian Chadd } 618a043e8c7SAdrian Chadd 619a043e8c7SAdrian Chadd static void 620a043e8c7SAdrian Chadd arswitch_statchg(device_t dev) 621a043e8c7SAdrian Chadd { 622a043e8c7SAdrian Chadd 623a043e8c7SAdrian Chadd DPRINTF(dev, "%s\n", __func__); 624a043e8c7SAdrian Chadd } 625a043e8c7SAdrian Chadd 626a043e8c7SAdrian Chadd static int 627a043e8c7SAdrian Chadd arswitch_ifmedia_upd(struct ifnet *ifp) 628a043e8c7SAdrian Chadd { 629a043e8c7SAdrian Chadd struct arswitch_softc *sc = ifp->if_softc; 630a043e8c7SAdrian Chadd struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 631a043e8c7SAdrian Chadd 632a043e8c7SAdrian Chadd if (mii == NULL) 633a043e8c7SAdrian Chadd return (ENXIO); 634a043e8c7SAdrian Chadd mii_mediachg(mii); 635a043e8c7SAdrian Chadd return (0); 636a043e8c7SAdrian Chadd } 637a043e8c7SAdrian Chadd 638a043e8c7SAdrian Chadd static void 639a043e8c7SAdrian Chadd arswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 640a043e8c7SAdrian Chadd { 641a043e8c7SAdrian Chadd struct arswitch_softc *sc = ifp->if_softc; 642a043e8c7SAdrian Chadd struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 643a043e8c7SAdrian Chadd 644a043e8c7SAdrian Chadd DPRINTF(sc->sc_dev, "%s\n", __func__); 645a043e8c7SAdrian Chadd 646a043e8c7SAdrian Chadd if (mii == NULL) 647a043e8c7SAdrian Chadd return; 648a043e8c7SAdrian Chadd mii_pollstat(mii); 649a043e8c7SAdrian Chadd ifmr->ifm_active = mii->mii_media_active; 650a043e8c7SAdrian Chadd ifmr->ifm_status = mii->mii_media_status; 651a043e8c7SAdrian Chadd } 652a043e8c7SAdrian Chadd 653b9f07b86SLuiz Otavio O Souza static int 654b9f07b86SLuiz Otavio O Souza arswitch_getconf(device_t dev, etherswitch_conf_t *conf) 655b9f07b86SLuiz Otavio O Souza { 656b9f07b86SLuiz Otavio O Souza struct arswitch_softc *sc; 657b9f07b86SLuiz Otavio O Souza 658b9f07b86SLuiz Otavio O Souza sc = device_get_softc(dev); 659b9f07b86SLuiz Otavio O Souza 660b9f07b86SLuiz Otavio O Souza /* Return the VLAN mode. */ 661b9f07b86SLuiz Otavio O Souza conf->cmd = ETHERSWITCH_CONF_VLAN_MODE; 662b9f07b86SLuiz Otavio O Souza conf->vlan_mode = sc->vlan_mode; 663b9f07b86SLuiz Otavio O Souza 664b9f07b86SLuiz Otavio O Souza return (0); 665b9f07b86SLuiz Otavio O Souza } 666b9f07b86SLuiz Otavio O Souza 667b9f07b86SLuiz Otavio O Souza static int 668b9f07b86SLuiz Otavio O Souza arswitch_setconf(device_t dev, etherswitch_conf_t *conf) 669b9f07b86SLuiz Otavio O Souza { 670b9f07b86SLuiz Otavio O Souza struct arswitch_softc *sc; 671b9f07b86SLuiz Otavio O Souza int err; 672b9f07b86SLuiz Otavio O Souza 673b9f07b86SLuiz Otavio O Souza sc = device_get_softc(dev); 674b9f07b86SLuiz Otavio O Souza 675b9f07b86SLuiz Otavio O Souza /* Set the VLAN mode. */ 676b9f07b86SLuiz Otavio O Souza if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) { 677b9f07b86SLuiz Otavio O Souza err = arswitch_set_vlan_mode(sc, conf->vlan_mode); 678b9f07b86SLuiz Otavio O Souza if (err != 0) 679b9f07b86SLuiz Otavio O Souza return (err); 680b9f07b86SLuiz Otavio O Souza } 681b9f07b86SLuiz Otavio O Souza 682b9f07b86SLuiz Otavio O Souza return (0); 683b9f07b86SLuiz Otavio O Souza } 684b9f07b86SLuiz Otavio O Souza 685a043e8c7SAdrian Chadd static device_method_t arswitch_methods[] = { 686a043e8c7SAdrian Chadd /* Device interface */ 687a043e8c7SAdrian Chadd DEVMETHOD(device_probe, arswitch_probe), 688a043e8c7SAdrian Chadd DEVMETHOD(device_attach, arswitch_attach), 689a043e8c7SAdrian Chadd DEVMETHOD(device_detach, arswitch_detach), 690a043e8c7SAdrian Chadd 691a043e8c7SAdrian Chadd /* bus interface */ 692a043e8c7SAdrian Chadd DEVMETHOD(bus_add_child, device_add_child_ordered), 693a043e8c7SAdrian Chadd 694a043e8c7SAdrian Chadd /* MII interface */ 695a043e8c7SAdrian Chadd DEVMETHOD(miibus_readreg, arswitch_readphy), 696a043e8c7SAdrian Chadd DEVMETHOD(miibus_writereg, arswitch_writephy), 697a043e8c7SAdrian Chadd DEVMETHOD(miibus_statchg, arswitch_statchg), 698a043e8c7SAdrian Chadd 699a043e8c7SAdrian Chadd /* MDIO interface */ 700a043e8c7SAdrian Chadd DEVMETHOD(mdio_readreg, arswitch_readphy), 701a043e8c7SAdrian Chadd DEVMETHOD(mdio_writereg, arswitch_writephy), 702a043e8c7SAdrian Chadd 703a043e8c7SAdrian Chadd /* etherswitch interface */ 704454d507aSAleksandr Rybalko DEVMETHOD(etherswitch_lock, arswitch_lock), 705454d507aSAleksandr Rybalko DEVMETHOD(etherswitch_unlock, arswitch_unlock), 706a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_getinfo, arswitch_getinfo), 707a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_readreg, arswitch_readreg), 708a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_writereg, arswitch_writereg), 709a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_readphyreg, arswitch_readphy), 710a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_writephyreg, arswitch_writephy), 711a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_getport, arswitch_getport), 712a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_setport, arswitch_setport), 713a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_getvgroup, arswitch_getvgroup), 714a043e8c7SAdrian Chadd DEVMETHOD(etherswitch_setvgroup, arswitch_setvgroup), 715b9f07b86SLuiz Otavio O Souza DEVMETHOD(etherswitch_getconf, arswitch_getconf), 716b9f07b86SLuiz Otavio O Souza DEVMETHOD(etherswitch_setconf, arswitch_setconf), 717a043e8c7SAdrian Chadd 718a043e8c7SAdrian Chadd DEVMETHOD_END 719a043e8c7SAdrian Chadd }; 720a043e8c7SAdrian Chadd 721a043e8c7SAdrian Chadd DEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods, 722a043e8c7SAdrian Chadd sizeof(struct arswitch_softc)); 723a043e8c7SAdrian Chadd static devclass_t arswitch_devclass; 724a043e8c7SAdrian Chadd 725a043e8c7SAdrian Chadd DRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0); 726a043e8c7SAdrian Chadd DRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0); 727a043e8c7SAdrian Chadd DRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0); 728a043e8c7SAdrian Chadd DRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0); 729a043e8c7SAdrian Chadd MODULE_VERSION(arswitch, 1); 730a043e8c7SAdrian Chadd MODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */ 731a043e8c7SAdrian Chadd MODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */ 732