arswitch.c revision 262206
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 262206 2014-02-19 06:03:58Z 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 *); 83235288Sadrian 84235288Sadrianstatic int 85235288Sadrianarswitch_probe(device_t dev) 86235288Sadrian{ 87235288Sadrian struct arswitch_softc *sc; 88235288Sadrian uint32_t id; 89235288Sadrian char *chipname, desc[256]; 90235288Sadrian 91235288Sadrian sc = device_get_softc(dev); 92235288Sadrian bzero(sc, sizeof(*sc)); 93235288Sadrian sc->page = -1; 94235323Sadrian 95235323Sadrian /* AR7240 probe */ 96235323Sadrian if (ar7240_probe(dev) == 0) { 97235323Sadrian chipname = "AR7240"; 98235323Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR7240; 99256582Sadrian sc->is_internal_switch = 1; 100241577Sray id = 0; 101235323Sadrian goto done; 102235323Sadrian } 103235323Sadrian 104256582Sadrian /* AR9340 probe */ 105256582Sadrian if (ar9340_probe(dev) == 0) { 106256582Sadrian chipname = "AR9340"; 107256582Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR9340; 108256582Sadrian sc->is_internal_switch = 1; 109256582Sadrian id = 0; 110256582Sadrian goto done; 111256582Sadrian } 112256582Sadrian 113235323Sadrian /* AR8xxx probe */ 114235288Sadrian id = arswitch_readreg(dev, AR8X16_REG_MASK_CTRL); 115262201Sadrian sc->chip_rev = (id & AR8X16_MASK_CTRL_REV_MASK); 116262201Sadrian sc->chip_ver = (id & AR8X16_MASK_CTRL_VER_MASK) > AR8X16_MASK_CTRL_VER_SHIFT; 117256582Sadrian switch (id & (AR8X16_MASK_CTRL_VER_MASK | AR8X16_MASK_CTRL_REV_MASK)) { 118256582Sadrian case 0x0101: 119235288Sadrian chipname = "AR8216"; 120235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8216; 121235288Sadrian break; 122256582Sadrian case 0x0201: 123235288Sadrian chipname = "AR8226"; 124235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8226; 125235288Sadrian break; 126256582Sadrian /* 0x0301 - AR8236 */ 127256582Sadrian case 0x1000: 128256582Sadrian case 0x1001: 129235288Sadrian chipname = "AR8316"; 130235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8316; 131235288Sadrian break; 132262202Sadrian case 0x1202: 133262202Sadrian chipname = "AR8327"; 134262202Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8327; 135262202Sadrian sc->mii_lo_first = 1; 136262202Sadrian break; 137235288Sadrian default: 138235288Sadrian chipname = NULL; 139235288Sadrian } 140235323Sadrian 141235323Sadriandone: 142256582Sadrian 143256582Sadrian DPRINTF(dev, "chipname=%s, id=%08x\n", chipname, id); 144235288Sadrian if (chipname != NULL) { 145235288Sadrian snprintf(desc, sizeof(desc), 146235288Sadrian "Atheros %s Ethernet Switch", 147235288Sadrian chipname); 148235288Sadrian device_set_desc_copy(dev, desc); 149235288Sadrian return (BUS_PROBE_DEFAULT); 150235288Sadrian } 151235288Sadrian return (ENXIO); 152235288Sadrian} 153235288Sadrian 154235288Sadrianstatic int 155235288Sadrianarswitch_attach_phys(struct arswitch_softc *sc) 156235288Sadrian{ 157235288Sadrian int phy, err = 0; 158235288Sadrian char name[IFNAMSIZ]; 159235288Sadrian 160235288Sadrian /* PHYs need an interface, so we generate a dummy one */ 161235288Sadrian snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev)); 162235288Sadrian for (phy = 0; phy < sc->numphys; phy++) { 163235288Sadrian sc->ifp[phy] = if_alloc(IFT_ETHER); 164235288Sadrian sc->ifp[phy]->if_softc = sc; 165235288Sadrian sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST | 166235288Sadrian IFF_DRV_RUNNING | IFF_SIMPLEX; 167235288Sadrian sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK); 168235288Sadrian bcopy(name, sc->ifname[phy], strlen(name)+1); 169235288Sadrian if_initname(sc->ifp[phy], sc->ifname[phy], 170235288Sadrian arswitch_portforphy(phy)); 171235288Sadrian err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy], 172235288Sadrian arswitch_ifmedia_upd, arswitch_ifmedia_sts, \ 173235288Sadrian BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0); 174235288Sadrian DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n", 175235288Sadrian device_get_nameunit(sc->miibus[phy]), 176235288Sadrian sc->ifp[phy]->if_xname); 177235288Sadrian if (err != 0) { 178235288Sadrian device_printf(sc->sc_dev, 179235288Sadrian "attaching PHY %d failed\n", 180235288Sadrian phy); 181235288Sadrian } 182235288Sadrian } 183235288Sadrian return (err); 184235288Sadrian} 185235288Sadrian 186235288Sadrianstatic int 187253572Sloosarswitch_reset(device_t dev) 188253572Sloos{ 189253572Sloos 190253572Sloos arswitch_writereg(dev, AR8X16_REG_MASK_CTRL, 191253572Sloos AR8X16_MASK_CTRL_SOFT_RESET); 192253572Sloos DELAY(1000); 193253572Sloos if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) & 194253572Sloos AR8X16_MASK_CTRL_SOFT_RESET) { 195253572Sloos device_printf(dev, "unable to reset switch\n"); 196253572Sloos return (-1); 197253572Sloos } 198253572Sloos return (0); 199253572Sloos} 200253572Sloos 201253572Sloosstatic int 202253572Sloosarswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode) 203253572Sloos{ 204253572Sloos 205253572Sloos /* Check for invalid modes. */ 206253572Sloos if ((mode & sc->info.es_vlan_caps) != mode) 207253572Sloos return (EINVAL); 208253572Sloos 209253572Sloos switch (mode) { 210253572Sloos case ETHERSWITCH_VLAN_DOT1Q: 211253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q; 212253572Sloos break; 213253572Sloos case ETHERSWITCH_VLAN_PORT: 214253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_PORT; 215253572Sloos break; 216253572Sloos default: 217253572Sloos sc->vlan_mode = 0; 218253572Sloos }; 219253572Sloos 220253572Sloos /* Reset VLANs. */ 221253572Sloos arswitch_reset_vlans(sc); 222253572Sloos 223253572Sloos return (0); 224253572Sloos} 225253572Sloos 226253572Sloosstatic void 227262206Sadrianarswitch_port_init_8xxx(struct arswitch_softc *sc, int port) 228253572Sloos{ 229253572Sloos 230253572Sloos /* Port0 - CPU */ 231262203Sadrian if (port == AR8X16_PORT_CPU) { 232262203Sadrian arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0), 233262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 234262203Sadrian AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) | 235262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) | 236262203Sadrian (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) | 237262203Sadrian AR8X16_PORT_STS_RXMAC | 238262203Sadrian AR8X16_PORT_STS_TXMAC | 239262203Sadrian AR8X16_PORT_STS_DUPLEX); 240262203Sadrian arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0), 241262203Sadrian arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) & 242262203Sadrian ~AR8X16_PORT_CTRL_HEADER); 243262203Sadrian } else { 244253572Sloos /* Set ports to auto negotiation. */ 245253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port), 246253572Sloos AR8X16_PORT_STS_LINK_AUTO); 247253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port), 248253572Sloos arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) & 249253572Sloos ~AR8X16_PORT_CTRL_HEADER); 250253572Sloos } 251253572Sloos} 252253572Sloos 253253572Sloosstatic int 254235288Sadrianarswitch_attach(device_t dev) 255235288Sadrian{ 256235288Sadrian struct arswitch_softc *sc; 257235288Sadrian int err = 0; 258262203Sadrian int port; 259235288Sadrian 260235288Sadrian sc = device_get_softc(dev); 261235288Sadrian 262235288Sadrian /* sc->sc_switchtype is already decided in arswitch_probe() */ 263235288Sadrian sc->sc_dev = dev; 264235288Sadrian mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF); 265235288Sadrian sc->page = -1; 266235288Sadrian strlcpy(sc->info.es_name, device_get_desc(dev), 267235288Sadrian sizeof(sc->info.es_name)); 268235288Sadrian 269262206Sadrian /* Default HAL methods */ 270262206Sadrian sc->hal.arswitch_port_init = arswitch_port_init_8xxx; 271262206Sadrian 272235288Sadrian /* 273235288Sadrian * Attach switch related functions 274235288Sadrian */ 275235323Sadrian if (AR8X16_IS_SWITCH(sc, AR7240)) 276235323Sadrian ar7240_attach(sc); 277256582Sadrian else if (AR8X16_IS_SWITCH(sc, AR9340)) 278256582Sadrian ar9340_attach(sc); 279235323Sadrian else if (AR8X16_IS_SWITCH(sc, AR8216)) 280235288Sadrian ar8216_attach(sc); 281235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8226)) 282235288Sadrian ar8226_attach(sc); 283235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8316)) 284235288Sadrian ar8316_attach(sc); 285235288Sadrian else 286235288Sadrian return (ENXIO); 287235288Sadrian 288253572Sloos /* Common defaults. */ 289235288Sadrian sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */ 290235288Sadrian 291235288Sadrian /* XXX Defaults for externally connected AR8316 */ 292235288Sadrian sc->numphys = 4; 293235288Sadrian sc->phy4cpu = 1; 294235288Sadrian sc->is_rgmii = 1; 295235288Sadrian sc->is_gmii = 0; 296256582Sadrian sc->is_mii = 0; 297235288Sadrian 298235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 299235288Sadrian "numphys", &sc->numphys); 300235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 301235288Sadrian "phy4cpu", &sc->phy4cpu); 302235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 303235288Sadrian "is_rgmii", &sc->is_rgmii); 304235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 305235288Sadrian "is_gmii", &sc->is_gmii); 306256582Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 307256582Sadrian "is_mii", &sc->is_mii); 308235288Sadrian 309253572Sloos if (sc->numphys > AR8X16_NUM_PHYS) 310253572Sloos sc->numphys = AR8X16_NUM_PHYS; 311253572Sloos 312253572Sloos /* Reset the switch. */ 313253572Sloos if (arswitch_reset(dev)) 314235288Sadrian return (ENXIO); 315235288Sadrian 316256582Sadrian err = sc->hal.arswitch_hw_setup(sc); 317256582Sadrian if (err != 0) 318256582Sadrian return (err); 319256582Sadrian 320235288Sadrian err = sc->hal.arswitch_hw_global_setup(sc); 321235288Sadrian if (err != 0) 322235288Sadrian return (err); 323235288Sadrian 324253572Sloos /* Initialize the switch ports. */ 325262203Sadrian for (port = 0; port <= sc->numphys; port++) { 326262206Sadrian sc->hal.arswitch_port_init(sc, port); 327262203Sadrian } 328253572Sloos 329235288Sadrian /* 330235288Sadrian * Attach the PHYs and complete the bus enumeration. 331235288Sadrian */ 332235288Sadrian err = arswitch_attach_phys(sc); 333235288Sadrian if (err != 0) 334235288Sadrian return (err); 335235288Sadrian 336253572Sloos /* Default to ingress filters off. */ 337253572Sloos err = arswitch_set_vlan_mode(sc, 0); 338253572Sloos if (err != 0) 339253572Sloos return (err); 340253572Sloos 341235288Sadrian bus_generic_probe(dev); 342235288Sadrian bus_enumerate_hinted_children(dev); 343235288Sadrian err = bus_generic_attach(dev); 344235288Sadrian if (err != 0) 345235288Sadrian return (err); 346235288Sadrian 347235288Sadrian callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0); 348241578Sray 349241578Sray ARSWITCH_LOCK(sc); 350235288Sadrian arswitch_tick(sc); 351241578Sray ARSWITCH_UNLOCK(sc); 352235288Sadrian 353235288Sadrian return (err); 354235288Sadrian} 355235288Sadrian 356235288Sadrianstatic int 357235288Sadrianarswitch_detach(device_t dev) 358235288Sadrian{ 359235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 360235288Sadrian int i; 361235288Sadrian 362235288Sadrian callout_drain(&sc->callout_tick); 363235288Sadrian 364235288Sadrian for (i=0; i < sc->numphys; i++) { 365235288Sadrian if (sc->miibus[i] != NULL) 366235288Sadrian device_delete_child(dev, sc->miibus[i]); 367235288Sadrian if (sc->ifp[i] != NULL) 368235288Sadrian if_free(sc->ifp[i]); 369235288Sadrian free(sc->ifname[i], M_DEVBUF); 370235288Sadrian } 371235288Sadrian 372235288Sadrian bus_generic_detach(dev); 373235288Sadrian mtx_destroy(&sc->sc_mtx); 374235288Sadrian 375235288Sadrian return (0); 376235288Sadrian} 377235288Sadrian 378235288Sadrian/* 379235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to 380235288Sadrian * port 2, etc. 381235288Sadrian */ 382235288Sadrianstatic inline int 383235288Sadrianarswitch_portforphy(int phy) 384235288Sadrian{ 385235288Sadrian return (phy+1); 386235288Sadrian} 387235288Sadrian 388235288Sadrianstatic inline struct mii_data * 389235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port) 390235288Sadrian{ 391235288Sadrian int phy = port-1; 392235288Sadrian 393235288Sadrian if (phy < 0 || phy >= sc->numphys) 394235288Sadrian return (NULL); 395235288Sadrian return (device_get_softc(sc->miibus[phy])); 396235288Sadrian} 397235288Sadrian 398235288Sadrianstatic inline struct ifnet * 399235288Sadrianarswitch_ifpforport(struct arswitch_softc *sc, int port) 400235288Sadrian{ 401235288Sadrian int phy = port-1; 402235288Sadrian 403235288Sadrian if (phy < 0 || phy >= sc->numphys) 404235288Sadrian return (NULL); 405235288Sadrian return (sc->ifp[phy]); 406235288Sadrian} 407235288Sadrian 408235288Sadrian/* 409235288Sadrian * Convert port status to ifmedia. 410235288Sadrian */ 411235288Sadrianstatic void 412235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active) 413235288Sadrian{ 414235288Sadrian *media_active = IFM_ETHER; 415235288Sadrian *media_status = IFM_AVALID; 416235288Sadrian 417235288Sadrian if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0) 418235288Sadrian *media_status |= IFM_ACTIVE; 419235288Sadrian else { 420235288Sadrian *media_active |= IFM_NONE; 421235288Sadrian return; 422235288Sadrian } 423235288Sadrian switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) { 424235288Sadrian case AR8X16_PORT_STS_SPEED_10: 425235288Sadrian *media_active |= IFM_10_T; 426235288Sadrian break; 427235288Sadrian case AR8X16_PORT_STS_SPEED_100: 428235288Sadrian *media_active |= IFM_100_TX; 429235288Sadrian break; 430235288Sadrian case AR8X16_PORT_STS_SPEED_1000: 431235288Sadrian *media_active |= IFM_1000_T; 432235288Sadrian break; 433235288Sadrian } 434235288Sadrian if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0) 435235288Sadrian *media_active |= IFM_FDX; 436235288Sadrian else 437235288Sadrian *media_active |= IFM_HDX; 438235288Sadrian if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0) 439235288Sadrian *media_active |= IFM_ETH_TXPAUSE; 440235288Sadrian if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0) 441235288Sadrian *media_active |= IFM_ETH_RXPAUSE; 442235288Sadrian} 443235288Sadrian 444235288Sadrian/* 445235288Sadrian * Poll the status for all PHYs. We're using the switch port status because 446235288Sadrian * thats a lot quicker to read than talking to all the PHYs. Care must be 447235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will 448235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs 449235288Sadrian * update function is called. 450235288Sadrian */ 451235288Sadrianstatic void 452235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc) 453235288Sadrian{ 454235288Sadrian int i; 455235288Sadrian struct mii_data *mii; 456235288Sadrian struct mii_softc *miisc; 457235288Sadrian int portstatus; 458235288Sadrian 459241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 460241578Sray 461235288Sadrian for (i = 0; i < sc->numphys; i++) { 462235288Sadrian if (sc->miibus[i] == NULL) 463235288Sadrian continue; 464235288Sadrian mii = device_get_softc(sc->miibus[i]); 465262206Sadrian /* XXX This would be nice to have abstracted out to be per-chip */ 466262206Sadrian /* AR8327/AR8337 has a different register base */ 467262206Sadrian if (AR8X16_IS_SWITCH(sc, AR8327)) 468262206Sadrian portstatus = arswitch_readreg(sc->sc_dev, 469262206Sadrian AR8327_REG_PORT_STATUS(arswitch_portforphy(i))); 470262206Sadrian else 471262206Sadrian portstatus = arswitch_readreg(sc->sc_dev, 472262206Sadrian AR8X16_REG_PORT_STS(arswitch_portforphy(i))); 473262206Sadrian 474235288Sadrian#if 0 475235288Sadrian DPRINTF(sc->sc_dev, "p[%d]=%b\n", 476256582Sadrian i, 477235288Sadrian portstatus, 478235288Sadrian "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7" 479235288Sadrian "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE"); 480235288Sadrian#endif 481235288Sadrian arswitch_update_ifmedia(portstatus, &mii->mii_media_status, 482235288Sadrian &mii->mii_media_active); 483235288Sadrian LIST_FOREACH(miisc, &mii->mii_phys, mii_list) { 484235288Sadrian if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) != 485235288Sadrian miisc->mii_inst) 486235288Sadrian continue; 487235288Sadrian mii_phy_update(miisc, MII_POLLSTAT); 488235288Sadrian } 489235288Sadrian } 490235288Sadrian} 491235288Sadrian 492235288Sadrianstatic void 493235288Sadrianarswitch_tick(void *arg) 494235288Sadrian{ 495235288Sadrian struct arswitch_softc *sc = arg; 496235288Sadrian 497235288Sadrian arswitch_miipollstat(sc); 498235288Sadrian callout_reset(&sc->callout_tick, hz, arswitch_tick, sc); 499235288Sadrian} 500235288Sadrian 501241578Sraystatic void 502241578Srayarswitch_lock(device_t dev) 503241578Sray{ 504241578Sray struct arswitch_softc *sc = device_get_softc(dev); 505241578Sray 506241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED); 507241578Sray ARSWITCH_LOCK(sc); 508241578Sray} 509241578Sray 510241578Sraystatic void 511241578Srayarswitch_unlock(device_t dev) 512241578Sray{ 513241578Sray struct arswitch_softc *sc = device_get_softc(dev); 514241578Sray 515241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 516241578Sray ARSWITCH_UNLOCK(sc); 517241578Sray} 518241578Sray 519235288Sadrianstatic etherswitch_info_t * 520235288Sadrianarswitch_getinfo(device_t dev) 521235288Sadrian{ 522235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 523235288Sadrian 524235288Sadrian return (&sc->info); 525235288Sadrian} 526235288Sadrian 527235288Sadrianstatic int 528235288Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p) 529235288Sadrian{ 530253572Sloos struct arswitch_softc *sc; 531253572Sloos struct ifmediareq *ifmr; 532235288Sadrian struct mii_data *mii; 533253572Sloos uint32_t reg; 534235288Sadrian int err; 535253572Sloos 536253572Sloos sc = device_get_softc(dev); 537253572Sloos if (p->es_port < 0 || p->es_port > sc->numphys) 538235288Sadrian return (ENXIO); 539235288Sadrian 540253572Sloos ARSWITCH_LOCK(sc); 541253572Sloos 542253572Sloos /* Retrieve the PVID. */ 543253572Sloos arswitch_get_pvid(sc, p->es_port, &p->es_pvid); 544253572Sloos 545253572Sloos /* Port flags. */ 546253572Sloos reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port)); 547253572Sloos if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG) 548253572Sloos p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG; 549253572Sloos reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 550253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD) 551253572Sloos p->es_flags |= ETHERSWITCH_PORT_ADDTAG; 552253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP) 553253572Sloos p->es_flags |= ETHERSWITCH_PORT_STRIPTAG; 554253572Sloos ARSWITCH_UNLOCK(sc); 555253572Sloos 556235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 557235288Sadrian if (p->es_port == 0) { 558235288Sadrian /* fill in fixed values for CPU port */ 559250383Sadrian p->es_flags |= ETHERSWITCH_PORT_CPU; 560253572Sloos ifmr = &p->es_ifmr; 561235288Sadrian ifmr->ifm_count = 0; 562235288Sadrian ifmr->ifm_current = ifmr->ifm_active = 563235288Sadrian IFM_ETHER | IFM_1000_T | IFM_FDX; 564235288Sadrian ifmr->ifm_mask = 0; 565235288Sadrian ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID; 566235288Sadrian } else if (mii != NULL) { 567235288Sadrian err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr, 568235288Sadrian &mii->mii_media, SIOCGIFMEDIA); 569235288Sadrian if (err) 570235288Sadrian return (err); 571235288Sadrian } else { 572235288Sadrian return (ENXIO); 573235288Sadrian } 574235288Sadrian return (0); 575235288Sadrian} 576235288Sadrian 577235288Sadrianstatic int 578235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p) 579235288Sadrian{ 580235288Sadrian int err; 581253572Sloos uint32_t reg; 582235288Sadrian struct arswitch_softc *sc; 583235288Sadrian struct ifmedia *ifm; 584235288Sadrian struct mii_data *mii; 585235288Sadrian struct ifnet *ifp; 586235288Sadrian 587253572Sloos sc = device_get_softc(dev); 588253572Sloos if (p->es_port < 0 || p->es_port > sc->numphys) 589235288Sadrian return (ENXIO); 590235288Sadrian 591253572Sloos /* Port flags. */ 592253572Sloos if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) { 593235288Sadrian 594253572Sloos ARSWITCH_LOCK(sc); 595253572Sloos /* Set the PVID. */ 596253572Sloos if (p->es_pvid != 0) 597253572Sloos arswitch_set_pvid(sc, p->es_port, p->es_pvid); 598235288Sadrian 599253572Sloos /* Mutually exclusive. */ 600253572Sloos if (p->es_flags & ETHERSWITCH_PORT_ADDTAG && 601253572Sloos p->es_flags & ETHERSWITCH_PORT_STRIPTAG) { 602253572Sloos ARSWITCH_UNLOCK(sc); 603253572Sloos return (EINVAL); 604253572Sloos } 605253572Sloos 606253572Sloos reg = 0; 607253572Sloos if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG) 608253572Sloos reg |= AR8X16_PORT_CTRL_DOUBLE_TAG; 609253572Sloos if (p->es_flags & ETHERSWITCH_PORT_ADDTAG) 610253572Sloos reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD << 611253572Sloos AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 612253572Sloos if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG) 613253572Sloos reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP << 614253572Sloos AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 615253572Sloos 616253572Sloos err = arswitch_modifyreg(sc->sc_dev, 617253572Sloos AR8X16_REG_PORT_CTRL(p->es_port), 618253572Sloos 0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT | 619253572Sloos AR8X16_PORT_CTRL_DOUBLE_TAG, reg); 620253572Sloos 621253572Sloos ARSWITCH_UNLOCK(sc); 622253572Sloos if (err) 623253572Sloos return (err); 624253572Sloos } 625253572Sloos 626253572Sloos /* Do not allow media changes on CPU port. */ 627253572Sloos if (p->es_port == AR8X16_PORT_CPU) 628253572Sloos return (0); 629253572Sloos 630235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 631235288Sadrian if (mii == NULL) 632235288Sadrian return (ENXIO); 633235288Sadrian 634235288Sadrian ifp = arswitch_ifpforport(sc, p->es_port); 635235288Sadrian 636235288Sadrian ifm = &mii->mii_media; 637253572Sloos return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA)); 638235288Sadrian} 639235288Sadrian 640235288Sadrianstatic void 641235288Sadrianarswitch_statchg(device_t dev) 642235288Sadrian{ 643235288Sadrian 644235288Sadrian DPRINTF(dev, "%s\n", __func__); 645235288Sadrian} 646235288Sadrian 647235288Sadrianstatic int 648235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp) 649235288Sadrian{ 650235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 651235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 652235288Sadrian 653235288Sadrian if (mii == NULL) 654235288Sadrian return (ENXIO); 655235288Sadrian mii_mediachg(mii); 656235288Sadrian return (0); 657235288Sadrian} 658235288Sadrian 659235288Sadrianstatic void 660235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 661235288Sadrian{ 662235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 663235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 664235288Sadrian 665235288Sadrian DPRINTF(sc->sc_dev, "%s\n", __func__); 666235288Sadrian 667235288Sadrian if (mii == NULL) 668235288Sadrian return; 669235288Sadrian mii_pollstat(mii); 670235288Sadrian ifmr->ifm_active = mii->mii_media_active; 671235288Sadrian ifmr->ifm_status = mii->mii_media_status; 672235288Sadrian} 673235288Sadrian 674253572Sloosstatic int 675253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf) 676253572Sloos{ 677253572Sloos struct arswitch_softc *sc; 678253572Sloos 679253572Sloos sc = device_get_softc(dev); 680253572Sloos 681253572Sloos /* Return the VLAN mode. */ 682253572Sloos conf->cmd = ETHERSWITCH_CONF_VLAN_MODE; 683253572Sloos conf->vlan_mode = sc->vlan_mode; 684253572Sloos 685253572Sloos return (0); 686253572Sloos} 687253572Sloos 688253572Sloosstatic int 689253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf) 690253572Sloos{ 691253572Sloos struct arswitch_softc *sc; 692253572Sloos int err; 693253572Sloos 694253572Sloos sc = device_get_softc(dev); 695253572Sloos 696253572Sloos /* Set the VLAN mode. */ 697253572Sloos if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) { 698253572Sloos err = arswitch_set_vlan_mode(sc, conf->vlan_mode); 699253572Sloos if (err != 0) 700253572Sloos return (err); 701253572Sloos } 702253572Sloos 703253572Sloos return (0); 704253572Sloos} 705253572Sloos 706235288Sadrianstatic device_method_t arswitch_methods[] = { 707235288Sadrian /* Device interface */ 708235288Sadrian DEVMETHOD(device_probe, arswitch_probe), 709235288Sadrian DEVMETHOD(device_attach, arswitch_attach), 710235288Sadrian DEVMETHOD(device_detach, arswitch_detach), 711235288Sadrian 712235288Sadrian /* bus interface */ 713235288Sadrian DEVMETHOD(bus_add_child, device_add_child_ordered), 714235288Sadrian 715235288Sadrian /* MII interface */ 716235288Sadrian DEVMETHOD(miibus_readreg, arswitch_readphy), 717235288Sadrian DEVMETHOD(miibus_writereg, arswitch_writephy), 718235288Sadrian DEVMETHOD(miibus_statchg, arswitch_statchg), 719235288Sadrian 720235288Sadrian /* MDIO interface */ 721235288Sadrian DEVMETHOD(mdio_readreg, arswitch_readphy), 722235288Sadrian DEVMETHOD(mdio_writereg, arswitch_writephy), 723235288Sadrian 724235288Sadrian /* etherswitch interface */ 725241578Sray DEVMETHOD(etherswitch_lock, arswitch_lock), 726241578Sray DEVMETHOD(etherswitch_unlock, arswitch_unlock), 727235288Sadrian DEVMETHOD(etherswitch_getinfo, arswitch_getinfo), 728235288Sadrian DEVMETHOD(etherswitch_readreg, arswitch_readreg), 729235288Sadrian DEVMETHOD(etherswitch_writereg, arswitch_writereg), 730235288Sadrian DEVMETHOD(etherswitch_readphyreg, arswitch_readphy), 731235288Sadrian DEVMETHOD(etherswitch_writephyreg, arswitch_writephy), 732235288Sadrian DEVMETHOD(etherswitch_getport, arswitch_getport), 733235288Sadrian DEVMETHOD(etherswitch_setport, arswitch_setport), 734235288Sadrian DEVMETHOD(etherswitch_getvgroup, arswitch_getvgroup), 735235288Sadrian DEVMETHOD(etherswitch_setvgroup, arswitch_setvgroup), 736253572Sloos DEVMETHOD(etherswitch_getconf, arswitch_getconf), 737253572Sloos DEVMETHOD(etherswitch_setconf, arswitch_setconf), 738235288Sadrian 739235288Sadrian DEVMETHOD_END 740235288Sadrian}; 741235288Sadrian 742235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods, 743235288Sadrian sizeof(struct arswitch_softc)); 744235288Sadrianstatic devclass_t arswitch_devclass; 745235288Sadrian 746235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0); 747235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0); 748235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0); 749235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0); 750235288SadrianMODULE_VERSION(arswitch, 1); 751235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */ 752235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */ 753