arswitch.c revision 262429
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 262429 2014-02-24 04:44:28Z 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> 50235288Sadrian#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> 69256582Sadrian#include <dev/etherswitch/arswitch/arswitch_9340.h> 70235288Sadrian 71235288Sadrian#include "mdio_if.h" 72235288Sadrian#include "miibus_if.h" 73235288Sadrian#include "etherswitch_if.h" 74235288Sadrian 75235288Sadrian#if defined(DEBUG) 76235288Sadrianstatic SYSCTL_NODE(_debug, OID_AUTO, arswitch, CTLFLAG_RD, 0, "arswitch"); 77235288Sadrian#endif 78235288Sadrian 79235288Sadrianstatic inline int arswitch_portforphy(int phy); 80235288Sadrianstatic void arswitch_tick(void *arg); 81235288Sadrianstatic int arswitch_ifmedia_upd(struct ifnet *); 82235288Sadrianstatic void arswitch_ifmedia_sts(struct ifnet *, struct ifmediareq *); 83262208Sadrianstatic int ar8xxx_port_vlan_setup(struct arswitch_softc *sc, 84262208Sadrian etherswitch_port_t *p); 85262208Sadrianstatic int ar8xxx_port_vlan_get(struct arswitch_softc *sc, 86262208Sadrian etherswitch_port_t *p); 87235288Sadrian 88235288Sadrianstatic int 89235288Sadrianarswitch_probe(device_t dev) 90235288Sadrian{ 91235288Sadrian struct arswitch_softc *sc; 92235288Sadrian uint32_t id; 93235288Sadrian char *chipname, desc[256]; 94235288Sadrian 95235288Sadrian sc = device_get_softc(dev); 96235288Sadrian bzero(sc, sizeof(*sc)); 97235288Sadrian sc->page = -1; 98235323Sadrian 99235323Sadrian /* AR7240 probe */ 100235323Sadrian if (ar7240_probe(dev) == 0) { 101235323Sadrian chipname = "AR7240"; 102235323Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR7240; 103256582Sadrian sc->is_internal_switch = 1; 104241577Sray id = 0; 105235323Sadrian goto done; 106235323Sadrian } 107235323Sadrian 108256582Sadrian /* AR9340 probe */ 109256582Sadrian if (ar9340_probe(dev) == 0) { 110256582Sadrian chipname = "AR9340"; 111256582Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR9340; 112256582Sadrian sc->is_internal_switch = 1; 113256582Sadrian id = 0; 114256582Sadrian goto done; 115256582Sadrian } 116256582Sadrian 117235323Sadrian /* AR8xxx probe */ 118235288Sadrian id = arswitch_readreg(dev, AR8X16_REG_MASK_CTRL); 119262201Sadrian sc->chip_rev = (id & AR8X16_MASK_CTRL_REV_MASK); 120262201Sadrian sc->chip_ver = (id & AR8X16_MASK_CTRL_VER_MASK) > AR8X16_MASK_CTRL_VER_SHIFT; 121256582Sadrian switch (id & (AR8X16_MASK_CTRL_VER_MASK | AR8X16_MASK_CTRL_REV_MASK)) { 122256582Sadrian case 0x0101: 123235288Sadrian chipname = "AR8216"; 124235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8216; 125235288Sadrian break; 126256582Sadrian case 0x0201: 127235288Sadrian chipname = "AR8226"; 128235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8226; 129235288Sadrian break; 130256582Sadrian /* 0x0301 - AR8236 */ 131256582Sadrian case 0x1000: 132256582Sadrian case 0x1001: 133235288Sadrian chipname = "AR8316"; 134235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8316; 135235288Sadrian break; 136262202Sadrian case 0x1202: 137262202Sadrian chipname = "AR8327"; 138262202Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8327; 139262202Sadrian sc->mii_lo_first = 1; 140262202Sadrian break; 141235288Sadrian default: 142235288Sadrian chipname = NULL; 143235288Sadrian } 144235323Sadrian 145235323Sadriandone: 146256582Sadrian 147256582Sadrian DPRINTF(dev, "chipname=%s, id=%08x\n", chipname, id); 148235288Sadrian if (chipname != NULL) { 149235288Sadrian snprintf(desc, sizeof(desc), 150235288Sadrian "Atheros %s Ethernet Switch", 151235288Sadrian chipname); 152235288Sadrian device_set_desc_copy(dev, desc); 153235288Sadrian return (BUS_PROBE_DEFAULT); 154235288Sadrian } 155235288Sadrian return (ENXIO); 156235288Sadrian} 157235288Sadrian 158235288Sadrianstatic int 159235288Sadrianarswitch_attach_phys(struct arswitch_softc *sc) 160235288Sadrian{ 161235288Sadrian int phy, err = 0; 162235288Sadrian char name[IFNAMSIZ]; 163235288Sadrian 164235288Sadrian /* PHYs need an interface, so we generate a dummy one */ 165235288Sadrian snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev)); 166235288Sadrian for (phy = 0; phy < sc->numphys; phy++) { 167235288Sadrian sc->ifp[phy] = if_alloc(IFT_ETHER); 168235288Sadrian sc->ifp[phy]->if_softc = sc; 169235288Sadrian sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST | 170235288Sadrian IFF_DRV_RUNNING | IFF_SIMPLEX; 171235288Sadrian sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK); 172235288Sadrian bcopy(name, sc->ifname[phy], strlen(name)+1); 173235288Sadrian if_initname(sc->ifp[phy], sc->ifname[phy], 174235288Sadrian arswitch_portforphy(phy)); 175235288Sadrian err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy], 176235288Sadrian arswitch_ifmedia_upd, arswitch_ifmedia_sts, \ 177235288Sadrian BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0); 178235288Sadrian DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n", 179235288Sadrian device_get_nameunit(sc->miibus[phy]), 180235288Sadrian sc->ifp[phy]->if_xname); 181235288Sadrian if (err != 0) { 182235288Sadrian device_printf(sc->sc_dev, 183235288Sadrian "attaching PHY %d failed\n", 184235288Sadrian phy); 185235288Sadrian } 186235288Sadrian } 187235288Sadrian return (err); 188235288Sadrian} 189235288Sadrian 190235288Sadrianstatic int 191253572Sloosarswitch_reset(device_t dev) 192253572Sloos{ 193253572Sloos 194253572Sloos arswitch_writereg(dev, AR8X16_REG_MASK_CTRL, 195253572Sloos AR8X16_MASK_CTRL_SOFT_RESET); 196253572Sloos DELAY(1000); 197253572Sloos if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) & 198253572Sloos AR8X16_MASK_CTRL_SOFT_RESET) { 199253572Sloos device_printf(dev, "unable to reset switch\n"); 200253572Sloos return (-1); 201253572Sloos } 202253572Sloos return (0); 203253572Sloos} 204253572Sloos 205253572Sloosstatic int 206253572Sloosarswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode) 207253572Sloos{ 208253572Sloos 209253572Sloos /* Check for invalid modes. */ 210253572Sloos if ((mode & sc->info.es_vlan_caps) != mode) 211253572Sloos return (EINVAL); 212253572Sloos 213253572Sloos switch (mode) { 214253572Sloos case ETHERSWITCH_VLAN_DOT1Q: 215253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q; 216253572Sloos break; 217253572Sloos case ETHERSWITCH_VLAN_PORT: 218253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_PORT; 219253572Sloos break; 220253572Sloos default: 221253572Sloos sc->vlan_mode = 0; 222253572Sloos }; 223253572Sloos 224253572Sloos /* Reset VLANs. */ 225262429Sadrian sc->hal.arswitch_vlan_init_hw(sc); 226253572Sloos 227253572Sloos return (0); 228253572Sloos} 229253572Sloos 230253572Sloosstatic void 231262208Sadrianar8xxx_port_init(struct arswitch_softc *sc, int port) 232253572Sloos{ 233253572Sloos 234253572Sloos /* Port0 - CPU */ 235262203Sadrian if (port == AR8X16_PORT_CPU) { 236262203Sadrian arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0), 237262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 238262203Sadrian AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) | 239262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) | 240262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) | 241262203Sadrian AR8X16_PORT_STS_RXMAC | 242262203Sadrian AR8X16_PORT_STS_TXMAC | 243262203Sadrian AR8X16_PORT_STS_DUPLEX); 244262203Sadrian arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0), 245262203Sadrian arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) & 246262203Sadrian ~AR8X16_PORT_CTRL_HEADER); 247262203Sadrian } else { 248253572Sloos /* Set ports to auto negotiation. */ 249253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port), 250253572Sloos AR8X16_PORT_STS_LINK_AUTO); 251253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port), 252253572Sloos arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) & 253253572Sloos ~AR8X16_PORT_CTRL_HEADER); 254253572Sloos } 255253572Sloos} 256253572Sloos 257253572Sloosstatic int 258235288Sadrianarswitch_attach(device_t dev) 259235288Sadrian{ 260235288Sadrian struct arswitch_softc *sc; 261235288Sadrian int err = 0; 262262203Sadrian int port; 263235288Sadrian 264235288Sadrian sc = device_get_softc(dev); 265235288Sadrian 266235288Sadrian /* sc->sc_switchtype is already decided in arswitch_probe() */ 267235288Sadrian sc->sc_dev = dev; 268235288Sadrian mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF); 269235288Sadrian sc->page = -1; 270235288Sadrian strlcpy(sc->info.es_name, device_get_desc(dev), 271235288Sadrian sizeof(sc->info.es_name)); 272235288Sadrian 273262206Sadrian /* Default HAL methods */ 274262208Sadrian sc->hal.arswitch_port_init = ar8xxx_port_init; 275262208Sadrian sc->hal.arswitch_port_vlan_setup = ar8xxx_port_vlan_setup; 276262208Sadrian sc->hal.arswitch_port_vlan_get = ar8xxx_port_vlan_get; 277262429Sadrian sc->hal.arswitch_vlan_init_hw = ar8xxx_reset_vlans; 278262429Sadrian sc->hal.arswitch_vlan_getvgroup = ar8xxx_getvgroup; 279262429Sadrian sc->hal.arswitch_vlan_setvgroup = ar8xxx_setvgroup; 280262429Sadrian sc->hal.arswitch_vlan_get_pvid = ar8xxx_get_pvid; 281262429Sadrian sc->hal.arswitch_vlan_set_pvid = ar8xxx_set_pvid; 282262206Sadrian 283235288Sadrian /* 284235288Sadrian * Attach switch related functions 285235288Sadrian */ 286235323Sadrian if (AR8X16_IS_SWITCH(sc, AR7240)) 287235323Sadrian ar7240_attach(sc); 288256582Sadrian else if (AR8X16_IS_SWITCH(sc, AR9340)) 289256582Sadrian ar9340_attach(sc); 290235323Sadrian else if (AR8X16_IS_SWITCH(sc, AR8216)) 291235288Sadrian ar8216_attach(sc); 292235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8226)) 293235288Sadrian ar8226_attach(sc); 294235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8316)) 295235288Sadrian ar8316_attach(sc); 296235288Sadrian else 297235288Sadrian return (ENXIO); 298235288Sadrian 299253572Sloos /* Common defaults. */ 300235288Sadrian sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */ 301235288Sadrian 302235288Sadrian /* XXX Defaults for externally connected AR8316 */ 303235288Sadrian sc->numphys = 4; 304235288Sadrian sc->phy4cpu = 1; 305235288Sadrian sc->is_rgmii = 1; 306235288Sadrian sc->is_gmii = 0; 307256582Sadrian sc->is_mii = 0; 308235288Sadrian 309235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 310235288Sadrian "numphys", &sc->numphys); 311235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 312235288Sadrian "phy4cpu", &sc->phy4cpu); 313235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 314235288Sadrian "is_rgmii", &sc->is_rgmii); 315235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 316235288Sadrian "is_gmii", &sc->is_gmii); 317256582Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 318256582Sadrian "is_mii", &sc->is_mii); 319235288Sadrian 320253572Sloos if (sc->numphys > AR8X16_NUM_PHYS) 321253572Sloos sc->numphys = AR8X16_NUM_PHYS; 322253572Sloos 323253572Sloos /* Reset the switch. */ 324253572Sloos if (arswitch_reset(dev)) 325235288Sadrian return (ENXIO); 326235288Sadrian 327256582Sadrian err = sc->hal.arswitch_hw_setup(sc); 328256582Sadrian if (err != 0) 329256582Sadrian return (err); 330256582Sadrian 331235288Sadrian err = sc->hal.arswitch_hw_global_setup(sc); 332235288Sadrian if (err != 0) 333235288Sadrian return (err); 334235288Sadrian 335253572Sloos /* Initialize the switch ports. */ 336262203Sadrian for (port = 0; port <= sc->numphys; port++) { 337262206Sadrian sc->hal.arswitch_port_init(sc, port); 338262203Sadrian } 339253572Sloos 340235288Sadrian /* 341235288Sadrian * Attach the PHYs and complete the bus enumeration. 342235288Sadrian */ 343235288Sadrian err = arswitch_attach_phys(sc); 344235288Sadrian if (err != 0) 345235288Sadrian return (err); 346235288Sadrian 347253572Sloos /* Default to ingress filters off. */ 348253572Sloos err = arswitch_set_vlan_mode(sc, 0); 349253572Sloos if (err != 0) 350253572Sloos return (err); 351253572Sloos 352235288Sadrian bus_generic_probe(dev); 353235288Sadrian bus_enumerate_hinted_children(dev); 354235288Sadrian err = bus_generic_attach(dev); 355235288Sadrian if (err != 0) 356235288Sadrian return (err); 357235288Sadrian 358235288Sadrian callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0); 359241578Sray 360241578Sray ARSWITCH_LOCK(sc); 361235288Sadrian arswitch_tick(sc); 362241578Sray ARSWITCH_UNLOCK(sc); 363235288Sadrian 364235288Sadrian return (err); 365235288Sadrian} 366235288Sadrian 367235288Sadrianstatic int 368235288Sadrianarswitch_detach(device_t dev) 369235288Sadrian{ 370235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 371235288Sadrian int i; 372235288Sadrian 373235288Sadrian callout_drain(&sc->callout_tick); 374235288Sadrian 375235288Sadrian for (i=0; i < sc->numphys; i++) { 376235288Sadrian if (sc->miibus[i] != NULL) 377235288Sadrian device_delete_child(dev, sc->miibus[i]); 378235288Sadrian if (sc->ifp[i] != NULL) 379235288Sadrian if_free(sc->ifp[i]); 380235288Sadrian free(sc->ifname[i], M_DEVBUF); 381235288Sadrian } 382235288Sadrian 383235288Sadrian bus_generic_detach(dev); 384235288Sadrian mtx_destroy(&sc->sc_mtx); 385235288Sadrian 386235288Sadrian return (0); 387235288Sadrian} 388235288Sadrian 389235288Sadrian/* 390235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to 391235288Sadrian * port 2, etc. 392235288Sadrian */ 393235288Sadrianstatic inline int 394235288Sadrianarswitch_portforphy(int phy) 395235288Sadrian{ 396235288Sadrian return (phy+1); 397235288Sadrian} 398235288Sadrian 399235288Sadrianstatic inline struct mii_data * 400235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port) 401235288Sadrian{ 402235288Sadrian int phy = port-1; 403235288Sadrian 404235288Sadrian if (phy < 0 || phy >= sc->numphys) 405235288Sadrian return (NULL); 406235288Sadrian return (device_get_softc(sc->miibus[phy])); 407235288Sadrian} 408235288Sadrian 409235288Sadrianstatic inline struct ifnet * 410235288Sadrianarswitch_ifpforport(struct arswitch_softc *sc, int port) 411235288Sadrian{ 412235288Sadrian int phy = port-1; 413235288Sadrian 414235288Sadrian if (phy < 0 || phy >= sc->numphys) 415235288Sadrian return (NULL); 416235288Sadrian return (sc->ifp[phy]); 417235288Sadrian} 418235288Sadrian 419235288Sadrian/* 420235288Sadrian * Convert port status to ifmedia. 421235288Sadrian */ 422235288Sadrianstatic void 423235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active) 424235288Sadrian{ 425235288Sadrian *media_active = IFM_ETHER; 426235288Sadrian *media_status = IFM_AVALID; 427235288Sadrian 428235288Sadrian if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0) 429235288Sadrian *media_status |= IFM_ACTIVE; 430235288Sadrian else { 431235288Sadrian *media_active |= IFM_NONE; 432235288Sadrian return; 433235288Sadrian } 434235288Sadrian switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) { 435235288Sadrian case AR8X16_PORT_STS_SPEED_10: 436235288Sadrian *media_active |= IFM_10_T; 437235288Sadrian break; 438235288Sadrian case AR8X16_PORT_STS_SPEED_100: 439235288Sadrian *media_active |= IFM_100_TX; 440235288Sadrian break; 441235288Sadrian case AR8X16_PORT_STS_SPEED_1000: 442235288Sadrian *media_active |= IFM_1000_T; 443235288Sadrian break; 444235288Sadrian } 445235288Sadrian if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0) 446235288Sadrian *media_active |= IFM_FDX; 447235288Sadrian else 448235288Sadrian *media_active |= IFM_HDX; 449235288Sadrian if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0) 450235288Sadrian *media_active |= IFM_ETH_TXPAUSE; 451235288Sadrian if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0) 452235288Sadrian *media_active |= IFM_ETH_RXPAUSE; 453235288Sadrian} 454235288Sadrian 455235288Sadrian/* 456235288Sadrian * Poll the status for all PHYs. We're using the switch port status because 457235288Sadrian * thats a lot quicker to read than talking to all the PHYs. Care must be 458235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will 459235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs 460235288Sadrian * update function is called. 461235288Sadrian */ 462235288Sadrianstatic void 463235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc) 464235288Sadrian{ 465235288Sadrian int i; 466235288Sadrian struct mii_data *mii; 467235288Sadrian struct mii_softc *miisc; 468235288Sadrian int portstatus; 469235288Sadrian 470241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 471241578Sray 472235288Sadrian for (i = 0; i < sc->numphys; i++) { 473235288Sadrian if (sc->miibus[i] == NULL) 474235288Sadrian continue; 475235288Sadrian mii = device_get_softc(sc->miibus[i]); 476262206Sadrian /* XXX This would be nice to have abstracted out to be per-chip */ 477262206Sadrian /* AR8327/AR8337 has a different register base */ 478262206Sadrian if (AR8X16_IS_SWITCH(sc, AR8327)) 479262206Sadrian portstatus = arswitch_readreg(sc->sc_dev, 480262206Sadrian AR8327_REG_PORT_STATUS(arswitch_portforphy(i))); 481262206Sadrian else 482262206Sadrian portstatus = arswitch_readreg(sc->sc_dev, 483262206Sadrian AR8X16_REG_PORT_STS(arswitch_portforphy(i))); 484262206Sadrian 485235288Sadrian#if 0 486235288Sadrian DPRINTF(sc->sc_dev, "p[%d]=%b\n", 487256582Sadrian i, 488235288Sadrian portstatus, 489235288Sadrian "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7" 490235288Sadrian "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE"); 491235288Sadrian#endif 492235288Sadrian arswitch_update_ifmedia(portstatus, &mii->mii_media_status, 493235288Sadrian &mii->mii_media_active); 494235288Sadrian LIST_FOREACH(miisc, &mii->mii_phys, mii_list) { 495235288Sadrian if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) != 496235288Sadrian miisc->mii_inst) 497235288Sadrian continue; 498235288Sadrian mii_phy_update(miisc, MII_POLLSTAT); 499235288Sadrian } 500235288Sadrian } 501235288Sadrian} 502235288Sadrian 503235288Sadrianstatic void 504235288Sadrianarswitch_tick(void *arg) 505235288Sadrian{ 506235288Sadrian struct arswitch_softc *sc = arg; 507235288Sadrian 508235288Sadrian arswitch_miipollstat(sc); 509235288Sadrian callout_reset(&sc->callout_tick, hz, arswitch_tick, sc); 510235288Sadrian} 511235288Sadrian 512241578Sraystatic void 513241578Srayarswitch_lock(device_t dev) 514241578Sray{ 515241578Sray struct arswitch_softc *sc = device_get_softc(dev); 516241578Sray 517241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED); 518241578Sray ARSWITCH_LOCK(sc); 519241578Sray} 520241578Sray 521241578Sraystatic void 522241578Srayarswitch_unlock(device_t dev) 523241578Sray{ 524241578Sray struct arswitch_softc *sc = device_get_softc(dev); 525241578Sray 526241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 527241578Sray ARSWITCH_UNLOCK(sc); 528241578Sray} 529241578Sray 530235288Sadrianstatic etherswitch_info_t * 531235288Sadrianarswitch_getinfo(device_t dev) 532235288Sadrian{ 533235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 534235288Sadrian 535235288Sadrian return (&sc->info); 536235288Sadrian} 537235288Sadrian 538235288Sadrianstatic int 539262208Sadrianar8xxx_port_vlan_get(struct arswitch_softc *sc, etherswitch_port_t *p) 540235288Sadrian{ 541253572Sloos uint32_t reg; 542253572Sloos 543253572Sloos ARSWITCH_LOCK(sc); 544253572Sloos 545253572Sloos /* Retrieve the PVID. */ 546262429Sadrian sc->hal.arswitch_vlan_get_pvid(sc, p->es_port, &p->es_pvid); 547253572Sloos 548253572Sloos /* Port flags. */ 549253572Sloos reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port)); 550253572Sloos if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG) 551253572Sloos p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG; 552253572Sloos reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 553253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD) 554253572Sloos p->es_flags |= ETHERSWITCH_PORT_ADDTAG; 555253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP) 556253572Sloos p->es_flags |= ETHERSWITCH_PORT_STRIPTAG; 557253572Sloos ARSWITCH_UNLOCK(sc); 558253572Sloos 559262208Sadrian return (0); 560262208Sadrian} 561262208Sadrian 562262208Sadrianstatic int 563262208Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p) 564262208Sadrian{ 565262208Sadrian struct arswitch_softc *sc; 566262208Sadrian struct mii_data *mii; 567262208Sadrian struct ifmediareq *ifmr; 568262208Sadrian int err; 569262208Sadrian 570262208Sadrian sc = device_get_softc(dev); 571262208Sadrian if (p->es_port < 0 || p->es_port > sc->numphys) 572262208Sadrian return (ENXIO); 573262208Sadrian 574262208Sadrian err = sc->hal.arswitch_port_vlan_get(sc, p); 575262208Sadrian if (err != 0) 576262208Sadrian return (err); 577262208Sadrian 578235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 579262208Sadrian if (p->es_port == AR8X16_PORT_CPU) { 580235288Sadrian /* fill in fixed values for CPU port */ 581262208Sadrian /* XXX is this valid in all cases? */ 582250383Sadrian p->es_flags |= ETHERSWITCH_PORT_CPU; 583253572Sloos ifmr = &p->es_ifmr; 584235288Sadrian ifmr->ifm_count = 0; 585235288Sadrian ifmr->ifm_current = ifmr->ifm_active = 586235288Sadrian IFM_ETHER | IFM_1000_T | IFM_FDX; 587235288Sadrian ifmr->ifm_mask = 0; 588235288Sadrian ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID; 589235288Sadrian } else if (mii != NULL) { 590235288Sadrian err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr, 591235288Sadrian &mii->mii_media, SIOCGIFMEDIA); 592235288Sadrian if (err) 593235288Sadrian return (err); 594235288Sadrian } else { 595235288Sadrian return (ENXIO); 596235288Sadrian } 597235288Sadrian return (0); 598235288Sadrian} 599235288Sadrian 600235288Sadrianstatic int 601262208Sadrianar8xxx_port_vlan_setup(struct arswitch_softc *sc, etherswitch_port_t *p) 602262208Sadrian{ 603262208Sadrian uint32_t reg; 604262208Sadrian int err; 605262208Sadrian 606262208Sadrian ARSWITCH_LOCK(sc); 607262208Sadrian 608262208Sadrian /* Set the PVID. */ 609262208Sadrian if (p->es_pvid != 0) 610262429Sadrian sc->hal.arswitch_vlan_set_pvid(sc, p->es_port, p->es_pvid); 611262208Sadrian 612262208Sadrian /* Mutually exclusive. */ 613262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_ADDTAG && 614262208Sadrian p->es_flags & ETHERSWITCH_PORT_STRIPTAG) { 615262208Sadrian ARSWITCH_UNLOCK(sc); 616262208Sadrian return (EINVAL); 617262208Sadrian } 618262208Sadrian 619262208Sadrian reg = 0; 620262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG) 621262208Sadrian reg |= AR8X16_PORT_CTRL_DOUBLE_TAG; 622262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_ADDTAG) 623262208Sadrian reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD << 624262208Sadrian AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 625262208Sadrian if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG) 626262208Sadrian reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP << 627262208Sadrian AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 628262208Sadrian 629262208Sadrian err = arswitch_modifyreg(sc->sc_dev, 630262208Sadrian AR8X16_REG_PORT_CTRL(p->es_port), 631262208Sadrian 0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT | 632262208Sadrian AR8X16_PORT_CTRL_DOUBLE_TAG, reg); 633262208Sadrian 634262208Sadrian ARSWITCH_UNLOCK(sc); 635262208Sadrian return (err); 636262208Sadrian} 637262208Sadrian 638262208Sadrianstatic int 639235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p) 640235288Sadrian{ 641235288Sadrian int err; 642235288Sadrian struct arswitch_softc *sc; 643235288Sadrian struct ifmedia *ifm; 644235288Sadrian struct mii_data *mii; 645235288Sadrian struct ifnet *ifp; 646235288Sadrian 647253572Sloos sc = device_get_softc(dev); 648253572Sloos if (p->es_port < 0 || p->es_port > sc->numphys) 649235288Sadrian return (ENXIO); 650235288Sadrian 651253572Sloos /* Port flags. */ 652253572Sloos if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) { 653262208Sadrian err = sc->hal.arswitch_port_vlan_setup(sc, p); 654253572Sloos if (err) 655253572Sloos return (err); 656262208Sadrian } 657253572Sloos 658253572Sloos /* Do not allow media changes on CPU port. */ 659253572Sloos if (p->es_port == AR8X16_PORT_CPU) 660253572Sloos return (0); 661253572Sloos 662235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 663235288Sadrian if (mii == NULL) 664235288Sadrian return (ENXIO); 665235288Sadrian 666235288Sadrian ifp = arswitch_ifpforport(sc, p->es_port); 667235288Sadrian 668235288Sadrian ifm = &mii->mii_media; 669253572Sloos return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA)); 670235288Sadrian} 671235288Sadrian 672235288Sadrianstatic void 673235288Sadrianarswitch_statchg(device_t dev) 674235288Sadrian{ 675235288Sadrian 676235288Sadrian DPRINTF(dev, "%s\n", __func__); 677235288Sadrian} 678235288Sadrian 679235288Sadrianstatic int 680235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp) 681235288Sadrian{ 682235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 683235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 684235288Sadrian 685235288Sadrian if (mii == NULL) 686235288Sadrian return (ENXIO); 687235288Sadrian mii_mediachg(mii); 688235288Sadrian return (0); 689235288Sadrian} 690235288Sadrian 691235288Sadrianstatic void 692235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 693235288Sadrian{ 694235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 695235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 696235288Sadrian 697235288Sadrian DPRINTF(sc->sc_dev, "%s\n", __func__); 698235288Sadrian 699235288Sadrian if (mii == NULL) 700235288Sadrian return; 701235288Sadrian mii_pollstat(mii); 702235288Sadrian ifmr->ifm_active = mii->mii_media_active; 703235288Sadrian ifmr->ifm_status = mii->mii_media_status; 704235288Sadrian} 705235288Sadrian 706253572Sloosstatic int 707253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf) 708253572Sloos{ 709253572Sloos struct arswitch_softc *sc; 710253572Sloos 711253572Sloos sc = device_get_softc(dev); 712253572Sloos 713253572Sloos /* Return the VLAN mode. */ 714253572Sloos conf->cmd = ETHERSWITCH_CONF_VLAN_MODE; 715253572Sloos conf->vlan_mode = sc->vlan_mode; 716253572Sloos 717253572Sloos return (0); 718253572Sloos} 719253572Sloos 720253572Sloosstatic int 721253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf) 722253572Sloos{ 723253572Sloos struct arswitch_softc *sc; 724253572Sloos int err; 725253572Sloos 726253572Sloos sc = device_get_softc(dev); 727253572Sloos 728253572Sloos /* Set the VLAN mode. */ 729253572Sloos if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) { 730253572Sloos err = arswitch_set_vlan_mode(sc, conf->vlan_mode); 731253572Sloos if (err != 0) 732253572Sloos return (err); 733253572Sloos } 734253572Sloos 735253572Sloos return (0); 736253572Sloos} 737253572Sloos 738262429Sadrianstatic int 739262429Sadrianarswitch_getvgroup(device_t dev, etherswitch_vlangroup_t *e) 740262429Sadrian{ 741262429Sadrian struct arswitch_softc *sc = device_get_softc(dev); 742262429Sadrian 743262429Sadrian return (sc->hal.arswitch_vlan_getvgroup(sc, e)); 744262429Sadrian} 745262429Sadrian 746262429Sadrianstatic int 747262429Sadrianarswitch_setvgroup(device_t dev, etherswitch_vlangroup_t *e) 748262429Sadrian{ 749262429Sadrian struct arswitch_softc *sc = device_get_softc(dev); 750262429Sadrian 751262429Sadrian return (sc->hal.arswitch_vlan_setvgroup(sc, e)); 752262429Sadrian} 753262429Sadrian 754235288Sadrianstatic device_method_t arswitch_methods[] = { 755235288Sadrian /* Device interface */ 756235288Sadrian DEVMETHOD(device_probe, arswitch_probe), 757235288Sadrian DEVMETHOD(device_attach, arswitch_attach), 758235288Sadrian DEVMETHOD(device_detach, arswitch_detach), 759235288Sadrian 760235288Sadrian /* bus interface */ 761235288Sadrian DEVMETHOD(bus_add_child, device_add_child_ordered), 762235288Sadrian 763235288Sadrian /* MII interface */ 764235288Sadrian DEVMETHOD(miibus_readreg, arswitch_readphy), 765235288Sadrian DEVMETHOD(miibus_writereg, arswitch_writephy), 766235288Sadrian DEVMETHOD(miibus_statchg, arswitch_statchg), 767235288Sadrian 768235288Sadrian /* MDIO interface */ 769235288Sadrian DEVMETHOD(mdio_readreg, arswitch_readphy), 770235288Sadrian DEVMETHOD(mdio_writereg, arswitch_writephy), 771235288Sadrian 772235288Sadrian /* etherswitch interface */ 773241578Sray DEVMETHOD(etherswitch_lock, arswitch_lock), 774241578Sray DEVMETHOD(etherswitch_unlock, arswitch_unlock), 775235288Sadrian DEVMETHOD(etherswitch_getinfo, arswitch_getinfo), 776235288Sadrian DEVMETHOD(etherswitch_readreg, arswitch_readreg), 777235288Sadrian DEVMETHOD(etherswitch_writereg, arswitch_writereg), 778235288Sadrian DEVMETHOD(etherswitch_readphyreg, arswitch_readphy), 779235288Sadrian DEVMETHOD(etherswitch_writephyreg, arswitch_writephy), 780235288Sadrian DEVMETHOD(etherswitch_getport, arswitch_getport), 781235288Sadrian DEVMETHOD(etherswitch_setport, arswitch_setport), 782235288Sadrian DEVMETHOD(etherswitch_getvgroup, arswitch_getvgroup), 783235288Sadrian DEVMETHOD(etherswitch_setvgroup, arswitch_setvgroup), 784253572Sloos DEVMETHOD(etherswitch_getconf, arswitch_getconf), 785253572Sloos DEVMETHOD(etherswitch_setconf, arswitch_setconf), 786235288Sadrian 787235288Sadrian DEVMETHOD_END 788235288Sadrian}; 789235288Sadrian 790235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods, 791235288Sadrian sizeof(struct arswitch_softc)); 792235288Sadrianstatic devclass_t arswitch_devclass; 793235288Sadrian 794235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0); 795235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0); 796235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0); 797235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0); 798235288SadrianMODULE_VERSION(arswitch, 1); 799235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */ 800235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */ 801