2 * Copyright (c) 2016 Stanislav Galabov.
3 * Copyright (c) 2011-2012 Stefan Bethke.
4 * Copyright (c) 2012 Adrian Chadd.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 #include <sys/param.h>
33 #include <sys/errno.h>
34 #include <sys/kernel.h>
36 #include <sys/malloc.h>
37 #include <sys/module.h>
38 #include <sys/mutex.h>
39 #include <sys/socket.h>
40 #include <sys/sockio.h>
41 #include <sys/sysctl.h>
42 #include <sys/systm.h>
45 #include <net/if_var.h>
46 #include <net/ethernet.h>
47 #include <net/if_media.h>
48 #include <net/if_types.h>
50 #include <machine/bus.h>
51 #include <dev/mii/mii.h>
52 #include <dev/mii/miivar.h>
53 #include <dev/mdio/mdio.h>
55 #include <dev/etherswitch/etherswitch.h>
56 #include <dev/etherswitch/mtkswitch/mtkswitchvar.h>
58 #include <dev/ofw/ofw_bus_subr.h>
61 #include "miibus_if.h"
62 #include "etherswitch_if.h"
67 static SYSCTL_NODE(_debug, OID_AUTO, mtkswitch, CTLFLAG_RD, 0, "mtkswitch");
70 static inline int mtkswitch_portforphy(int phy);
71 static int mtkswitch_ifmedia_upd(struct ifnet *ifp);
72 static void mtkswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr);
73 static void mtkswitch_tick(void *arg);
75 static const struct ofw_compat_data compat_data[] = {
76 { "ralink,rt3050-esw", MTK_SWITCH_RT3050 },
77 { "ralink,rt3352-esw", MTK_SWITCH_RT3352 },
78 { "ralink,rt5350-esw", MTK_SWITCH_RT5350 },
79 { "mediatek,mt7620-gsw", MTK_SWITCH_MT7620 },
80 { "mediatek,mt7621-gsw", MTK_SWITCH_MT7621 },
81 { "mediatek,mt7628-esw", MTK_SWITCH_MT7628 },
84 { NULL, MTK_SWITCH_NONE }
88 mtkswitch_probe(device_t dev)
90 struct mtkswitch_softc *sc;
91 mtk_switch_type switch_type;
93 if (!ofw_bus_status_okay(dev))
96 switch_type = ofw_bus_search_compatible(dev, compat_data)->ocd_data;
97 if (switch_type == MTK_SWITCH_NONE)
100 sc = device_get_softc(dev);
101 bzero(sc, sizeof(*sc));
102 sc->sc_switchtype = switch_type;
104 device_set_desc_copy(dev, "MTK Switch Driver");
110 mtkswitch_attach_phys(struct mtkswitch_softc *sc)
115 /* PHYs need an interface, so we generate a dummy one */
116 snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev));
117 for (phy = 0; phy < sc->numphys; phy++) {
118 if ((sc->phymap & (1u << phy)) == 0) {
120 sc->ifname[phy] = NULL;
121 sc->miibus[phy] = NULL;
124 sc->ifp[phy] = if_alloc(IFT_ETHER);
125 if (sc->ifp[phy] == NULL) {
126 device_printf(sc->sc_dev, "couldn't allocate ifnet structure\n");
131 sc->ifp[phy]->if_softc = sc;
132 sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST |
133 IFF_DRV_RUNNING | IFF_SIMPLEX;
134 sc->ifname[phy] = malloc(strlen(name) + 1, M_DEVBUF, M_WAITOK);
135 bcopy(name, sc->ifname[phy], strlen(name) + 1);
136 if_initname(sc->ifp[phy], sc->ifname[phy],
137 mtkswitch_portforphy(phy));
138 err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy],
139 mtkswitch_ifmedia_upd, mtkswitch_ifmedia_sts,
140 BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0);
142 device_printf(sc->sc_dev,
143 "attaching PHY %d failed\n",
146 DPRINTF(sc->sc_dev, "%s attached to pseudo interface "
147 "%s\n", device_get_nameunit(sc->miibus[phy]),
148 sc->ifp[phy]->if_xname);
155 mtkswitch_set_vlan_mode(struct mtkswitch_softc *sc, uint32_t mode)
158 /* Check for invalid modes. */
159 if ((mode & sc->info.es_vlan_caps) != mode)
162 sc->vlan_mode = mode;
165 sc->hal.mtkswitch_vlan_init_hw(sc);
171 mtkswitch_attach(device_t dev)
173 struct mtkswitch_softc *sc;
177 sc = device_get_softc(dev);
179 /* sc->sc_switchtype is already decided in mtkswitch_probe() */
180 sc->numports = MTKSWITCH_MAX_PORTS;
181 sc->numphys = MTKSWITCH_MAX_PHYS;
182 sc->cpuport = MTKSWITCH_CPU_PORT;
185 /* Attach switch related functions */
186 if (sc->sc_switchtype == MTK_SWITCH_NONE) {
187 device_printf(dev, "Unknown switch type\n");
191 if (sc->sc_switchtype == MTK_SWITCH_MT7620 ||
192 sc->sc_switchtype == MTK_SWITCH_MT7621)
193 mtk_attach_switch_mt7620(sc);
195 mtk_attach_switch_rt3050(sc);
197 /* Allocate resources */
199 sc->sc_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
201 if (sc->sc_res == NULL) {
202 device_printf(dev, "could not map memory\n");
206 mtx_init(&sc->sc_mtx, "mtkswitch", NULL, MTX_DEF);
208 /* Reset the switch */
209 if (sc->hal.mtkswitch_reset(sc)) {
210 DPRINTF(dev, "%s: mtkswitch_reset: failed\n", __func__);
214 err = sc->hal.mtkswitch_hw_setup(sc);
215 DPRINTF(dev, "%s: hw_setup: err=%d\n", __func__, err);
219 err = sc->hal.mtkswitch_hw_global_setup(sc);
220 DPRINTF(dev, "%s: hw_global_setup: err=%d\n", __func__, err);
224 /* Initialize the switch ports */
225 for (port = 0; port < sc->numports; port++) {
226 sc->hal.mtkswitch_port_init(sc, port);
229 /* Attach the PHYs and complete the bus enumeration */
230 err = mtkswitch_attach_phys(sc);
231 DPRINTF(dev, "%s: attach_phys: err=%d\n", __func__, err);
235 /* Default to ingress filters off. */
236 err = mtkswitch_set_vlan_mode(sc, ETHERSWITCH_VLAN_DOT1Q);
237 DPRINTF(dev, "%s: set_vlan_mode: err=%d\n", __func__, err);
241 bus_generic_probe(dev);
242 bus_enumerate_hinted_children(dev);
243 err = bus_generic_attach(dev);
244 DPRINTF(dev, "%s: bus_generic_attach: err=%d\n", __func__, err);
248 callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0);
252 MTKSWITCH_UNLOCK(sc);
258 mtkswitch_detach(device_t dev)
260 struct mtkswitch_softc *sc = device_get_softc(dev);
263 callout_drain(&sc->callout_tick);
265 for (phy = 0; phy < MTKSWITCH_MAX_PHYS; phy++) {
266 if (sc->miibus[phy] != NULL)
267 device_delete_child(dev, sc->miibus[phy]);
268 if (sc->ifp[phy] != NULL)
269 if_free(sc->ifp[phy]);
270 free(sc->ifname[phy], M_DEVBUF);
273 bus_generic_detach(dev);
274 mtx_destroy(&sc->sc_mtx);
279 /* PHY <-> port mapping is currently 1:1 */
281 mtkswitch_portforphy(int phy)
288 mtkswitch_phyforport(int port)
294 static inline struct mii_data *
295 mtkswitch_miiforport(struct mtkswitch_softc *sc, int port)
297 int phy = mtkswitch_phyforport(port);
299 if (phy < 0 || phy >= MTKSWITCH_MAX_PHYS || sc->miibus[phy] == NULL)
302 return (device_get_softc(sc->miibus[phy]));
305 static inline struct ifnet *
306 mtkswitch_ifpforport(struct mtkswitch_softc *sc, int port)
308 int phy = mtkswitch_phyforport(port);
310 if (phy < 0 || phy >= MTKSWITCH_MAX_PHYS)
313 return (sc->ifp[phy]);
317 * Convert port status to ifmedia.
320 mtkswitch_update_ifmedia(uint32_t portstatus, u_int *media_status,
323 *media_active = IFM_ETHER;
324 *media_status = IFM_AVALID;
326 if ((portstatus & MTKSWITCH_LINK_UP) != 0)
327 *media_status |= IFM_ACTIVE;
329 *media_active |= IFM_NONE;
333 switch (portstatus & MTKSWITCH_SPEED_MASK) {
334 case MTKSWITCH_SPEED_10:
335 *media_active |= IFM_10_T;
337 case MTKSWITCH_SPEED_100:
338 *media_active |= IFM_100_TX;
340 case MTKSWITCH_SPEED_1000:
341 *media_active |= IFM_1000_T;
345 if ((portstatus & MTKSWITCH_DUPLEX) != 0)
346 *media_active |= IFM_FDX;
348 *media_active |= IFM_HDX;
350 if ((portstatus & MTKSWITCH_TXFLOW) != 0)
351 *media_active |= IFM_ETH_TXPAUSE;
352 if ((portstatus & MTKSWITCH_RXFLOW) != 0)
353 *media_active |= IFM_ETH_RXPAUSE;
357 mtkswitch_miipollstat(struct mtkswitch_softc *sc)
359 struct mii_data *mii;
360 struct mii_softc *miisc;
362 int i, port_flap = 0;
364 MTKSWITCH_LOCK_ASSERT(sc, MA_OWNED);
366 for (i = 0; i < sc->numphys; i++) {
367 if (sc->miibus[i] == NULL)
369 mii = device_get_softc(sc->miibus[i]);
370 portstatus = sc->hal.mtkswitch_get_port_status(sc,
371 mtkswitch_portforphy(i));
373 /* If a port has flapped - mark it so we can flush the ATU */
374 if (((mii->mii_media_status & IFM_ACTIVE) == 0 &&
375 (portstatus & MTKSWITCH_LINK_UP) != 0) ||
376 ((mii->mii_media_status & IFM_ACTIVE) != 0 &&
377 (portstatus & MTKSWITCH_LINK_UP) == 0)) {
381 mtkswitch_update_ifmedia(portstatus, &mii->mii_media_status,
382 &mii->mii_media_active);
383 LIST_FOREACH(miisc, &mii->mii_phys, mii_list) {
384 if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) !=
387 mii_phy_update(miisc, MII_POLLSTAT);
392 sc->hal.mtkswitch_atu_flush(sc);
396 mtkswitch_tick(void *arg)
398 struct mtkswitch_softc *sc = arg;
400 mtkswitch_miipollstat(sc);
401 callout_reset(&sc->callout_tick, hz, mtkswitch_tick, sc);
405 mtkswitch_lock(device_t dev)
407 struct mtkswitch_softc *sc = device_get_softc(dev);
409 MTKSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED);
414 mtkswitch_unlock(device_t dev)
416 struct mtkswitch_softc *sc = device_get_softc(dev);
418 MTKSWITCH_LOCK_ASSERT(sc, MA_OWNED);
419 MTKSWITCH_UNLOCK(sc);
422 static etherswitch_info_t *
423 mtkswitch_getinfo(device_t dev)
425 struct mtkswitch_softc *sc = device_get_softc(dev);
431 mtkswitch_is_cpuport(struct mtkswitch_softc *sc, int port)
434 return (sc->cpuport == port);
438 mtkswitch_getport(device_t dev, etherswitch_port_t *p)
440 struct mtkswitch_softc *sc;
441 struct mii_data *mii;
442 struct ifmediareq *ifmr;
445 sc = device_get_softc(dev);
446 if (p->es_port < 0 || p->es_port > sc->info.es_nports)
449 err = sc->hal.mtkswitch_port_vlan_get(sc, p);
453 mii = mtkswitch_miiforport(sc, p->es_port);
454 if (mtkswitch_is_cpuport(sc, p->es_port)) {
455 /* fill in fixed values for CPU port */
456 /* XXX is this valid in all cases? */
457 p->es_flags |= ETHERSWITCH_PORT_CPU;
460 ifmr->ifm_current = ifmr->ifm_active =
461 IFM_ETHER | IFM_1000_T | IFM_FDX;
463 ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID;
464 } else if (mii != NULL) {
465 err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr,
466 &mii->mii_media, SIOCGIFMEDIA);
472 ifmr->ifm_current = ifmr->ifm_active = IFM_NONE;
474 ifmr->ifm_status = 0;
480 mtkswitch_setport(device_t dev, etherswitch_port_t *p)
483 struct mtkswitch_softc *sc;
485 struct mii_data *mii;
488 sc = device_get_softc(dev);
489 if (p->es_port < 0 || p->es_port > sc->info.es_nports)
493 if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) {
494 err = sc->hal.mtkswitch_port_vlan_setup(sc, p);
499 /* Do not allow media changes on CPU port. */
500 if (mtkswitch_is_cpuport(sc, p->es_port))
503 mii = mtkswitch_miiforport(sc, p->es_port);
507 ifp = mtkswitch_ifpforport(sc, p->es_port);
509 ifm = &mii->mii_media;
510 return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA));
514 mtkswitch_statchg(device_t dev)
517 DPRINTF(dev, "%s\n", __func__);
521 mtkswitch_ifmedia_upd(struct ifnet *ifp)
523 struct mtkswitch_softc *sc = ifp->if_softc;
524 struct mii_data *mii = mtkswitch_miiforport(sc, ifp->if_dunit);
533 mtkswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
535 struct mtkswitch_softc *sc = ifp->if_softc;
536 struct mii_data *mii = mtkswitch_miiforport(sc, ifp->if_dunit);
538 DPRINTF(sc->sc_dev, "%s\n", __func__);
543 ifmr->ifm_active = mii->mii_media_active;
544 ifmr->ifm_status = mii->mii_media_status;
548 mtkswitch_getconf(device_t dev, etherswitch_conf_t *conf)
550 struct mtkswitch_softc *sc;
552 sc = device_get_softc(dev);
554 /* Return the VLAN mode. */
555 conf->cmd = ETHERSWITCH_CONF_VLAN_MODE;
556 conf->vlan_mode = sc->vlan_mode;
562 mtkswitch_setconf(device_t dev, etherswitch_conf_t *conf)
564 struct mtkswitch_softc *sc;
567 sc = device_get_softc(dev);
569 /* Set the VLAN mode. */
570 if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) {
571 err = mtkswitch_set_vlan_mode(sc, conf->vlan_mode);
580 mtkswitch_getvgroup(device_t dev, etherswitch_vlangroup_t *e)
582 struct mtkswitch_softc *sc = device_get_softc(dev);
584 return (sc->hal.mtkswitch_vlan_getvgroup(sc, e));
588 mtkswitch_setvgroup(device_t dev, etherswitch_vlangroup_t *e)
590 struct mtkswitch_softc *sc = device_get_softc(dev);
592 return (sc->hal.mtkswitch_vlan_setvgroup(sc, e));
596 mtkswitch_readphy(device_t dev, int phy, int reg)
598 struct mtkswitch_softc *sc = device_get_softc(dev);
600 return (sc->hal.mtkswitch_phy_read(dev, phy, reg));
604 mtkswitch_writephy(device_t dev, int phy, int reg, int val)
606 struct mtkswitch_softc *sc = device_get_softc(dev);
608 return (sc->hal.mtkswitch_phy_write(dev, phy, reg, val));
612 mtkswitch_readreg(device_t dev, int addr)
614 struct mtkswitch_softc *sc = device_get_softc(dev);
616 return (sc->hal.mtkswitch_reg_read(dev, addr));
620 mtkswitch_writereg(device_t dev, int addr, int value)
622 struct mtkswitch_softc *sc = device_get_softc(dev);
624 return (sc->hal.mtkswitch_reg_write(dev, addr, value));
627 static device_method_t mtkswitch_methods[] = {
628 /* Device interface */
629 DEVMETHOD(device_probe, mtkswitch_probe),
630 DEVMETHOD(device_attach, mtkswitch_attach),
631 DEVMETHOD(device_detach, mtkswitch_detach),
634 DEVMETHOD(bus_add_child, device_add_child_ordered),
637 DEVMETHOD(miibus_readreg, mtkswitch_readphy),
638 DEVMETHOD(miibus_writereg, mtkswitch_writephy),
639 DEVMETHOD(miibus_statchg, mtkswitch_statchg),
642 DEVMETHOD(mdio_readreg, mtkswitch_readphy),
643 DEVMETHOD(mdio_writereg, mtkswitch_writephy),
645 /* ehterswitch interface */
646 DEVMETHOD(etherswitch_lock, mtkswitch_lock),
647 DEVMETHOD(etherswitch_unlock, mtkswitch_unlock),
648 DEVMETHOD(etherswitch_getinfo, mtkswitch_getinfo),
649 DEVMETHOD(etherswitch_readreg, mtkswitch_readreg),
650 DEVMETHOD(etherswitch_writereg, mtkswitch_writereg),
651 DEVMETHOD(etherswitch_readphyreg, mtkswitch_readphy),
652 DEVMETHOD(etherswitch_writephyreg, mtkswitch_writephy),
653 DEVMETHOD(etherswitch_getport, mtkswitch_getport),
654 DEVMETHOD(etherswitch_setport, mtkswitch_setport),
655 DEVMETHOD(etherswitch_getvgroup, mtkswitch_getvgroup),
656 DEVMETHOD(etherswitch_setvgroup, mtkswitch_setvgroup),
657 DEVMETHOD(etherswitch_getconf, mtkswitch_getconf),
658 DEVMETHOD(etherswitch_setconf, mtkswitch_setconf),
663 DEFINE_CLASS_0(mtkswitch, mtkswitch_driver, mtkswitch_methods,
664 sizeof(struct mtkswitch_softc));
665 static devclass_t mtkswitch_devclass;
667 DRIVER_MODULE(mtkswitch, simplebus, mtkswitch_driver, mtkswitch_devclass, 0, 0);
668 DRIVER_MODULE(miibus, mtkswitch, miibus_driver, miibus_devclass, 0, 0);
669 DRIVER_MODULE(mdio, mtkswitch, mdio_driver, mdio_devclass, 0, 0);
670 DRIVER_MODULE(etherswitch, mtkswitch, etherswitch_driver, etherswitch_devclass,
672 MODULE_VERSION(mtkswitch, 1);
673 MODULE_DEPEND(mtkswitch, miibus, 1, 1, 1);
674 MODULE_DEPEND(mtkswitch, etherswitch, 1, 1, 1);