arswitch.c revision 262202
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 262202 2014-02-19 05:09:47Z 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
227253572Sloosarswitch_ports_init(struct arswitch_softc *sc)
228253572Sloos{
229253572Sloos	int port;
230253572Sloos
231253572Sloos	/* Port0 - CPU */
232253572Sloos	arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0),
233253572Sloos	    (AR8X16_IS_SWITCH(sc, AR8216) ?
234253572Sloos	    AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) |
235253572Sloos	    (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) |
236253572Sloos	    (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) |
237253572Sloos	    AR8X16_PORT_STS_RXMAC |
238253572Sloos	    AR8X16_PORT_STS_TXMAC |
239253572Sloos	    AR8X16_PORT_STS_DUPLEX);
240253572Sloos	arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0),
241253572Sloos	    arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) &
242253572Sloos	    ~AR8X16_PORT_CTRL_HEADER);
243253572Sloos
244253572Sloos	for (port = 1; port <= sc->numphys; port++) {
245253572Sloos		/* Set ports to auto negotiation. */
246253572Sloos		arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port),
247253572Sloos		    AR8X16_PORT_STS_LINK_AUTO);
248253572Sloos		arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port),
249253572Sloos		    arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) &
250253572Sloos		    ~AR8X16_PORT_CTRL_HEADER);
251253572Sloos	}
252253572Sloos}
253253572Sloos
254253572Sloosstatic int
255235288Sadrianarswitch_attach(device_t dev)
256235288Sadrian{
257235288Sadrian	struct arswitch_softc *sc;
258235288Sadrian	int err = 0;
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
269235288Sadrian	/*
270235288Sadrian	 * Attach switch related functions
271235288Sadrian	 */
272235323Sadrian	if (AR8X16_IS_SWITCH(sc, AR7240))
273235323Sadrian		ar7240_attach(sc);
274256582Sadrian	else if (AR8X16_IS_SWITCH(sc, AR9340))
275256582Sadrian		ar9340_attach(sc);
276235323Sadrian	else if (AR8X16_IS_SWITCH(sc, AR8216))
277235288Sadrian		ar8216_attach(sc);
278235288Sadrian	else if (AR8X16_IS_SWITCH(sc, AR8226))
279235288Sadrian		ar8226_attach(sc);
280235288Sadrian	else if (AR8X16_IS_SWITCH(sc, AR8316))
281235288Sadrian		ar8316_attach(sc);
282235288Sadrian	else
283235288Sadrian		return (ENXIO);
284235288Sadrian
285253572Sloos	/* Common defaults. */
286235288Sadrian	sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */
287235288Sadrian
288235288Sadrian	/* XXX Defaults for externally connected AR8316 */
289235288Sadrian	sc->numphys = 4;
290235288Sadrian	sc->phy4cpu = 1;
291235288Sadrian	sc->is_rgmii = 1;
292235288Sadrian	sc->is_gmii = 0;
293256582Sadrian	sc->is_mii = 0;
294235288Sadrian
295235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
296235288Sadrian	    "numphys", &sc->numphys);
297235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
298235288Sadrian	    "phy4cpu", &sc->phy4cpu);
299235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
300235288Sadrian	    "is_rgmii", &sc->is_rgmii);
301235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
302235288Sadrian	    "is_gmii", &sc->is_gmii);
303256582Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
304256582Sadrian	    "is_mii", &sc->is_mii);
305235288Sadrian
306253572Sloos	if (sc->numphys > AR8X16_NUM_PHYS)
307253572Sloos		sc->numphys = AR8X16_NUM_PHYS;
308253572Sloos
309253572Sloos	/* Reset the switch. */
310253572Sloos	if (arswitch_reset(dev))
311235288Sadrian		return (ENXIO);
312235288Sadrian
313256582Sadrian	err = sc->hal.arswitch_hw_setup(sc);
314256582Sadrian	if (err != 0)
315256582Sadrian		return (err);
316256582Sadrian
317235288Sadrian	err = sc->hal.arswitch_hw_global_setup(sc);
318235288Sadrian	if (err != 0)
319235288Sadrian		return (err);
320235288Sadrian
321253572Sloos	/* Initialize the switch ports. */
322253572Sloos	arswitch_ports_init(sc);
323253572Sloos
324235288Sadrian	/*
325235288Sadrian	 * Attach the PHYs and complete the bus enumeration.
326235288Sadrian	 */
327235288Sadrian	err = arswitch_attach_phys(sc);
328235288Sadrian	if (err != 0)
329235288Sadrian		return (err);
330235288Sadrian
331253572Sloos	/* Default to ingress filters off. */
332253572Sloos	err = arswitch_set_vlan_mode(sc, 0);
333253572Sloos	if (err != 0)
334253572Sloos		return (err);
335253572Sloos
336235288Sadrian	bus_generic_probe(dev);
337235288Sadrian	bus_enumerate_hinted_children(dev);
338235288Sadrian	err = bus_generic_attach(dev);
339235288Sadrian	if (err != 0)
340235288Sadrian		return (err);
341235288Sadrian
342235288Sadrian	callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0);
343241578Sray
344241578Sray	ARSWITCH_LOCK(sc);
345235288Sadrian	arswitch_tick(sc);
346241578Sray	ARSWITCH_UNLOCK(sc);
347235288Sadrian
348235288Sadrian	return (err);
349235288Sadrian}
350235288Sadrian
351235288Sadrianstatic int
352235288Sadrianarswitch_detach(device_t dev)
353235288Sadrian{
354235288Sadrian	struct arswitch_softc *sc = device_get_softc(dev);
355235288Sadrian	int i;
356235288Sadrian
357235288Sadrian	callout_drain(&sc->callout_tick);
358235288Sadrian
359235288Sadrian	for (i=0; i < sc->numphys; i++) {
360235288Sadrian		if (sc->miibus[i] != NULL)
361235288Sadrian			device_delete_child(dev, sc->miibus[i]);
362235288Sadrian		if (sc->ifp[i] != NULL)
363235288Sadrian			if_free(sc->ifp[i]);
364235288Sadrian		free(sc->ifname[i], M_DEVBUF);
365235288Sadrian	}
366235288Sadrian
367235288Sadrian	bus_generic_detach(dev);
368235288Sadrian	mtx_destroy(&sc->sc_mtx);
369235288Sadrian
370235288Sadrian	return (0);
371235288Sadrian}
372235288Sadrian
373235288Sadrian/*
374235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to
375235288Sadrian * port 2, etc.
376235288Sadrian */
377235288Sadrianstatic inline int
378235288Sadrianarswitch_portforphy(int phy)
379235288Sadrian{
380235288Sadrian	return (phy+1);
381235288Sadrian}
382235288Sadrian
383235288Sadrianstatic inline struct mii_data *
384235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port)
385235288Sadrian{
386235288Sadrian	int phy = port-1;
387235288Sadrian
388235288Sadrian	if (phy < 0 || phy >= sc->numphys)
389235288Sadrian		return (NULL);
390235288Sadrian	return (device_get_softc(sc->miibus[phy]));
391235288Sadrian}
392235288Sadrian
393235288Sadrianstatic inline struct ifnet *
394235288Sadrianarswitch_ifpforport(struct arswitch_softc *sc, int port)
395235288Sadrian{
396235288Sadrian	int phy = port-1;
397235288Sadrian
398235288Sadrian	if (phy < 0 || phy >= sc->numphys)
399235288Sadrian		return (NULL);
400235288Sadrian	return (sc->ifp[phy]);
401235288Sadrian}
402235288Sadrian
403235288Sadrian/*
404235288Sadrian * Convert port status to ifmedia.
405235288Sadrian */
406235288Sadrianstatic void
407235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active)
408235288Sadrian{
409235288Sadrian	*media_active = IFM_ETHER;
410235288Sadrian	*media_status = IFM_AVALID;
411235288Sadrian
412235288Sadrian	if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0)
413235288Sadrian		*media_status |= IFM_ACTIVE;
414235288Sadrian	else {
415235288Sadrian		*media_active |= IFM_NONE;
416235288Sadrian		return;
417235288Sadrian	}
418235288Sadrian	switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) {
419235288Sadrian	case AR8X16_PORT_STS_SPEED_10:
420235288Sadrian		*media_active |= IFM_10_T;
421235288Sadrian		break;
422235288Sadrian	case AR8X16_PORT_STS_SPEED_100:
423235288Sadrian		*media_active |= IFM_100_TX;
424235288Sadrian		break;
425235288Sadrian	case AR8X16_PORT_STS_SPEED_1000:
426235288Sadrian		*media_active |= IFM_1000_T;
427235288Sadrian		break;
428235288Sadrian	}
429235288Sadrian	if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0)
430235288Sadrian		*media_active |= IFM_FDX;
431235288Sadrian	else
432235288Sadrian		*media_active |= IFM_HDX;
433235288Sadrian	if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0)
434235288Sadrian		*media_active |= IFM_ETH_TXPAUSE;
435235288Sadrian	if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0)
436235288Sadrian		*media_active |= IFM_ETH_RXPAUSE;
437235288Sadrian}
438235288Sadrian
439235288Sadrian/*
440235288Sadrian * Poll the status for all PHYs.  We're using the switch port status because
441235288Sadrian * thats a lot quicker to read than talking to all the PHYs.  Care must be
442235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will
443235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs
444235288Sadrian * update function is called.
445235288Sadrian */
446235288Sadrianstatic void
447235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc)
448235288Sadrian{
449235288Sadrian	int i;
450235288Sadrian	struct mii_data *mii;
451235288Sadrian	struct mii_softc *miisc;
452235288Sadrian	int portstatus;
453235288Sadrian
454241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
455241578Sray
456235288Sadrian	for (i = 0; i < sc->numphys; i++) {
457235288Sadrian		if (sc->miibus[i] == NULL)
458235288Sadrian			continue;
459235288Sadrian		mii = device_get_softc(sc->miibus[i]);
460235288Sadrian		portstatus = arswitch_readreg(sc->sc_dev,
461235288Sadrian		    AR8X16_REG_PORT_STS(arswitch_portforphy(i)));
462235288Sadrian#if 0
463235288Sadrian		DPRINTF(sc->sc_dev, "p[%d]=%b\n",
464256582Sadrian		    i,
465235288Sadrian		    portstatus,
466235288Sadrian		    "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7"
467235288Sadrian		    "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE");
468235288Sadrian#endif
469235288Sadrian		arswitch_update_ifmedia(portstatus, &mii->mii_media_status,
470235288Sadrian		    &mii->mii_media_active);
471235288Sadrian		LIST_FOREACH(miisc, &mii->mii_phys, mii_list) {
472235288Sadrian			if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) !=
473235288Sadrian			    miisc->mii_inst)
474235288Sadrian				continue;
475235288Sadrian			mii_phy_update(miisc, MII_POLLSTAT);
476235288Sadrian		}
477235288Sadrian	}
478235288Sadrian}
479235288Sadrian
480235288Sadrianstatic void
481235288Sadrianarswitch_tick(void *arg)
482235288Sadrian{
483235288Sadrian	struct arswitch_softc *sc = arg;
484235288Sadrian
485235288Sadrian	arswitch_miipollstat(sc);
486235288Sadrian	callout_reset(&sc->callout_tick, hz, arswitch_tick, sc);
487235288Sadrian}
488235288Sadrian
489241578Sraystatic void
490241578Srayarswitch_lock(device_t dev)
491241578Sray{
492241578Sray	struct arswitch_softc *sc = device_get_softc(dev);
493241578Sray
494241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED);
495241578Sray	ARSWITCH_LOCK(sc);
496241578Sray}
497241578Sray
498241578Sraystatic void
499241578Srayarswitch_unlock(device_t dev)
500241578Sray{
501241578Sray	struct arswitch_softc *sc = device_get_softc(dev);
502241578Sray
503241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
504241578Sray	ARSWITCH_UNLOCK(sc);
505241578Sray}
506241578Sray
507235288Sadrianstatic etherswitch_info_t *
508235288Sadrianarswitch_getinfo(device_t dev)
509235288Sadrian{
510235288Sadrian	struct arswitch_softc *sc = device_get_softc(dev);
511235288Sadrian
512235288Sadrian	return (&sc->info);
513235288Sadrian}
514235288Sadrian
515235288Sadrianstatic int
516235288Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p)
517235288Sadrian{
518253572Sloos	struct arswitch_softc *sc;
519253572Sloos	struct ifmediareq *ifmr;
520235288Sadrian	struct mii_data *mii;
521253572Sloos	uint32_t reg;
522235288Sadrian	int err;
523253572Sloos
524253572Sloos	sc = device_get_softc(dev);
525253572Sloos	if (p->es_port < 0 || p->es_port > sc->numphys)
526235288Sadrian		return (ENXIO);
527235288Sadrian
528253572Sloos	ARSWITCH_LOCK(sc);
529253572Sloos
530253572Sloos	/* Retrieve the PVID. */
531253572Sloos	arswitch_get_pvid(sc, p->es_port, &p->es_pvid);
532253572Sloos
533253572Sloos	/* Port flags. */
534253572Sloos	reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port));
535253572Sloos	if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG)
536253572Sloos		p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG;
537253572Sloos	reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
538253572Sloos	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD)
539253572Sloos		p->es_flags |= ETHERSWITCH_PORT_ADDTAG;
540253572Sloos	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP)
541253572Sloos		p->es_flags |= ETHERSWITCH_PORT_STRIPTAG;
542253572Sloos	ARSWITCH_UNLOCK(sc);
543253572Sloos
544235288Sadrian	mii = arswitch_miiforport(sc, p->es_port);
545235288Sadrian	if (p->es_port == 0) {
546235288Sadrian		/* fill in fixed values for CPU port */
547250383Sadrian		p->es_flags |= ETHERSWITCH_PORT_CPU;
548253572Sloos		ifmr = &p->es_ifmr;
549235288Sadrian		ifmr->ifm_count = 0;
550235288Sadrian		ifmr->ifm_current = ifmr->ifm_active =
551235288Sadrian		    IFM_ETHER | IFM_1000_T | IFM_FDX;
552235288Sadrian		ifmr->ifm_mask = 0;
553235288Sadrian		ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID;
554235288Sadrian	} else if (mii != NULL) {
555235288Sadrian		err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr,
556235288Sadrian		    &mii->mii_media, SIOCGIFMEDIA);
557235288Sadrian		if (err)
558235288Sadrian			return (err);
559235288Sadrian	} else {
560235288Sadrian		return (ENXIO);
561235288Sadrian	}
562235288Sadrian	return (0);
563235288Sadrian}
564235288Sadrian
565235288Sadrianstatic int
566235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p)
567235288Sadrian{
568235288Sadrian	int err;
569253572Sloos	uint32_t reg;
570235288Sadrian	struct arswitch_softc *sc;
571235288Sadrian	struct ifmedia *ifm;
572235288Sadrian	struct mii_data *mii;
573235288Sadrian	struct ifnet *ifp;
574235288Sadrian
575253572Sloos	sc = device_get_softc(dev);
576253572Sloos	if (p->es_port < 0 || p->es_port > sc->numphys)
577235288Sadrian		return (ENXIO);
578235288Sadrian
579253572Sloos	/* Port flags. */
580253572Sloos	if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) {
581235288Sadrian
582253572Sloos		ARSWITCH_LOCK(sc);
583253572Sloos		/* Set the PVID. */
584253572Sloos		if (p->es_pvid != 0)
585253572Sloos			arswitch_set_pvid(sc, p->es_port, p->es_pvid);
586235288Sadrian
587253572Sloos		/* Mutually exclusive. */
588253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG &&
589253572Sloos		    p->es_flags & ETHERSWITCH_PORT_STRIPTAG) {
590253572Sloos			ARSWITCH_UNLOCK(sc);
591253572Sloos			return (EINVAL);
592253572Sloos		}
593253572Sloos
594253572Sloos		reg = 0;
595253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG)
596253572Sloos			reg |= AR8X16_PORT_CTRL_DOUBLE_TAG;
597253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG)
598253572Sloos			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD <<
599253572Sloos			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
600253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG)
601253572Sloos			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP <<
602253572Sloos			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
603253572Sloos
604253572Sloos		err = arswitch_modifyreg(sc->sc_dev,
605253572Sloos		    AR8X16_REG_PORT_CTRL(p->es_port),
606253572Sloos		    0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT |
607253572Sloos		    AR8X16_PORT_CTRL_DOUBLE_TAG, reg);
608253572Sloos
609253572Sloos		ARSWITCH_UNLOCK(sc);
610253572Sloos		if (err)
611253572Sloos			return (err);
612253572Sloos        }
613253572Sloos
614253572Sloos	/* Do not allow media changes on CPU port. */
615253572Sloos	if (p->es_port == AR8X16_PORT_CPU)
616253572Sloos		return (0);
617253572Sloos
618235288Sadrian	mii = arswitch_miiforport(sc, p->es_port);
619235288Sadrian	if (mii == NULL)
620235288Sadrian		return (ENXIO);
621235288Sadrian
622235288Sadrian	ifp = arswitch_ifpforport(sc, p->es_port);
623235288Sadrian
624235288Sadrian	ifm = &mii->mii_media;
625253572Sloos	return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA));
626235288Sadrian}
627235288Sadrian
628235288Sadrianstatic void
629235288Sadrianarswitch_statchg(device_t dev)
630235288Sadrian{
631235288Sadrian
632235288Sadrian	DPRINTF(dev, "%s\n", __func__);
633235288Sadrian}
634235288Sadrian
635235288Sadrianstatic int
636235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp)
637235288Sadrian{
638235288Sadrian	struct arswitch_softc *sc = ifp->if_softc;
639235288Sadrian	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
640235288Sadrian
641235288Sadrian	if (mii == NULL)
642235288Sadrian		return (ENXIO);
643235288Sadrian	mii_mediachg(mii);
644235288Sadrian	return (0);
645235288Sadrian}
646235288Sadrian
647235288Sadrianstatic void
648235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
649235288Sadrian{
650235288Sadrian	struct arswitch_softc *sc = ifp->if_softc;
651235288Sadrian	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
652235288Sadrian
653235288Sadrian	DPRINTF(sc->sc_dev, "%s\n", __func__);
654235288Sadrian
655235288Sadrian	if (mii == NULL)
656235288Sadrian		return;
657235288Sadrian	mii_pollstat(mii);
658235288Sadrian	ifmr->ifm_active = mii->mii_media_active;
659235288Sadrian	ifmr->ifm_status = mii->mii_media_status;
660235288Sadrian}
661235288Sadrian
662253572Sloosstatic int
663253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf)
664253572Sloos{
665253572Sloos	struct arswitch_softc *sc;
666253572Sloos
667253572Sloos	sc = device_get_softc(dev);
668253572Sloos
669253572Sloos	/* Return the VLAN mode. */
670253572Sloos	conf->cmd = ETHERSWITCH_CONF_VLAN_MODE;
671253572Sloos	conf->vlan_mode = sc->vlan_mode;
672253572Sloos
673253572Sloos	return (0);
674253572Sloos}
675253572Sloos
676253572Sloosstatic int
677253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf)
678253572Sloos{
679253572Sloos	struct arswitch_softc *sc;
680253572Sloos	int err;
681253572Sloos
682253572Sloos	sc = device_get_softc(dev);
683253572Sloos
684253572Sloos	/* Set the VLAN mode. */
685253572Sloos	if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) {
686253572Sloos		err = arswitch_set_vlan_mode(sc, conf->vlan_mode);
687253572Sloos		if (err != 0)
688253572Sloos			return (err);
689253572Sloos	}
690253572Sloos
691253572Sloos	return (0);
692253572Sloos}
693253572Sloos
694235288Sadrianstatic device_method_t arswitch_methods[] = {
695235288Sadrian	/* Device interface */
696235288Sadrian	DEVMETHOD(device_probe,		arswitch_probe),
697235288Sadrian	DEVMETHOD(device_attach,	arswitch_attach),
698235288Sadrian	DEVMETHOD(device_detach,	arswitch_detach),
699235288Sadrian
700235288Sadrian	/* bus interface */
701235288Sadrian	DEVMETHOD(bus_add_child,	device_add_child_ordered),
702235288Sadrian
703235288Sadrian	/* MII interface */
704235288Sadrian	DEVMETHOD(miibus_readreg,	arswitch_readphy),
705235288Sadrian	DEVMETHOD(miibus_writereg,	arswitch_writephy),
706235288Sadrian	DEVMETHOD(miibus_statchg,	arswitch_statchg),
707235288Sadrian
708235288Sadrian	/* MDIO interface */
709235288Sadrian	DEVMETHOD(mdio_readreg,		arswitch_readphy),
710235288Sadrian	DEVMETHOD(mdio_writereg,	arswitch_writephy),
711235288Sadrian
712235288Sadrian	/* etherswitch interface */
713241578Sray	DEVMETHOD(etherswitch_lock,	arswitch_lock),
714241578Sray	DEVMETHOD(etherswitch_unlock,	arswitch_unlock),
715235288Sadrian	DEVMETHOD(etherswitch_getinfo,	arswitch_getinfo),
716235288Sadrian	DEVMETHOD(etherswitch_readreg,	arswitch_readreg),
717235288Sadrian	DEVMETHOD(etherswitch_writereg,	arswitch_writereg),
718235288Sadrian	DEVMETHOD(etherswitch_readphyreg,	arswitch_readphy),
719235288Sadrian	DEVMETHOD(etherswitch_writephyreg,	arswitch_writephy),
720235288Sadrian	DEVMETHOD(etherswitch_getport,	arswitch_getport),
721235288Sadrian	DEVMETHOD(etherswitch_setport,	arswitch_setport),
722235288Sadrian	DEVMETHOD(etherswitch_getvgroup,	arswitch_getvgroup),
723235288Sadrian	DEVMETHOD(etherswitch_setvgroup,	arswitch_setvgroup),
724253572Sloos	DEVMETHOD(etherswitch_getconf,	arswitch_getconf),
725253572Sloos	DEVMETHOD(etherswitch_setconf,	arswitch_setconf),
726235288Sadrian
727235288Sadrian	DEVMETHOD_END
728235288Sadrian};
729235288Sadrian
730235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods,
731235288Sadrian    sizeof(struct arswitch_softc));
732235288Sadrianstatic devclass_t arswitch_devclass;
733235288Sadrian
734235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0);
735235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0);
736235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0);
737235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0);
738235288SadrianMODULE_VERSION(arswitch, 1);
739235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */
740235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */
741