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