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$ 28235288Sadrian */ 29235288Sadrian 30235288Sadrian#include <sys/param.h> 31235288Sadrian#include <sys/bus.h> 32235288Sadrian#include <sys/errno.h> 33235288Sadrian#include <sys/kernel.h> 34235288Sadrian#include <sys/module.h> 35235288Sadrian#include <sys/socket.h> 36235288Sadrian#include <sys/sockio.h> 37235288Sadrian#include <sys/sysctl.h> 38235288Sadrian#include <sys/systm.h> 39235288Sadrian 40235288Sadrian#include <net/if.h> 41235288Sadrian#include <net/if_arp.h> 42235288Sadrian#include <net/ethernet.h> 43235288Sadrian#include <net/if_dl.h> 44235288Sadrian#include <net/if_media.h> 45235288Sadrian#include <net/if_types.h> 46235288Sadrian 47235288Sadrian#include <machine/bus.h> 48235288Sadrian#include <dev/iicbus/iic.h> 49235288Sadrian#include <dev/iicbus/iiconf.h> 50235288Sadrian#include <dev/iicbus/iicbus.h> 51235288Sadrian#include <dev/mii/mii.h> 52235288Sadrian#include <dev/mii/miivar.h> 53235288Sadrian#include <dev/etherswitch/mdio.h> 54235288Sadrian 55235288Sadrian#include <dev/etherswitch/etherswitch.h> 56235288Sadrian 57235288Sadrian#include <dev/etherswitch/arswitch/arswitchreg.h> 58235288Sadrian#include <dev/etherswitch/arswitch/arswitchvar.h> 59235288Sadrian#include <dev/etherswitch/arswitch/arswitch_reg.h> 60235288Sadrian#include <dev/etherswitch/arswitch/arswitch_phy.h> 61253572Sloos#include <dev/etherswitch/arswitch/arswitch_vlans.h> 62235288Sadrian 63235323Sadrian#include <dev/etherswitch/arswitch/arswitch_7240.h> 64235288Sadrian#include <dev/etherswitch/arswitch/arswitch_8216.h> 65235288Sadrian#include <dev/etherswitch/arswitch/arswitch_8226.h> 66235288Sadrian#include <dev/etherswitch/arswitch/arswitch_8316.h> 67235288Sadrian 68235288Sadrian#include "mdio_if.h" 69235288Sadrian#include "miibus_if.h" 70235288Sadrian#include "etherswitch_if.h" 71235288Sadrian 72235288Sadrian#if defined(DEBUG) 73235288Sadrianstatic SYSCTL_NODE(_debug, OID_AUTO, arswitch, CTLFLAG_RD, 0, "arswitch"); 74235288Sadrian#endif 75235288Sadrian 76235288Sadrianstatic inline int arswitch_portforphy(int phy); 77235288Sadrianstatic void arswitch_tick(void *arg); 78235288Sadrianstatic int arswitch_ifmedia_upd(struct ifnet *); 79235288Sadrianstatic void arswitch_ifmedia_sts(struct ifnet *, struct ifmediareq *); 80235288Sadrian 81235288Sadrianstatic int 82235288Sadrianarswitch_probe(device_t dev) 83235288Sadrian{ 84235288Sadrian struct arswitch_softc *sc; 85235288Sadrian uint32_t id; 86235288Sadrian char *chipname, desc[256]; 87235288Sadrian 88235288Sadrian sc = device_get_softc(dev); 89235288Sadrian bzero(sc, sizeof(*sc)); 90235288Sadrian sc->page = -1; 91235323Sadrian 92235323Sadrian /* AR7240 probe */ 93235323Sadrian if (ar7240_probe(dev) == 0) { 94235323Sadrian chipname = "AR7240"; 95235323Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR7240; 96241577Sray id = 0; 97235323Sadrian goto done; 98235323Sadrian } 99235323Sadrian 100235323Sadrian /* AR8xxx probe */ 101235288Sadrian id = arswitch_readreg(dev, AR8X16_REG_MASK_CTRL); 102235288Sadrian switch ((id & AR8X16_MASK_CTRL_VER_MASK) >> 103235288Sadrian AR8X16_MASK_CTRL_VER_SHIFT) { 104235288Sadrian case 1: 105235288Sadrian chipname = "AR8216"; 106235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8216; 107235288Sadrian break; 108235288Sadrian case 2: 109235288Sadrian chipname = "AR8226"; 110235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8226; 111235288Sadrian break; 112235288Sadrian case 16: 113235288Sadrian chipname = "AR8316"; 114235288Sadrian sc->sc_switchtype = AR8X16_SWITCH_AR8316; 115235288Sadrian break; 116235288Sadrian default: 117235288Sadrian chipname = NULL; 118235288Sadrian } 119235323Sadrian 120235323Sadriandone: 121235288Sadrian DPRINTF(dev, "chipname=%s, rev=%02x\n", chipname, 122235288Sadrian id & AR8X16_MASK_CTRL_REV_MASK); 123235288Sadrian if (chipname != NULL) { 124235288Sadrian snprintf(desc, sizeof(desc), 125235288Sadrian "Atheros %s Ethernet Switch", 126235288Sadrian chipname); 127235288Sadrian device_set_desc_copy(dev, desc); 128235288Sadrian return (BUS_PROBE_DEFAULT); 129235288Sadrian } 130235288Sadrian return (ENXIO); 131235288Sadrian} 132235288Sadrian 133235288Sadrianstatic int 134235288Sadrianarswitch_attach_phys(struct arswitch_softc *sc) 135235288Sadrian{ 136235288Sadrian int phy, err = 0; 137235288Sadrian char name[IFNAMSIZ]; 138235288Sadrian 139235288Sadrian /* PHYs need an interface, so we generate a dummy one */ 140235288Sadrian snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev)); 141235288Sadrian for (phy = 0; phy < sc->numphys; phy++) { 142235288Sadrian sc->ifp[phy] = if_alloc(IFT_ETHER); 143235288Sadrian sc->ifp[phy]->if_softc = sc; 144235288Sadrian sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST | 145235288Sadrian IFF_DRV_RUNNING | IFF_SIMPLEX; 146235288Sadrian sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK); 147235288Sadrian bcopy(name, sc->ifname[phy], strlen(name)+1); 148235288Sadrian if_initname(sc->ifp[phy], sc->ifname[phy], 149235288Sadrian arswitch_portforphy(phy)); 150235288Sadrian err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy], 151235288Sadrian arswitch_ifmedia_upd, arswitch_ifmedia_sts, \ 152235288Sadrian BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0); 153235288Sadrian DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n", 154235288Sadrian device_get_nameunit(sc->miibus[phy]), 155235288Sadrian sc->ifp[phy]->if_xname); 156235288Sadrian if (err != 0) { 157235288Sadrian device_printf(sc->sc_dev, 158235288Sadrian "attaching PHY %d failed\n", 159235288Sadrian phy); 160235288Sadrian } 161235288Sadrian } 162235288Sadrian return (err); 163235288Sadrian} 164235288Sadrian 165235288Sadrianstatic int 166253572Sloosarswitch_reset(device_t dev) 167253572Sloos{ 168253572Sloos 169253572Sloos arswitch_writereg(dev, AR8X16_REG_MASK_CTRL, 170253572Sloos AR8X16_MASK_CTRL_SOFT_RESET); 171253572Sloos DELAY(1000); 172253572Sloos if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) & 173253572Sloos AR8X16_MASK_CTRL_SOFT_RESET) { 174253572Sloos device_printf(dev, "unable to reset switch\n"); 175253572Sloos return (-1); 176253572Sloos } 177253572Sloos return (0); 178253572Sloos} 179253572Sloos 180253572Sloosstatic int 181253572Sloosarswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode) 182253572Sloos{ 183253572Sloos 184253572Sloos /* Check for invalid modes. */ 185253572Sloos if ((mode & sc->info.es_vlan_caps) != mode) 186253572Sloos return (EINVAL); 187253572Sloos 188253572Sloos switch (mode) { 189253572Sloos case ETHERSWITCH_VLAN_DOT1Q: 190253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q; 191253572Sloos break; 192253572Sloos case ETHERSWITCH_VLAN_PORT: 193253572Sloos sc->vlan_mode = ETHERSWITCH_VLAN_PORT; 194253572Sloos break; 195253572Sloos default: 196253572Sloos sc->vlan_mode = 0; 197253572Sloos }; 198253572Sloos 199253572Sloos /* Reset VLANs. */ 200253572Sloos arswitch_reset_vlans(sc); 201253572Sloos 202253572Sloos return (0); 203253572Sloos} 204253572Sloos 205253572Sloosstatic void 206253572Sloosarswitch_ports_init(struct arswitch_softc *sc) 207253572Sloos{ 208253572Sloos int port; 209253572Sloos 210253572Sloos /* Port0 - CPU */ 211253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0), 212253572Sloos (AR8X16_IS_SWITCH(sc, AR8216) ? 213253572Sloos AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) | 214253572Sloos (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) | 215253572Sloos (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) | 216253572Sloos AR8X16_PORT_STS_RXMAC | 217253572Sloos AR8X16_PORT_STS_TXMAC | 218253572Sloos AR8X16_PORT_STS_DUPLEX); 219253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0), 220253572Sloos arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) & 221253572Sloos ~AR8X16_PORT_CTRL_HEADER); 222253572Sloos 223253572Sloos for (port = 1; port <= sc->numphys; port++) { 224253572Sloos /* Set ports to auto negotiation. */ 225253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port), 226253572Sloos AR8X16_PORT_STS_LINK_AUTO); 227253572Sloos arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port), 228253572Sloos arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) & 229253572Sloos ~AR8X16_PORT_CTRL_HEADER); 230253572Sloos } 231253572Sloos} 232253572Sloos 233253572Sloosstatic int 234235288Sadrianarswitch_attach(device_t dev) 235235288Sadrian{ 236235288Sadrian struct arswitch_softc *sc; 237235288Sadrian int err = 0; 238235288Sadrian 239235288Sadrian sc = device_get_softc(dev); 240235288Sadrian 241235288Sadrian /* sc->sc_switchtype is already decided in arswitch_probe() */ 242235288Sadrian sc->sc_dev = dev; 243235288Sadrian mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF); 244235288Sadrian sc->page = -1; 245235288Sadrian strlcpy(sc->info.es_name, device_get_desc(dev), 246235288Sadrian sizeof(sc->info.es_name)); 247235288Sadrian 248235288Sadrian /* 249235288Sadrian * Attach switch related functions 250235288Sadrian */ 251235323Sadrian if (AR8X16_IS_SWITCH(sc, AR7240)) 252235323Sadrian ar7240_attach(sc); 253235323Sadrian else if (AR8X16_IS_SWITCH(sc, AR8216)) 254235288Sadrian ar8216_attach(sc); 255235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8226)) 256235288Sadrian ar8226_attach(sc); 257235288Sadrian else if (AR8X16_IS_SWITCH(sc, AR8316)) 258235288Sadrian ar8316_attach(sc); 259235288Sadrian else 260235288Sadrian return (ENXIO); 261235288Sadrian 262253572Sloos /* Common defaults. */ 263235288Sadrian sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */ 264235288Sadrian 265235288Sadrian /* XXX Defaults for externally connected AR8316 */ 266235288Sadrian sc->numphys = 4; 267235288Sadrian sc->phy4cpu = 1; 268235288Sadrian sc->is_rgmii = 1; 269235288Sadrian sc->is_gmii = 0; 270235288Sadrian 271235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 272235288Sadrian "numphys", &sc->numphys); 273235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 274235288Sadrian "phy4cpu", &sc->phy4cpu); 275235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 276235288Sadrian "is_rgmii", &sc->is_rgmii); 277235288Sadrian (void) resource_int_value(device_get_name(dev), device_get_unit(dev), 278235288Sadrian "is_gmii", &sc->is_gmii); 279235288Sadrian 280253572Sloos if (sc->numphys > AR8X16_NUM_PHYS) 281253572Sloos sc->numphys = AR8X16_NUM_PHYS; 282253572Sloos 283253572Sloos /* Reset the switch. */ 284253572Sloos if (arswitch_reset(dev)) 285235288Sadrian return (ENXIO); 286235288Sadrian 287235288Sadrian err = sc->hal.arswitch_hw_global_setup(sc); 288235288Sadrian if (err != 0) 289235288Sadrian return (err); 290235288Sadrian 291253572Sloos /* Initialize the switch ports. */ 292253572Sloos arswitch_ports_init(sc); 293253572Sloos 294235288Sadrian /* 295235288Sadrian * Attach the PHYs and complete the bus enumeration. 296235288Sadrian */ 297235288Sadrian err = arswitch_attach_phys(sc); 298235288Sadrian if (err != 0) 299235288Sadrian return (err); 300235288Sadrian 301253572Sloos /* Default to ingress filters off. */ 302253572Sloos err = arswitch_set_vlan_mode(sc, 0); 303253572Sloos if (err != 0) 304253572Sloos return (err); 305253572Sloos 306253572Sloos err = sc->hal.arswitch_hw_setup(sc); 307253572Sloos if (err != 0) 308253572Sloos return (err); 309253572Sloos 310235288Sadrian bus_generic_probe(dev); 311235288Sadrian bus_enumerate_hinted_children(dev); 312235288Sadrian err = bus_generic_attach(dev); 313235288Sadrian if (err != 0) 314235288Sadrian return (err); 315235288Sadrian 316235288Sadrian callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0); 317241578Sray 318241578Sray ARSWITCH_LOCK(sc); 319235288Sadrian arswitch_tick(sc); 320241578Sray ARSWITCH_UNLOCK(sc); 321235288Sadrian 322235288Sadrian return (err); 323235288Sadrian} 324235288Sadrian 325235288Sadrianstatic int 326235288Sadrianarswitch_detach(device_t dev) 327235288Sadrian{ 328235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 329235288Sadrian int i; 330235288Sadrian 331235288Sadrian callout_drain(&sc->callout_tick); 332235288Sadrian 333235288Sadrian for (i=0; i < sc->numphys; i++) { 334235288Sadrian if (sc->miibus[i] != NULL) 335235288Sadrian device_delete_child(dev, sc->miibus[i]); 336235288Sadrian if (sc->ifp[i] != NULL) 337235288Sadrian if_free(sc->ifp[i]); 338235288Sadrian free(sc->ifname[i], M_DEVBUF); 339235288Sadrian } 340235288Sadrian 341235288Sadrian bus_generic_detach(dev); 342235288Sadrian mtx_destroy(&sc->sc_mtx); 343235288Sadrian 344235288Sadrian return (0); 345235288Sadrian} 346235288Sadrian 347235288Sadrian/* 348235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to 349235288Sadrian * port 2, etc. 350235288Sadrian */ 351235288Sadrianstatic inline int 352235288Sadrianarswitch_portforphy(int phy) 353235288Sadrian{ 354235288Sadrian return (phy+1); 355235288Sadrian} 356235288Sadrian 357235288Sadrianstatic inline struct mii_data * 358235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port) 359235288Sadrian{ 360235288Sadrian int phy = port-1; 361235288Sadrian 362235288Sadrian if (phy < 0 || phy >= sc->numphys) 363235288Sadrian return (NULL); 364235288Sadrian return (device_get_softc(sc->miibus[phy])); 365235288Sadrian} 366235288Sadrian 367235288Sadrianstatic inline struct ifnet * 368235288Sadrianarswitch_ifpforport(struct arswitch_softc *sc, int port) 369235288Sadrian{ 370235288Sadrian int phy = port-1; 371235288Sadrian 372235288Sadrian if (phy < 0 || phy >= sc->numphys) 373235288Sadrian return (NULL); 374235288Sadrian return (sc->ifp[phy]); 375235288Sadrian} 376235288Sadrian 377235288Sadrian/* 378235288Sadrian * Convert port status to ifmedia. 379235288Sadrian */ 380235288Sadrianstatic void 381235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active) 382235288Sadrian{ 383235288Sadrian *media_active = IFM_ETHER; 384235288Sadrian *media_status = IFM_AVALID; 385235288Sadrian 386235288Sadrian if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0) 387235288Sadrian *media_status |= IFM_ACTIVE; 388235288Sadrian else { 389235288Sadrian *media_active |= IFM_NONE; 390235288Sadrian return; 391235288Sadrian } 392235288Sadrian switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) { 393235288Sadrian case AR8X16_PORT_STS_SPEED_10: 394235288Sadrian *media_active |= IFM_10_T; 395235288Sadrian break; 396235288Sadrian case AR8X16_PORT_STS_SPEED_100: 397235288Sadrian *media_active |= IFM_100_TX; 398235288Sadrian break; 399235288Sadrian case AR8X16_PORT_STS_SPEED_1000: 400235288Sadrian *media_active |= IFM_1000_T; 401235288Sadrian break; 402235288Sadrian } 403235288Sadrian if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0) 404235288Sadrian *media_active |= IFM_FDX; 405235288Sadrian else 406235288Sadrian *media_active |= IFM_HDX; 407235288Sadrian if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0) 408235288Sadrian *media_active |= IFM_ETH_TXPAUSE; 409235288Sadrian if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0) 410235288Sadrian *media_active |= IFM_ETH_RXPAUSE; 411235288Sadrian} 412235288Sadrian 413235288Sadrian/* 414235288Sadrian * Poll the status for all PHYs. We're using the switch port status because 415235288Sadrian * thats a lot quicker to read than talking to all the PHYs. Care must be 416235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will 417235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs 418235288Sadrian * update function is called. 419235288Sadrian */ 420235288Sadrianstatic void 421235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc) 422235288Sadrian{ 423235288Sadrian int i; 424235288Sadrian struct mii_data *mii; 425235288Sadrian struct mii_softc *miisc; 426235288Sadrian int portstatus; 427235288Sadrian 428241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 429241578Sray 430235288Sadrian for (i = 0; i < sc->numphys; i++) { 431235288Sadrian if (sc->miibus[i] == NULL) 432235288Sadrian continue; 433235288Sadrian mii = device_get_softc(sc->miibus[i]); 434235288Sadrian portstatus = arswitch_readreg(sc->sc_dev, 435235288Sadrian AR8X16_REG_PORT_STS(arswitch_portforphy(i))); 436235288Sadrian#if 0 437235288Sadrian DPRINTF(sc->sc_dev, "p[%d]=%b\n", 438235288Sadrian arge_portforphy(i), 439235288Sadrian portstatus, 440235288Sadrian "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7" 441235288Sadrian "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE"); 442235288Sadrian#endif 443235288Sadrian arswitch_update_ifmedia(portstatus, &mii->mii_media_status, 444235288Sadrian &mii->mii_media_active); 445235288Sadrian LIST_FOREACH(miisc, &mii->mii_phys, mii_list) { 446235288Sadrian if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) != 447235288Sadrian miisc->mii_inst) 448235288Sadrian continue; 449235288Sadrian mii_phy_update(miisc, MII_POLLSTAT); 450235288Sadrian } 451235288Sadrian } 452235288Sadrian} 453235288Sadrian 454235288Sadrianstatic void 455235288Sadrianarswitch_tick(void *arg) 456235288Sadrian{ 457235288Sadrian struct arswitch_softc *sc = arg; 458235288Sadrian 459235288Sadrian arswitch_miipollstat(sc); 460235288Sadrian callout_reset(&sc->callout_tick, hz, arswitch_tick, sc); 461235288Sadrian} 462235288Sadrian 463241578Sraystatic void 464241578Srayarswitch_lock(device_t dev) 465241578Sray{ 466241578Sray struct arswitch_softc *sc = device_get_softc(dev); 467241578Sray 468241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED); 469241578Sray ARSWITCH_LOCK(sc); 470241578Sray} 471241578Sray 472241578Sraystatic void 473241578Srayarswitch_unlock(device_t dev) 474241578Sray{ 475241578Sray struct arswitch_softc *sc = device_get_softc(dev); 476241578Sray 477241578Sray ARSWITCH_LOCK_ASSERT(sc, MA_OWNED); 478241578Sray ARSWITCH_UNLOCK(sc); 479241578Sray} 480241578Sray 481235288Sadrianstatic etherswitch_info_t * 482235288Sadrianarswitch_getinfo(device_t dev) 483235288Sadrian{ 484235288Sadrian struct arswitch_softc *sc = device_get_softc(dev); 485235288Sadrian 486235288Sadrian return (&sc->info); 487235288Sadrian} 488235288Sadrian 489235288Sadrianstatic int 490235288Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p) 491235288Sadrian{ 492253572Sloos struct arswitch_softc *sc; 493253572Sloos struct ifmediareq *ifmr; 494235288Sadrian struct mii_data *mii; 495253572Sloos uint32_t reg; 496235288Sadrian int err; 497253572Sloos 498253572Sloos sc = device_get_softc(dev); 499253572Sloos if (p->es_port < 0 || p->es_port > sc->numphys) 500235288Sadrian return (ENXIO); 501235288Sadrian 502253572Sloos ARSWITCH_LOCK(sc); 503253572Sloos 504253572Sloos /* Retrieve the PVID. */ 505253572Sloos arswitch_get_pvid(sc, p->es_port, &p->es_pvid); 506253572Sloos 507253572Sloos /* Port flags. */ 508253572Sloos reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port)); 509253572Sloos if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG) 510253572Sloos p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG; 511253572Sloos reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 512253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD) 513253572Sloos p->es_flags |= ETHERSWITCH_PORT_ADDTAG; 514253572Sloos if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP) 515253572Sloos p->es_flags |= ETHERSWITCH_PORT_STRIPTAG; 516253572Sloos ARSWITCH_UNLOCK(sc); 517253572Sloos 518235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 519235288Sadrian if (p->es_port == 0) { 520235288Sadrian /* fill in fixed values for CPU port */ 521250383Sadrian p->es_flags |= ETHERSWITCH_PORT_CPU; 522253572Sloos ifmr = &p->es_ifmr; 523235288Sadrian ifmr->ifm_count = 0; 524235288Sadrian ifmr->ifm_current = ifmr->ifm_active = 525235288Sadrian IFM_ETHER | IFM_1000_T | IFM_FDX; 526235288Sadrian ifmr->ifm_mask = 0; 527235288Sadrian ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID; 528235288Sadrian } else if (mii != NULL) { 529235288Sadrian err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr, 530235288Sadrian &mii->mii_media, SIOCGIFMEDIA); 531235288Sadrian if (err) 532235288Sadrian return (err); 533235288Sadrian } else { 534235288Sadrian return (ENXIO); 535235288Sadrian } 536235288Sadrian return (0); 537235288Sadrian} 538235288Sadrian 539235288Sadrianstatic int 540235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p) 541235288Sadrian{ 542235288Sadrian int err; 543253572Sloos uint32_t reg; 544235288Sadrian struct arswitch_softc *sc; 545235288Sadrian struct ifmedia *ifm; 546235288Sadrian struct mii_data *mii; 547235288Sadrian struct ifnet *ifp; 548235288Sadrian 549253572Sloos sc = device_get_softc(dev); 550253572Sloos if (p->es_port < 0 || p->es_port > sc->numphys) 551235288Sadrian return (ENXIO); 552235288Sadrian 553253572Sloos /* Port flags. */ 554253572Sloos if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) { 555235288Sadrian 556253572Sloos ARSWITCH_LOCK(sc); 557253572Sloos /* Set the PVID. */ 558253572Sloos if (p->es_pvid != 0) 559253572Sloos arswitch_set_pvid(sc, p->es_port, p->es_pvid); 560235288Sadrian 561253572Sloos /* Mutually exclusive. */ 562253572Sloos if (p->es_flags & ETHERSWITCH_PORT_ADDTAG && 563253572Sloos p->es_flags & ETHERSWITCH_PORT_STRIPTAG) { 564253572Sloos ARSWITCH_UNLOCK(sc); 565253572Sloos return (EINVAL); 566253572Sloos } 567253572Sloos 568253572Sloos reg = 0; 569253572Sloos if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG) 570253572Sloos reg |= AR8X16_PORT_CTRL_DOUBLE_TAG; 571253572Sloos if (p->es_flags & ETHERSWITCH_PORT_ADDTAG) 572253572Sloos reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD << 573253572Sloos AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 574253572Sloos if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG) 575253572Sloos reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP << 576253572Sloos AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT; 577253572Sloos 578253572Sloos err = arswitch_modifyreg(sc->sc_dev, 579253572Sloos AR8X16_REG_PORT_CTRL(p->es_port), 580253572Sloos 0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT | 581253572Sloos AR8X16_PORT_CTRL_DOUBLE_TAG, reg); 582253572Sloos 583253572Sloos ARSWITCH_UNLOCK(sc); 584253572Sloos if (err) 585253572Sloos return (err); 586253572Sloos } 587253572Sloos 588253572Sloos /* Do not allow media changes on CPU port. */ 589253572Sloos if (p->es_port == AR8X16_PORT_CPU) 590253572Sloos return (0); 591253572Sloos 592235288Sadrian mii = arswitch_miiforport(sc, p->es_port); 593235288Sadrian if (mii == NULL) 594235288Sadrian return (ENXIO); 595235288Sadrian 596235288Sadrian ifp = arswitch_ifpforport(sc, p->es_port); 597235288Sadrian 598235288Sadrian ifm = &mii->mii_media; 599253572Sloos return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA)); 600235288Sadrian} 601235288Sadrian 602235288Sadrianstatic void 603235288Sadrianarswitch_statchg(device_t dev) 604235288Sadrian{ 605235288Sadrian 606235288Sadrian DPRINTF(dev, "%s\n", __func__); 607235288Sadrian} 608235288Sadrian 609235288Sadrianstatic int 610235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp) 611235288Sadrian{ 612235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 613235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 614235288Sadrian 615235288Sadrian if (mii == NULL) 616235288Sadrian return (ENXIO); 617235288Sadrian mii_mediachg(mii); 618235288Sadrian return (0); 619235288Sadrian} 620235288Sadrian 621235288Sadrianstatic void 622235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 623235288Sadrian{ 624235288Sadrian struct arswitch_softc *sc = ifp->if_softc; 625235288Sadrian struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit); 626235288Sadrian 627235288Sadrian DPRINTF(sc->sc_dev, "%s\n", __func__); 628235288Sadrian 629235288Sadrian if (mii == NULL) 630235288Sadrian return; 631235288Sadrian mii_pollstat(mii); 632235288Sadrian ifmr->ifm_active = mii->mii_media_active; 633235288Sadrian ifmr->ifm_status = mii->mii_media_status; 634235288Sadrian} 635235288Sadrian 636253572Sloosstatic int 637253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf) 638253572Sloos{ 639253572Sloos struct arswitch_softc *sc; 640253572Sloos 641253572Sloos sc = device_get_softc(dev); 642253572Sloos 643253572Sloos /* Return the VLAN mode. */ 644253572Sloos conf->cmd = ETHERSWITCH_CONF_VLAN_MODE; 645253572Sloos conf->vlan_mode = sc->vlan_mode; 646253572Sloos 647253572Sloos return (0); 648253572Sloos} 649253572Sloos 650253572Sloosstatic int 651253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf) 652253572Sloos{ 653253572Sloos struct arswitch_softc *sc; 654253572Sloos int err; 655253572Sloos 656253572Sloos sc = device_get_softc(dev); 657253572Sloos 658253572Sloos /* Set the VLAN mode. */ 659253572Sloos if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) { 660253572Sloos err = arswitch_set_vlan_mode(sc, conf->vlan_mode); 661253572Sloos if (err != 0) 662253572Sloos return (err); 663253572Sloos } 664253572Sloos 665253572Sloos return (0); 666253572Sloos} 667253572Sloos 668235288Sadrianstatic device_method_t arswitch_methods[] = { 669235288Sadrian /* Device interface */ 670235288Sadrian DEVMETHOD(device_probe, arswitch_probe), 671235288Sadrian DEVMETHOD(device_attach, arswitch_attach), 672235288Sadrian DEVMETHOD(device_detach, arswitch_detach), 673235288Sadrian 674235288Sadrian /* bus interface */ 675235288Sadrian DEVMETHOD(bus_add_child, device_add_child_ordered), 676235288Sadrian 677235288Sadrian /* MII interface */ 678235288Sadrian DEVMETHOD(miibus_readreg, arswitch_readphy), 679235288Sadrian DEVMETHOD(miibus_writereg, arswitch_writephy), 680235288Sadrian DEVMETHOD(miibus_statchg, arswitch_statchg), 681235288Sadrian 682235288Sadrian /* MDIO interface */ 683235288Sadrian DEVMETHOD(mdio_readreg, arswitch_readphy), 684235288Sadrian DEVMETHOD(mdio_writereg, arswitch_writephy), 685235288Sadrian 686235288Sadrian /* etherswitch interface */ 687241578Sray DEVMETHOD(etherswitch_lock, arswitch_lock), 688241578Sray DEVMETHOD(etherswitch_unlock, arswitch_unlock), 689235288Sadrian DEVMETHOD(etherswitch_getinfo, arswitch_getinfo), 690235288Sadrian DEVMETHOD(etherswitch_readreg, arswitch_readreg), 691235288Sadrian DEVMETHOD(etherswitch_writereg, arswitch_writereg), 692235288Sadrian DEVMETHOD(etherswitch_readphyreg, arswitch_readphy), 693235288Sadrian DEVMETHOD(etherswitch_writephyreg, arswitch_writephy), 694235288Sadrian DEVMETHOD(etherswitch_getport, arswitch_getport), 695235288Sadrian DEVMETHOD(etherswitch_setport, arswitch_setport), 696235288Sadrian DEVMETHOD(etherswitch_getvgroup, arswitch_getvgroup), 697235288Sadrian DEVMETHOD(etherswitch_setvgroup, arswitch_setvgroup), 698253572Sloos DEVMETHOD(etherswitch_getconf, arswitch_getconf), 699253572Sloos DEVMETHOD(etherswitch_setconf, arswitch_setconf), 700235288Sadrian 701235288Sadrian DEVMETHOD_END 702235288Sadrian}; 703235288Sadrian 704235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods, 705235288Sadrian sizeof(struct arswitch_softc)); 706235288Sadrianstatic devclass_t arswitch_devclass; 707235288Sadrian 708235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0); 709235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0); 710235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0); 711235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0); 712235288SadrianMODULE_VERSION(arswitch, 1); 713235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */ 714235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */ 715