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