arswitch.c revision 279767
1235288Sadrian/*- 2235288Sadrian * Copyright (c) 2011-2012 Stefan Bethke. 3235288Sadrian * Copyright (c) 2012 Adrian Chadd. 4235288Sadrian * All rights reserved. 5235288Sadrian * 6235288Sadrian * Redistribution and use in source and binary forms, with or without 7235288Sadrian * modification, are permitted provided that the following conditions 8235288Sadrian * are met: 9235288Sadrian * 1. Redistributions of source code must retain the above copyright 10235288Sadrian * notice, this list of conditions and the following disclaimer. 11235288Sadrian * 2. Redistributions in binary form must reproduce the above copyright 12235288Sadrian * notice, this list of conditions and the following disclaimer in the 13235288Sadrian * documentation and/or other materials provided with the distribution. 14235288Sadrian * 15235288Sadrian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16235288Sadrian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17235288Sadrian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18235288Sadrian * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19235288Sadrian * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20235288Sadrian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21235288Sadrian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22235288Sadrian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23235288Sadrian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24235288Sadrian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25235288Sadrian * SUCH DAMAGE. 26235288Sadrian * 27235288Sadrian * $FreeBSD: head/sys/dev/etherswitch/arswitch/arswitch.c 279767 2015-03-08 03:53:36Z adrian $ 28235288Sadrian */ 29235288Sadrian 30235288Sadrian#include <sys/param.h> 31235288Sadrian#include <sys/bus.h> 32235288Sadrian#include <sys/errno.h> 33235288Sadrian#include <sys/kernel.h> 34257284Sglebius#include <sys/malloc.h> 35235288Sadrian#include <sys/module.h> 36235288Sadrian#include <sys/socket.h> 37235288Sadrian#include <sys/sockio.h> 38235288Sadrian#include <sys/sysctl.h> 39235288Sadrian#include <sys/systm.h> 40235288Sadrian 41235288Sadrian#include <net/if.h> 42257284Sglebius#include <net/if_var.h> 43235288Sadrian#include <net/if_arp.h> 44235288Sadrian#include <net/ethernet.h> 45235288Sadrian#include <net/if_dl.h> 46235288Sadrian#include <net/if_media.h> 47235288Sadrian#include <net/if_types.h> 48235288Sadrian 49235288Sadrian#include <machine/bus.h> 50268564Srpaulo#include <dev/iicbus/iic.h> 51235288Sadrian#include <dev/iicbus/iiconf.h> 52235288Sadrian#include <dev/iicbus/iicbus.h> 53235288Sadrian#include <dev/mii/mii.h> 54235288Sadrian#include <dev/mii/miivar.h> 55235288Sadrian#include <dev/etherswitch/mdio.h> 56235288Sadrian 57235288Sadrian#include <dev/etherswitch/etherswitch.h> 58235288Sadrian 59235288Sadrian#include <dev/etherswitch/arswitch/arswitchreg.h> 60235288Sadrian#include <dev/etherswitch/arswitch/arswitchvar.h> 61235288Sadrian#include <dev/etherswitch/arswitch/arswitch_reg.h> 62235288Sadrian#include <dev/etherswitch/arswitch/arswitch_phy.h> 63253572Sloos#include <dev/etherswitch/arswitch/arswitch_vlans.h> 64235288Sadrian 65235323Sadrian#include <dev/etherswitch/arswitch/arswitch_7240.h> 66235288Sadrian#include <dev/etherswitch/arswitch/arswitch_8216.h> 67235288Sadrian#include <dev/etherswitch/arswitch/arswitch_8226.h> 68235288Sadrian#include <dev/etherswitch/arswitch/arswitch_8316.h> 69262431Sadrian#include <dev/etherswitch/arswitch/arswitch_8327.h> 70256582Sadrian#include <dev/etherswitch/arswitch/arswitch_9340.h> 71235288Sadrian 72235288Sadrian#include "mdio_if.h" 73235288Sadrian#include "miibus_if.h" 74235288Sadrian#include "etherswitch_if.h" 75235288Sadrian 76235288Sadrian#if defined(DEBUG) 77235288Sadrianstatic SYSCTL_NODE(_debug, OID_AUTO, arswitch, CTLFLAG_RD, 0, "arswitch"); 78235288Sadrian#endif 79235288Sadrian 80235288Sadrianstatic inline int arswitch_portforphy(int phy); 81235288Sadrianstatic void arswitch_tick(void *arg); 82235288Sadrianstatic int arswitch_ifmedia_upd(struct ifnet *); 83235288Sadrianstatic void arswitch_ifmedia_sts(struct ifnet *, struct ifmediareq *); 84262208Sadrianstatic int ar8xxx_port_vlan_setup(struct arswitch_softc *sc, 85262208Sadrian etherswitch_port_t *p); 86262208Sadrianstatic int ar8xxx_port_vlan_get(struct arswitch_softc *sc, 87262208Sadrian etherswitch_port_t *p); 88235288Sadrian 89235288Sadrianstatic int 90235288Sadrianarswitch_probe(device_t dev) 91235288Sadrian{ 92235288Sadrian struct arswitch_softc *sc; 93235288Sadrian uint32_t id; 94235288Sadrian char *chipname, desc[256]; 95235288Sadrian 96235288Sadrian sc = device_get_softc(dev); 97235288Sadrian bzero(sc, sizeof(*sc)); 98235288Sadrian sc->page = -1; 99235323Sadrian 100235323Sadrian /* AR7240 probe */ 101235323Sadrian if (ar7240_probe(dev) == 0) { 102235323Sadrian chipname = "AR7240"; 103235323Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR7240; 104256582Sadrian sc->is_internal_switch = 1; 105241577Sray id = 0; 106235323Sadrian goto done; 107235323Sadrian } 108235323Sadrian 109256582Sadrian /* AR9340 probe */ 110256582Sadrian if (ar9340_probe(dev) == 0) { 111256582Sadrian chipname = "AR9340"; 112256582Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR9340; 113256582Sadrian sc->is_internal_switch = 1; 114256582Sadrian id = 0; 115256582Sadrian goto done; 116256582Sadrian } 117256582Sadrian 118235323Sadrian /* AR8xxx probe */ 119235288Sadrian id = arswitch_readreg(dev, AR8X16_REG_MASK_CTRL); 120262201Sadrian sc->chip_rev = (id & AR8X16_MASK_CTRL_REV_MASK); 121262201Sadrian sc->chip_ver = (id & AR8X16_MASK_CTRL_VER_MASK) > AR8X16_MASK_CTRL_VER_SHIFT; 122256582Sadrian switch (id & (AR8X16_MASK_CTRL_VER_MASK | AR8X16_MASK_CTRL_REV_MASK)) { 123256582Sadrian case 0x0101: 124235288Sadrian chipname = "AR8216"; 125235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8216; 126235288Sadrian break; 127256582Sadrian case 0x0201: 128235288Sadrian chipname = "AR8226"; 129235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8226; 130235288Sadrian break; 131256582Sadrian /* 0x0301 - AR8236 */ 132256582Sadrian case 0x1000: 133256582Sadrian case 0x1001: 134235288Sadrian chipname = "AR8316"; 135235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8316; 136235288Sadrian break; 137262202Sadrian case 0x1202: 138269147Sadrian case 0x1204: 139262202Sadrian chipname = "AR8327"; 140262202Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8327; 141262202Sadrian sc->mii_lo_first = 1; 142262202Sadrian break; 143235288Sadrian default: 144235288Sadrian chipname = NULL; 145235288Sadrian } 146235323Sadrian 147235323Sadriandone: 148256582Sadrian 149256582Sadrian DPRINTF(dev, "chipname=%s, id=%08x\n", chipname, id); 150235288Sadrian if (chipname != NULL) { 151235288Sadrian snprintf(desc, sizeof(desc), 152279767Sadrian "Atheros %s Ethernet Switch (ver %d rev %d)", 153279767Sadrian chipname, 154279767Sadrian sc->chip_ver, 155279767Sadrian sc->chip_rev); 156235288Sadrian device_set_desc_copy(dev, desc); 157235288Sadrian return (BUS_PROBE_DEFAULT); 158235288Sadrian } 159235288Sadrian return (ENXIO); 160235288Sadrian} 161235288Sadrian 162235288Sadrianstatic int 163235288Sadrianarswitch_attach_phys(struct arswitch_softc *sc) 164235288Sadrian{ 165235288Sadrian int phy, err = 0; 166235288Sadrian char name[IFNAMSIZ]; 167235288Sadrian 168235288Sadrian /* PHYs need an interface, so we generate a dummy one */ 169235288Sadrian snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev)); 170235288Sadrian for (phy = 0; phy < sc->numphys; phy++) { 171235288Sadrian sc->ifp[phy] = if_alloc(IFT_ETHER); 172235288Sadrian sc->ifp[phy]->if_softc = sc; 173235288Sadrian sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST | 174235288Sadrian IFF_DRV_RUNNING | IFF_SIMPLEX; 175235288Sadrian sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK); 176235288Sadrian bcopy(name, sc->ifname[phy], strlen(name)+1); 177235288Sadrian if_initname(sc->ifp[phy], sc->ifname[phy], 178235288Sadrian arswitch_portforphy(phy)); 179235288Sadrian err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy], 180235288Sadrian arswitch_ifmedia_upd, arswitch_ifmedia_sts, \ 181235288Sadrian BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0); 182279767Sadrian#if 0 183235288Sadrian DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n", 184235288Sadrian device_get_nameunit(sc->miibus[phy]), 185235288Sadrian sc->ifp[phy]->if_xname); 186279767Sadrian#endif 187235288Sadrian if (err != 0) { 188235288Sadrian device_printf(sc->sc_dev, 189235288Sadrian "attaching PHY %d failed\n", 190235288Sadrian phy); 191235288Sadrian } 192235288Sadrian } 193235288Sadrian return (err); 194235288Sadrian} 195235288Sadrian 196235288Sadrianstatic int 197253572Sloosarswitch_reset(device_t dev) 198253572Sloos{ 199253572Sloos 200253572Sloos arswitch_writereg(dev, AR8X16_REG_MASK_CTRL, 201253572Sloos AR8X16_MASK_CTRL_SOFT_RESET); 202253572Sloos DELAY(1000); 203253572Sloos if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) & 204253572Sloos AR8X16_MASK_CTRL_SOFT_RESET) { 205253572Sloos device_printf(dev, "unable to reset switch\n"); 206253572Sloos return (-1); 207253572Sloos } 208253572Sloos return (0); 209253572Sloos} 210253572Sloos 211253572Sloosstatic int 212253572Sloosarswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode) 213253572Sloos{ 214253572Sloos 215253572Sloos /* Check for invalid modes. */ 216253572Sloos if ((mode & sc->info.es_vlan_caps) != mode) 217253572Sloos return (EINVAL); 218253572Sloos 219253572Sloos switch (mode) { 220253572Sloos case ETHERSWITCH_VLAN_DOT1Q: 221253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q; 222253572Sloos break; 223253572Sloos case ETHERSWITCH_VLAN_PORT: 224253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_PORT; 225253572Sloos break; 226253572Sloos default: 227253572Sloos sc->vlan_mode = 0; 228253572Sloos }; 229253572Sloos 230253572Sloos /* Reset VLANs. */ 231262429Sadrian sc->hal.arswitch_vlan_init_hw(sc); 232253572Sloos 233253572Sloos return (0); 234253572Sloos} 235253572Sloos 236253572Sloosstatic void 237262208Sadrianar8xxx_port_init(struct arswitch_softc *sc, int port) 238253572Sloos{ 239253572Sloos 240253572Sloos /* Port0 - CPU */ 241262203Sadrian if (port == AR8X16_PORT_CPU) { 242262203Sadrian arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0), 243262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 244262203Sadrian AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) | 245262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) | 246262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) | 247262203Sadrian AR8X16_PORT_STS_RXMAC | 248262203Sadrian AR8X16_PORT_STS_TXMAC | 249262203Sadrian AR8X16_PORT_STS_DUPLEX); 250262203Sadrian arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0), 251262203Sadrian arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) & 252262203Sadrian ~AR8X16_PORT_CTRL_HEADER); 253262203Sadrian } else { 254253572Sloos /* Set ports to auto negotiation. */ 255253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port), 256253572Sloos AR8X16_PORT_STS_LINK_AUTO); 257253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port), 258253572Sloos arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) & 259253572Sloos ~AR8X16_PORT_CTRL_HEADER); 260253572Sloos } 261253572Sloos} 262253572Sloos 263253572Sloosstatic int 264262681Sadrianar8xxx_atu_flush(struct arswitch_softc *sc) 265262681Sadrian{ 266262681Sadrian int ret; 267262681Sadrian 268262681Sadrian ret = arswitch_waitreg(sc->sc_dev, 269262681Sadrian AR8216_REG_ATU, 270262681Sadrian AR8216_ATU_ACTIVE, 271262681Sadrian 0, 272262681Sadrian 1000); 273262681Sadrian 274262681Sadrian if (ret) 275262681Sadrian device_printf(sc->sc_dev, "%s: waitreg failed\n", __func__); 276262681Sadrian 277262681Sadrian if (!ret) 278262681Sadrian arswitch_writereg(sc->sc_dev, 279262681Sadrian AR8216_REG_ATU, 280262681Sadrian AR8216_ATU_OP_FLUSH); 281262681Sadrian 282262681Sadrian return (ret); 283262681Sadrian} 284262681Sadrian 285262681Sadrianstatic int 286235288Sadrianarswitch_attach(device_t dev) 287235288Sadrian{ 288235288Sadrian struct arswitch_softc *sc; 289235288Sadrian int err = 0; 290262203Sadrian int port; 291235288Sadrian 292235288Sadrian sc = device_get_softc(dev); 293235288Sadrian 294235288Sadrian /* sc->sc_switchtype is already decided in arswitch_probe() */ 295235288Sadrian sc->sc_dev = dev; 296235288Sadrian mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF); 297235288Sadrian sc->page = -1; 298235288Sadrian strlcpy(sc->info.es_name, device_get_desc(dev), 299235288Sadrian sizeof(sc->info.es_name)); 300235288Sadrian 301262206Sadrian /* Default HAL methods */ 302262208Sadrian sc->hal.arswitch_port_init = ar8xxx_port_init; 303262208Sadrian sc->hal.arswitch_port_vlan_setup = ar8xxx_port_vlan_setup; 304262208Sadrian sc->hal.arswitch_port_vlan_get = ar8xxx_port_vlan_get; 305262429Sadrian sc->hal.arswitch_vlan_init_hw = ar8xxx_reset_vlans; 306262429Sadrian sc->hal.arswitch_vlan_getvgroup = ar8xxx_getvgroup; 307262429Sadrian sc->hal.arswitch_vlan_setvgroup = ar8xxx_setvgroup; 308262429Sadrian sc->hal.arswitch_vlan_get_pvid = ar8xxx_get_pvid; 309262429Sadrian sc->hal.arswitch_vlan_set_pvid = ar8xxx_set_pvid; 310262681Sadrian sc->hal.arswitch_atu_flush = ar8xxx_atu_flush; 311279767Sadrian sc->hal.arswitch_phy_read = arswitch_readphy_internal; 312279767Sadrian sc->hal.arswitch_phy_write = arswitch_writephy_internal; 313262206Sadrian 314235288Sadrian /* 315235288Sadrian * Attach switch related functions 316235288Sadrian */ 317235323Sadrian if (AR8X16_IS_SWITCH(sc, AR7240)) 318235323Sadrian ar7240_attach(sc); 319256582Sadrian else if (AR8X16_IS_SWITCH(sc, AR9340)) 320256582Sadrian ar9340_attach(sc); 321235323Sadrian else if (AR8X16_IS_SWITCH(sc, AR8216)) 322235288Sadrian ar8216_attach(sc); 323235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8226)) 324235288Sadrian ar8226_attach(sc); 325235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8316)) 326235288Sadrian ar8316_attach(sc); 327262431Sadrian else if (AR8X16_IS_SWITCH(sc, AR8327)) 328262431Sadrian ar8327_attach(sc); 329279767Sadrian else { 330279767Sadrian DPRINTF(dev, "%s: unknown switch (%d)?\n", __func__, sc->sc_switchtype); 331235288Sadrian return (ENXIO); 332279767Sadrian } 333235288Sadrian 334253572Sloos /* Common defaults. */ 335235288Sadrian sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */ 336235288Sadrian 337235288Sadrian /* XXX Defaults for externally connected AR8316 */ 338235288Sadrian sc->numphys = 4; 339235288Sadrian sc->phy4cpu = 1; 340235288Sadrian sc->is_rgmii = 1; 341235288Sadrian sc->is_gmii = 0; 342256582Sadrian sc->is_mii = 0; 343235288Sadrian 344235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 345235288Sadrian "numphys", &sc->numphys); 346235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 347235288Sadrian "phy4cpu", &sc->phy4cpu); 348235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 349235288Sadrian "is_rgmii", &sc->is_rgmii); 350235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 351235288Sadrian "is_gmii", &sc->is_gmii); 352256582Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 353256582Sadrian "is_mii", &sc->is_mii); 354235288Sadrian 355253572Sloos if (sc->numphys > AR8X16_NUM_PHYS) 356253572Sloos sc->numphys = AR8X16_NUM_PHYS; 357253572Sloos 358253572Sloos /* Reset the switch. */ 359279767Sadrian if (arswitch_reset(dev)) { 360279767Sadrian DPRINTF(dev, "%s: arswitch_reset: failed\n", __func__); 361235288Sadrian return (ENXIO); 362279767Sadrian } 363235288Sadrian 364256582Sadrian err = sc->hal.arswitch_hw_setup(sc); 365279767Sadrian DPRINTF(dev, "%s: hw_setup: err=%d\n", __func__, err); 366256582Sadrian if (err != 0) 367256582Sadrian return (err); 368256582Sadrian 369235288Sadrian err = sc->hal.arswitch_hw_global_setup(sc); 370279767Sadrian DPRINTF(dev, "%s: hw_global_setup: err=%d\n", __func__, err); 371235288Sadrian if (err != 0) 372235288Sadrian return (err); 373235288Sadrian 374253572Sloos /* Initialize the switch ports. */ 375262203Sadrian for (port = 0; port <= sc->numphys; port++) { 376262206Sadrian sc->hal.arswitch_port_init(sc, port); 377262203Sadrian } 378253572Sloos 379235288Sadrian /* 380235288Sadrian * Attach the PHYs and complete the bus enumeration. 381235288Sadrian */ 382235288Sadrian err = arswitch_attach_phys(sc); 383279767Sadrian DPRINTF(dev, "%s: attach_phys: err=%d\n", __func__, err); 384235288Sadrian if (err != 0) 385235288Sadrian return (err); 386235288Sadrian 387253572Sloos /* Default to ingress filters off. */ 388253572Sloos err = arswitch_set_vlan_mode(sc, 0); 389279767Sadrian DPRINTF(dev, "%s: set_vlan_mode: err=%d\n", __func__, err); 390253572Sloos if (err != 0) 391253572Sloos return (err); 392253572Sloos 393235288Sadrian bus_generic_probe(dev); 394235288Sadrian bus_enumerate_hinted_children(dev); 395235288Sadrian err = bus_generic_attach(dev); 396279767Sadrian DPRINTF(dev, "%s: bus_generic_attach: err=%d\n", __func__, err); 397235288Sadrian if (err != 0) 398235288Sadrian return (err); 399235288Sadrian 400235288Sadrian callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0); 401241578Sray 402241578Sray ARSWITCH_LOCK(sc); 403235288Sadrian arswitch_tick(sc); 404241578Sray ARSWITCH_UNLOCK(sc); 405235288Sadrian 406235288Sadrian return (err); 407235288Sadrian} 408235288Sadrian 409235288Sadrianstatic int 410235288Sadrianarswitch_detach(device_t dev) 411235288Sadrian{ 412235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 413235288Sadrian int i; 414235288Sadrian 415235288Sadrian callout_drain(&sc->callout_tick); 416235288Sadrian 417235288Sadrian for (i=0; i < sc->numphys; i++) { 418235288Sadrian if (sc->miibus[i] != NULL) 419235288Sadrian device_delete_child(dev, sc->miibus[i]); 420235288Sadrian if (sc->ifp[i] != NULL) 421235288Sadrian if_free(sc->ifp[i]); 422235288Sadrian free(sc->ifname[i], M_DEVBUF); 423235288Sadrian } 424235288Sadrian 425235288Sadrian bus_generic_detach(dev); 426235288Sadrian mtx_destroy(&sc->sc_mtx); 427235288Sadrian 428235288Sadrian return (0); 429235288Sadrian} 430235288Sadrian 431235288Sadrian/* 432235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to 433235288Sadrian * port 2, etc. 434235288Sadrian */ 435235288Sadrianstatic inline int 436235288Sadrianarswitch_portforphy(int phy) 437235288Sadrian{ 438235288Sadrian return (phy+1); 439235288Sadrian} 440235288Sadrian 441235288Sadrianstatic inline struct mii_data * 442235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port) 443235288Sadrian{ 444235288Sadrian int phy = port-1; 445235288Sadrian 446235288Sadrian if (phy < 0 || phy >= sc->numphys) 447235288Sadrian return (NULL); 448235288Sadrian return (device_get_softc(sc->miibus[phy])); 449235288Sadrian} 450235288Sadrian 451235288Sadrianstatic inline struct ifnet * 452235288Sadrianarswitch_ifpforport(struct arswitch_softc *sc, int port) 453235288Sadrian{ 454235288Sadrian int phy = port-1; 455235288Sadrian 456235288Sadrian if (phy < 0 || phy >= sc->numphys) 457235288Sadrian return (NULL); 458235288Sadrian return (sc->ifp[phy]); 459235288Sadrian} 460235288Sadrian 461235288Sadrian/* 462235288Sadrian * Convert port status to ifmedia. 463235288Sadrian */ 464235288Sadrianstatic void 465235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active) 466235288Sadrian{ 467235288Sadrian *media_active = IFM_ETHER; 468235288Sadrian *media_status = IFM_AVALID; 469235288Sadrian 470235288Sadrian if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0) 471235288Sadrian *media_status |= IFM_ACTIVE; 472235288Sadrian else { 473235288Sadrian *media_active |= IFM_NONE; 474235288Sadrian return; 475235288Sadrian } 476235288Sadrian switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) { 477235288Sadrian case AR8X16_PORT_STS_SPEED_10: 478235288Sadrian *media_active |= IFM_10_T; 479235288Sadrian break; 480235288Sadrian case AR8X16_PORT_STS_SPEED_100: 481235288Sadrian *media_active |= IFM_100_TX; 482235288Sadrian break; 483235288Sadrian case AR8X16_PORT_STS_SPEED_1000: 484235288Sadrian *media_active |= IFM_1000_T; 485235288Sadrian break; 486235288Sadrian } 487235288Sadrian if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0) 488235288Sadrian *media_active |= IFM_FDX; 489235288Sadrian else 490235288Sadrian *media_active |= IFM_HDX; 491235288Sadrian if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0) 492235288Sadrian *media_active |= IFM_ETH_TXPAUSE; 493235288Sadrian if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0) 494235288Sadrian *media_active |= IFM_ETH_RXPAUSE; 495235288Sadrian} 496235288Sadrian 497235288Sadrian/* 498235288Sadrian * Poll the status for all PHYs. We're using the switch port status because 499235288Sadrian * thats a lot quicker to read than talking to all the PHYs. Care must be 500235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will 501235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs 502235288Sadrian * update function is called. 503235288Sadrian */ 504235288Sadrianstatic void 505235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc) 506235288Sadrian{ 507235288Sadrian int i; 508235288Sadrian struct mii_data *mii; 509235288Sadrian struct mii_softc *miisc; 510235288Sadrian int portstatus; 511262681Sadrian int port_flap = 0; 512235288Sadrian 513241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 514241578Sray 515235288Sadrian for (i = 0; i < sc->numphys; i++) { 516235288Sadrian if (sc->miibus[i] == NULL) 517235288Sadrian continue; 518235288Sadrian mii = device_get_softc(sc->miibus[i]); 519262206Sadrian /* XXX This would be nice to have abstracted out to be per-chip */ 520262206Sadrian /* AR8327/AR8337 has a different register base */ 521262206Sadrian if (AR8X16_IS_SWITCH(sc, AR8327)) 522262206Sadrian portstatus = arswitch_readreg(sc->sc_dev, 523262206Sadrian AR8327_REG_PORT_STATUS(arswitch_portforphy(i))); 524262206Sadrian else 525262206Sadrian portstatus = arswitch_readreg(sc->sc_dev, 526262206Sadrian AR8X16_REG_PORT_STS(arswitch_portforphy(i))); 527235288Sadrian#if 0 528235288Sadrian DPRINTF(sc->sc_dev, "p[%d]=%b\n", 529256582Sadrian i, 530235288Sadrian portstatus, 531235288Sadrian "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7" 532235288Sadrian "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE"); 533235288Sadrian#endif 534262681Sadrian /* 535262681Sadrian * If the current status is down, but we have a link 536262681Sadrian * status showing up, we need to do an ATU flush. 537262681Sadrian */ 538262681Sadrian if ((mii->mii_media_status & IFM_ACTIVE) == 0 && 539262681Sadrian (portstatus & AR8X16_PORT_STS_LINK_UP) != 0) { 540262681Sadrian device_printf(sc->sc_dev, "%s: port %d: port -> UP\n", 541262681Sadrian __func__, 542262681Sadrian i); 543262681Sadrian port_flap = 1; 544262681Sadrian } 545262681Sadrian /* 546262681Sadrian * and maybe if a port goes up->down? 547262681Sadrian */ 548262681Sadrian if ((mii->mii_media_status & IFM_ACTIVE) != 0 && 549262681Sadrian (portstatus & AR8X16_PORT_STS_LINK_UP) == 0) { 550262681Sadrian device_printf(sc->sc_dev, "%s: port %d: port -> DOWN\n", 551262681Sadrian __func__, 552262681Sadrian i); 553262681Sadrian port_flap = 1; 554262681Sadrian } 555235288Sadrian arswitch_update_ifmedia(portstatus, &mii->mii_media_status, 556235288Sadrian &mii->mii_media_active); 557235288Sadrian LIST_FOREACH(miisc, &mii->mii_phys, mii_list) { 558235288Sadrian if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) != 559235288Sadrian miisc->mii_inst) 560235288Sadrian continue; 561235288Sadrian mii_phy_update(miisc, MII_POLLSTAT); 562235288Sadrian } 563235288Sadrian } 564262681Sadrian 565262681Sadrian /* If a port went from down->up, flush the ATU */ 566262681Sadrian if (port_flap) 567262681Sadrian sc->hal.arswitch_atu_flush(sc); 568235288Sadrian} 569235288Sadrian 570235288Sadrianstatic void 571235288Sadrianarswitch_tick(void *arg) 572235288Sadrian{ 573235288Sadrian struct arswitch_softc *sc = arg; 574235288Sadrian 575235288Sadrian arswitch_miipollstat(sc); 576235288Sadrian callout_reset(&sc->callout_tick, hz, arswitch_tick, sc); 577235288Sadrian} 578235288Sadrian 579241578Sraystatic void 580241578Srayarswitch_lock(device_t dev) 581241578Sray{ 582241578Sray struct arswitch_softc *sc = device_get_softc(dev); 583241578Sray 584241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED); 585241578Sray ARSWITCH_LOCK(sc); 586241578Sray} 587241578Sray 588241578Sraystatic void 589241578Srayarswitch_unlock(device_t dev) 590241578Sray{ 591241578Sray struct arswitch_softc *sc = device_get_softc(dev); 592241578Sray 593241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 594241578Sray ARSWITCH_UNLOCK(sc); 595241578Sray} 596241578Sray 597235288Sadrianstatic etherswitch_info_t * 598235288Sadrianarswitch_getinfo(device_t dev) 599235288Sadrian{ 600235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 601235288Sadrian 602235288Sadrian return (&sc->info); 603235288Sadrian} 604235288Sadrian 605235288Sadrianstatic int 606262208Sadrianar8xxx_port_vlan_get(struct arswitch_softc *sc, etherswitch_port_t *p) 607235288Sadrian{ 608253572Sloos uint32_t reg; 609253572Sloos 610253572Sloos ARSWITCH_LOCK(sc); 611253572Sloos 612253572Sloos /* Retrieve the PVID. */ 613262429Sadrian sc->hal.arswitch_vlan_get_pvid(sc, p->es_port, &p->es_pvid); 614253572Sloos 615253572Sloos /* Port flags. */ 616253572Sloos reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port)); 617253572Sloos if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG) 618253572Sloos p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG; 619253572Sloos reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 620253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD) 621253572Sloos p->es_flags |= ETHERSWITCH_PORT_ADDTAG; 622253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP) 623253572Sloos p->es_flags |= ETHERSWITCH_PORT_STRIPTAG; 624253572Sloos ARSWITCH_UNLOCK(sc); 625253572Sloos 626262208Sadrian return (0); 627262208Sadrian} 628262208Sadrian 629262208Sadrianstatic int 630262208Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p) 631262208Sadrian{ 632262208Sadrian struct arswitch_softc *sc; 633262208Sadrian struct mii_data *mii; 634262208Sadrian struct ifmediareq *ifmr; 635262208Sadrian int err; 636262208Sadrian 637262208Sadrian sc = device_get_softc(dev); 638262208Sadrian if (p->es_port < 0 || p->es_port > sc->numphys) 639262208Sadrian return (ENXIO); 640262208Sadrian 641262208Sadrian err = sc->hal.arswitch_port_vlan_get(sc, p); 642262208Sadrian if (err != 0) 643262208Sadrian return (err); 644262208Sadrian 645235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 646262208Sadrian if (p->es_port == AR8X16_PORT_CPU) { 647235288Sadrian /* fill in fixed values for CPU port */ 648262208Sadrian /* XXX is this valid in all cases? */ 649250383Sadrian p->es_flags |= ETHERSWITCH_PORT_CPU; 650253572Sloos ifmr = &p->es_ifmr; 651235288Sadrian ifmr->ifm_count = 0; 652235288Sadrian ifmr->ifm_current = ifmr->ifm_active = 653235288Sadrian IFM_ETHER | IFM_1000_T | IFM_FDX; 654235288Sadrian ifmr->ifm_mask = 0; 655235288Sadrian ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID; 656235288Sadrian } else if (mii != NULL) { 657235288Sadrian err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr, 658235288Sadrian &mii->mii_media, SIOCGIFMEDIA); 659235288Sadrian if (err) 660235288Sadrian return (err); 661235288Sadrian } else { 662235288Sadrian return (ENXIO); 663235288Sadrian } 664235288Sadrian return (0); 665235288Sadrian} 666235288Sadrian 667235288Sadrianstatic int 668262208Sadrianar8xxx_port_vlan_setup(struct arswitch_softc *sc, etherswitch_port_t *p) 669262208Sadrian{ 670262208Sadrian uint32_t reg; 671262208Sadrian int err; 672262208Sadrian 673262208Sadrian ARSWITCH_LOCK(sc); 674262208Sadrian 675262208Sadrian /* Set the PVID. */ 676262208Sadrian if (p->es_pvid != 0) 677262429Sadrian sc->hal.arswitch_vlan_set_pvid(sc, p->es_port, p->es_pvid); 678262208Sadrian 679262208Sadrian /* Mutually exclusive. */ 680262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_ADDTAG && 681262208Sadrian p->es_flags & ETHERSWITCH_PORT_STRIPTAG) { 682262208Sadrian ARSWITCH_UNLOCK(sc); 683262208Sadrian return (EINVAL); 684262208Sadrian } 685262208Sadrian 686262208Sadrian reg = 0; 687262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG) 688262208Sadrian reg |= AR8X16_PORT_CTRL_DOUBLE_TAG; 689262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_ADDTAG) 690262208Sadrian reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD << 691262208Sadrian AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 692262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG) 693262208Sadrian reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP << 694262208Sadrian AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 695262208Sadrian 696262208Sadrian err = arswitch_modifyreg(sc->sc_dev, 697262208Sadrian AR8X16_REG_PORT_CTRL(p->es_port), 698262208Sadrian 0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT | 699262208Sadrian AR8X16_PORT_CTRL_DOUBLE_TAG, reg); 700262208Sadrian 701262208Sadrian ARSWITCH_UNLOCK(sc); 702262208Sadrian return (err); 703262208Sadrian} 704262208Sadrian 705262208Sadrianstatic int 706235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p) 707235288Sadrian{ 708235288Sadrian int err; 709235288Sadrian struct arswitch_softc *sc; 710235288Sadrian struct ifmedia *ifm; 711235288Sadrian struct mii_data *mii; 712235288Sadrian struct ifnet *ifp; 713235288Sadrian 714253572Sloos sc = device_get_softc(dev); 715253572Sloos if (p->es_port < 0 || p->es_port > sc->numphys) 716235288Sadrian return (ENXIO); 717235288Sadrian 718253572Sloos /* Port flags. */ 719253572Sloos if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) { 720262208Sadrian err = sc->hal.arswitch_port_vlan_setup(sc, p); 721253572Sloos if (err) 722253572Sloos return (err); 723262208Sadrian } 724253572Sloos 725253572Sloos /* Do not allow media changes on CPU port. */ 726253572Sloos if (p->es_port == AR8X16_PORT_CPU) 727253572Sloos return (0); 728253572Sloos 729235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 730235288Sadrian if (mii == NULL) 731235288Sadrian return (ENXIO); 732235288Sadrian 733235288Sadrian ifp = arswitch_ifpforport(sc, p->es_port); 734235288Sadrian 735235288Sadrian ifm = &mii->mii_media; 736253572Sloos return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA)); 737235288Sadrian} 738235288Sadrian 739235288Sadrianstatic void 740235288Sadrianarswitch_statchg(device_t dev) 741235288Sadrian{ 742235288Sadrian 743235288Sadrian DPRINTF(dev, "%s\n", __func__); 744235288Sadrian} 745235288Sadrian 746235288Sadrianstatic int 747235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp) 748235288Sadrian{ 749235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 750235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 751235288Sadrian 752235288Sadrian if (mii == NULL) 753235288Sadrian return (ENXIO); 754235288Sadrian mii_mediachg(mii); 755235288Sadrian return (0); 756235288Sadrian} 757235288Sadrian 758235288Sadrianstatic void 759235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 760235288Sadrian{ 761235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 762235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 763235288Sadrian 764235288Sadrian DPRINTF(sc->sc_dev, "%s\n", __func__); 765235288Sadrian 766235288Sadrian if (mii == NULL) 767235288Sadrian return; 768235288Sadrian mii_pollstat(mii); 769235288Sadrian ifmr->ifm_active = mii->mii_media_active; 770235288Sadrian ifmr->ifm_status = mii->mii_media_status; 771235288Sadrian} 772235288Sadrian 773253572Sloosstatic int 774253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf) 775253572Sloos{ 776253572Sloos struct arswitch_softc *sc; 777253572Sloos 778253572Sloos sc = device_get_softc(dev); 779253572Sloos 780253572Sloos /* Return the VLAN mode. */ 781253572Sloos conf->cmd = ETHERSWITCH_CONF_VLAN_MODE; 782253572Sloos conf->vlan_mode = sc->vlan_mode; 783253572Sloos 784253572Sloos return (0); 785253572Sloos} 786253572Sloos 787253572Sloosstatic int 788253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf) 789253572Sloos{ 790253572Sloos struct arswitch_softc *sc; 791253572Sloos int err; 792253572Sloos 793253572Sloos sc = device_get_softc(dev); 794253572Sloos 795253572Sloos /* Set the VLAN mode. */ 796253572Sloos if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) { 797253572Sloos err = arswitch_set_vlan_mode(sc, conf->vlan_mode); 798253572Sloos if (err != 0) 799253572Sloos return (err); 800253572Sloos } 801253572Sloos 802253572Sloos return (0); 803253572Sloos} 804253572Sloos 805262429Sadrianstatic int 806262429Sadrianarswitch_getvgroup(device_t dev, etherswitch_vlangroup_t *e) 807262429Sadrian{ 808262429Sadrian struct arswitch_softc *sc = device_get_softc(dev); 809262429Sadrian 810262429Sadrian return (sc->hal.arswitch_vlan_getvgroup(sc, e)); 811262429Sadrian} 812262429Sadrian 813262429Sadrianstatic int 814262429Sadrianarswitch_setvgroup(device_t dev, etherswitch_vlangroup_t *e) 815262429Sadrian{ 816262429Sadrian struct arswitch_softc *sc = device_get_softc(dev); 817262429Sadrian 818262429Sadrian return (sc->hal.arswitch_vlan_setvgroup(sc, e)); 819262429Sadrian} 820262429Sadrian 821279767Sadrianstatic int 822279767Sadrianarswitch_readphy(device_t dev, int phy, int reg) 823279767Sadrian{ 824279767Sadrian struct arswitch_softc *sc = device_get_softc(dev); 825279767Sadrian 826279767Sadrian return (sc->hal.arswitch_phy_read(dev, phy, reg)); 827279767Sadrian} 828279767Sadrian 829279767Sadrianstatic int 830279767Sadrianarswitch_writephy(device_t dev, int phy, int reg, int val) 831279767Sadrian{ 832279767Sadrian struct arswitch_softc *sc = device_get_softc(dev); 833279767Sadrian 834279767Sadrian return (sc->hal.arswitch_phy_write(dev, phy, reg, val)); 835279767Sadrian} 836279767Sadrian 837235288Sadrianstatic device_method_t arswitch_methods[] = { 838235288Sadrian /* Device interface */ 839235288Sadrian DEVMETHOD(device_probe, arswitch_probe), 840235288Sadrian DEVMETHOD(device_attach, arswitch_attach), 841235288Sadrian DEVMETHOD(device_detach, arswitch_detach), 842235288Sadrian 843235288Sadrian /* bus interface */ 844235288Sadrian DEVMETHOD(bus_add_child, device_add_child_ordered), 845235288Sadrian 846235288Sadrian /* MII interface */ 847235288Sadrian DEVMETHOD(miibus_readreg, arswitch_readphy), 848235288Sadrian DEVMETHOD(miibus_writereg, arswitch_writephy), 849235288Sadrian DEVMETHOD(miibus_statchg, arswitch_statchg), 850235288Sadrian 851235288Sadrian /* MDIO interface */ 852235288Sadrian DEVMETHOD(mdio_readreg, arswitch_readphy), 853235288Sadrian DEVMETHOD(mdio_writereg, arswitch_writephy), 854235288Sadrian 855235288Sadrian /* etherswitch interface */ 856241578Sray DEVMETHOD(etherswitch_lock, arswitch_lock), 857241578Sray DEVMETHOD(etherswitch_unlock, arswitch_unlock), 858235288Sadrian DEVMETHOD(etherswitch_getinfo, arswitch_getinfo), 859235288Sadrian DEVMETHOD(etherswitch_readreg, arswitch_readreg), 860235288Sadrian DEVMETHOD(etherswitch_writereg, arswitch_writereg), 861235288Sadrian DEVMETHOD(etherswitch_readphyreg, arswitch_readphy), 862235288Sadrian DEVMETHOD(etherswitch_writephyreg, arswitch_writephy), 863235288Sadrian DEVMETHOD(etherswitch_getport, arswitch_getport), 864235288Sadrian DEVMETHOD(etherswitch_setport, arswitch_setport), 865235288Sadrian DEVMETHOD(etherswitch_getvgroup, arswitch_getvgroup), 866235288Sadrian DEVMETHOD(etherswitch_setvgroup, arswitch_setvgroup), 867253572Sloos DEVMETHOD(etherswitch_getconf, arswitch_getconf), 868253572Sloos DEVMETHOD(etherswitch_setconf, arswitch_setconf), 869235288Sadrian 870235288Sadrian DEVMETHOD_END 871235288Sadrian}; 872235288Sadrian 873235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods, 874235288Sadrian sizeof(struct arswitch_softc)); 875235288Sadrianstatic devclass_t arswitch_devclass; 876235288Sadrian 877235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0); 878235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0); 879235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0); 880235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0); 881235288SadrianMODULE_VERSION(arswitch, 1); 882235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */ 883235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */ 884