arswitch.c revision 262203
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 262203 2014-02-19 05:35:41Z 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
227262203Sadrianarswitch_port_init(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
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. */
322262203Sadrian	for (port = 0; port <= sc->numphys; port++) {
323262203Sadrian		arswitch_port_init(sc, port);
324262203Sadrian	}
325253572Sloos
326235288Sadrian	/*
327235288Sadrian	 * Attach the PHYs and complete the bus enumeration.
328235288Sadrian	 */
329235288Sadrian	err = arswitch_attach_phys(sc);
330235288Sadrian	if (err != 0)
331235288Sadrian		return (err);
332235288Sadrian
333253572Sloos	/* Default to ingress filters off. */
334253572Sloos	err = arswitch_set_vlan_mode(sc, 0);
335253572Sloos	if (err != 0)
336253572Sloos		return (err);
337253572Sloos
338235288Sadrian	bus_generic_probe(dev);
339235288Sadrian	bus_enumerate_hinted_children(dev);
340235288Sadrian	err = bus_generic_attach(dev);
341235288Sadrian	if (err != 0)
342235288Sadrian		return (err);
343235288Sadrian
344235288Sadrian	callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0);
345241578Sray
346241578Sray	ARSWITCH_LOCK(sc);
347235288Sadrian	arswitch_tick(sc);
348241578Sray	ARSWITCH_UNLOCK(sc);
349235288Sadrian
350235288Sadrian	return (err);
351235288Sadrian}
352235288Sadrian
353235288Sadrianstatic int
354235288Sadrianarswitch_detach(device_t dev)
355235288Sadrian{
356235288Sadrian	struct arswitch_softc *sc = device_get_softc(dev);
357235288Sadrian	int i;
358235288Sadrian
359235288Sadrian	callout_drain(&sc->callout_tick);
360235288Sadrian
361235288Sadrian	for (i=0; i < sc->numphys; i++) {
362235288Sadrian		if (sc->miibus[i] != NULL)
363235288Sadrian			device_delete_child(dev, sc->miibus[i]);
364235288Sadrian		if (sc->ifp[i] != NULL)
365235288Sadrian			if_free(sc->ifp[i]);
366235288Sadrian		free(sc->ifname[i], M_DEVBUF);
367235288Sadrian	}
368235288Sadrian
369235288Sadrian	bus_generic_detach(dev);
370235288Sadrian	mtx_destroy(&sc->sc_mtx);
371235288Sadrian
372235288Sadrian	return (0);
373235288Sadrian}
374235288Sadrian
375235288Sadrian/*
376235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to
377235288Sadrian * port 2, etc.
378235288Sadrian */
379235288Sadrianstatic inline int
380235288Sadrianarswitch_portforphy(int phy)
381235288Sadrian{
382235288Sadrian	return (phy+1);
383235288Sadrian}
384235288Sadrian
385235288Sadrianstatic inline struct mii_data *
386235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port)
387235288Sadrian{
388235288Sadrian	int phy = port-1;
389235288Sadrian
390235288Sadrian	if (phy < 0 || phy >= sc->numphys)
391235288Sadrian		return (NULL);
392235288Sadrian	return (device_get_softc(sc->miibus[phy]));
393235288Sadrian}
394235288Sadrian
395235288Sadrianstatic inline struct ifnet *
396235288Sadrianarswitch_ifpforport(struct arswitch_softc *sc, int port)
397235288Sadrian{
398235288Sadrian	int phy = port-1;
399235288Sadrian
400235288Sadrian	if (phy < 0 || phy >= sc->numphys)
401235288Sadrian		return (NULL);
402235288Sadrian	return (sc->ifp[phy]);
403235288Sadrian}
404235288Sadrian
405235288Sadrian/*
406235288Sadrian * Convert port status to ifmedia.
407235288Sadrian */
408235288Sadrianstatic void
409235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active)
410235288Sadrian{
411235288Sadrian	*media_active = IFM_ETHER;
412235288Sadrian	*media_status = IFM_AVALID;
413235288Sadrian
414235288Sadrian	if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0)
415235288Sadrian		*media_status |= IFM_ACTIVE;
416235288Sadrian	else {
417235288Sadrian		*media_active |= IFM_NONE;
418235288Sadrian		return;
419235288Sadrian	}
420235288Sadrian	switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) {
421235288Sadrian	case AR8X16_PORT_STS_SPEED_10:
422235288Sadrian		*media_active |= IFM_10_T;
423235288Sadrian		break;
424235288Sadrian	case AR8X16_PORT_STS_SPEED_100:
425235288Sadrian		*media_active |= IFM_100_TX;
426235288Sadrian		break;
427235288Sadrian	case AR8X16_PORT_STS_SPEED_1000:
428235288Sadrian		*media_active |= IFM_1000_T;
429235288Sadrian		break;
430235288Sadrian	}
431235288Sadrian	if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0)
432235288Sadrian		*media_active |= IFM_FDX;
433235288Sadrian	else
434235288Sadrian		*media_active |= IFM_HDX;
435235288Sadrian	if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0)
436235288Sadrian		*media_active |= IFM_ETH_TXPAUSE;
437235288Sadrian	if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0)
438235288Sadrian		*media_active |= IFM_ETH_RXPAUSE;
439235288Sadrian}
440235288Sadrian
441235288Sadrian/*
442235288Sadrian * Poll the status for all PHYs.  We're using the switch port status because
443235288Sadrian * thats a lot quicker to read than talking to all the PHYs.  Care must be
444235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will
445235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs
446235288Sadrian * update function is called.
447235288Sadrian */
448235288Sadrianstatic void
449235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc)
450235288Sadrian{
451235288Sadrian	int i;
452235288Sadrian	struct mii_data *mii;
453235288Sadrian	struct mii_softc *miisc;
454235288Sadrian	int portstatus;
455235288Sadrian
456241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
457241578Sray
458235288Sadrian	for (i = 0; i < sc->numphys; i++) {
459235288Sadrian		if (sc->miibus[i] == NULL)
460235288Sadrian			continue;
461235288Sadrian		mii = device_get_softc(sc->miibus[i]);
462235288Sadrian		portstatus = arswitch_readreg(sc->sc_dev,
463235288Sadrian		    AR8X16_REG_PORT_STS(arswitch_portforphy(i)));
464235288Sadrian#if 0
465235288Sadrian		DPRINTF(sc->sc_dev, "p[%d]=%b\n",
466256582Sadrian		    i,
467235288Sadrian		    portstatus,
468235288Sadrian		    "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7"
469235288Sadrian		    "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE");
470235288Sadrian#endif
471235288Sadrian		arswitch_update_ifmedia(portstatus, &mii->mii_media_status,
472235288Sadrian		    &mii->mii_media_active);
473235288Sadrian		LIST_FOREACH(miisc, &mii->mii_phys, mii_list) {
474235288Sadrian			if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) !=
475235288Sadrian			    miisc->mii_inst)
476235288Sadrian				continue;
477235288Sadrian			mii_phy_update(miisc, MII_POLLSTAT);
478235288Sadrian		}
479235288Sadrian	}
480235288Sadrian}
481235288Sadrian
482235288Sadrianstatic void
483235288Sadrianarswitch_tick(void *arg)
484235288Sadrian{
485235288Sadrian	struct arswitch_softc *sc = arg;
486235288Sadrian
487235288Sadrian	arswitch_miipollstat(sc);
488235288Sadrian	callout_reset(&sc->callout_tick, hz, arswitch_tick, sc);
489235288Sadrian}
490235288Sadrian
491241578Sraystatic void
492241578Srayarswitch_lock(device_t dev)
493241578Sray{
494241578Sray	struct arswitch_softc *sc = device_get_softc(dev);
495241578Sray
496241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED);
497241578Sray	ARSWITCH_LOCK(sc);
498241578Sray}
499241578Sray
500241578Sraystatic void
501241578Srayarswitch_unlock(device_t dev)
502241578Sray{
503241578Sray	struct arswitch_softc *sc = device_get_softc(dev);
504241578Sray
505241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
506241578Sray	ARSWITCH_UNLOCK(sc);
507241578Sray}
508241578Sray
509235288Sadrianstatic etherswitch_info_t *
510235288Sadrianarswitch_getinfo(device_t dev)
511235288Sadrian{
512235288Sadrian	struct arswitch_softc *sc = device_get_softc(dev);
513235288Sadrian
514235288Sadrian	return (&sc->info);
515235288Sadrian}
516235288Sadrian
517235288Sadrianstatic int
518235288Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p)
519235288Sadrian{
520253572Sloos	struct arswitch_softc *sc;
521253572Sloos	struct ifmediareq *ifmr;
522235288Sadrian	struct mii_data *mii;
523253572Sloos	uint32_t reg;
524235288Sadrian	int err;
525253572Sloos
526253572Sloos	sc = device_get_softc(dev);
527253572Sloos	if (p->es_port < 0 || p->es_port > sc->numphys)
528235288Sadrian		return (ENXIO);
529235288Sadrian
530253572Sloos	ARSWITCH_LOCK(sc);
531253572Sloos
532253572Sloos	/* Retrieve the PVID. */
533253572Sloos	arswitch_get_pvid(sc, p->es_port, &p->es_pvid);
534253572Sloos
535253572Sloos	/* Port flags. */
536253572Sloos	reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port));
537253572Sloos	if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG)
538253572Sloos		p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG;
539253572Sloos	reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
540253572Sloos	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD)
541253572Sloos		p->es_flags |= ETHERSWITCH_PORT_ADDTAG;
542253572Sloos	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP)
543253572Sloos		p->es_flags |= ETHERSWITCH_PORT_STRIPTAG;
544253572Sloos	ARSWITCH_UNLOCK(sc);
545253572Sloos
546235288Sadrian	mii = arswitch_miiforport(sc, p->es_port);
547235288Sadrian	if (p->es_port == 0) {
548235288Sadrian		/* fill in fixed values for CPU port */
549250383Sadrian		p->es_flags |= ETHERSWITCH_PORT_CPU;
550253572Sloos		ifmr = &p->es_ifmr;
551235288Sadrian		ifmr->ifm_count = 0;
552235288Sadrian		ifmr->ifm_current = ifmr->ifm_active =
553235288Sadrian		    IFM_ETHER | IFM_1000_T | IFM_FDX;
554235288Sadrian		ifmr->ifm_mask = 0;
555235288Sadrian		ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID;
556235288Sadrian	} else if (mii != NULL) {
557235288Sadrian		err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr,
558235288Sadrian		    &mii->mii_media, SIOCGIFMEDIA);
559235288Sadrian		if (err)
560235288Sadrian			return (err);
561235288Sadrian	} else {
562235288Sadrian		return (ENXIO);
563235288Sadrian	}
564235288Sadrian	return (0);
565235288Sadrian}
566235288Sadrian
567235288Sadrianstatic int
568235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p)
569235288Sadrian{
570235288Sadrian	int err;
571253572Sloos	uint32_t reg;
572235288Sadrian	struct arswitch_softc *sc;
573235288Sadrian	struct ifmedia *ifm;
574235288Sadrian	struct mii_data *mii;
575235288Sadrian	struct ifnet *ifp;
576235288Sadrian
577253572Sloos	sc = device_get_softc(dev);
578253572Sloos	if (p->es_port < 0 || p->es_port > sc->numphys)
579235288Sadrian		return (ENXIO);
580235288Sadrian
581253572Sloos	/* Port flags. */
582253572Sloos	if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) {
583235288Sadrian
584253572Sloos		ARSWITCH_LOCK(sc);
585253572Sloos		/* Set the PVID. */
586253572Sloos		if (p->es_pvid != 0)
587253572Sloos			arswitch_set_pvid(sc, p->es_port, p->es_pvid);
588235288Sadrian
589253572Sloos		/* Mutually exclusive. */
590253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG &&
591253572Sloos		    p->es_flags & ETHERSWITCH_PORT_STRIPTAG) {
592253572Sloos			ARSWITCH_UNLOCK(sc);
593253572Sloos			return (EINVAL);
594253572Sloos		}
595253572Sloos
596253572Sloos		reg = 0;
597253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG)
598253572Sloos			reg |= AR8X16_PORT_CTRL_DOUBLE_TAG;
599253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG)
600253572Sloos			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD <<
601253572Sloos			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
602253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG)
603253572Sloos			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP <<
604253572Sloos			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
605253572Sloos
606253572Sloos		err = arswitch_modifyreg(sc->sc_dev,
607253572Sloos		    AR8X16_REG_PORT_CTRL(p->es_port),
608253572Sloos		    0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT |
609253572Sloos		    AR8X16_PORT_CTRL_DOUBLE_TAG, reg);
610253572Sloos
611253572Sloos		ARSWITCH_UNLOCK(sc);
612253572Sloos		if (err)
613253572Sloos			return (err);
614253572Sloos        }
615253572Sloos
616253572Sloos	/* Do not allow media changes on CPU port. */
617253572Sloos	if (p->es_port == AR8X16_PORT_CPU)
618253572Sloos		return (0);
619253572Sloos
620235288Sadrian	mii = arswitch_miiforport(sc, p->es_port);
621235288Sadrian	if (mii == NULL)
622235288Sadrian		return (ENXIO);
623235288Sadrian
624235288Sadrian	ifp = arswitch_ifpforport(sc, p->es_port);
625235288Sadrian
626235288Sadrian	ifm = &mii->mii_media;
627253572Sloos	return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA));
628235288Sadrian}
629235288Sadrian
630235288Sadrianstatic void
631235288Sadrianarswitch_statchg(device_t dev)
632235288Sadrian{
633235288Sadrian
634235288Sadrian	DPRINTF(dev, "%s\n", __func__);
635235288Sadrian}
636235288Sadrian
637235288Sadrianstatic int
638235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp)
639235288Sadrian{
640235288Sadrian	struct arswitch_softc *sc = ifp->if_softc;
641235288Sadrian	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
642235288Sadrian
643235288Sadrian	if (mii == NULL)
644235288Sadrian		return (ENXIO);
645235288Sadrian	mii_mediachg(mii);
646235288Sadrian	return (0);
647235288Sadrian}
648235288Sadrian
649235288Sadrianstatic void
650235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
651235288Sadrian{
652235288Sadrian	struct arswitch_softc *sc = ifp->if_softc;
653235288Sadrian	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
654235288Sadrian
655235288Sadrian	DPRINTF(sc->sc_dev, "%s\n", __func__);
656235288Sadrian
657235288Sadrian	if (mii == NULL)
658235288Sadrian		return;
659235288Sadrian	mii_pollstat(mii);
660235288Sadrian	ifmr->ifm_active = mii->mii_media_active;
661235288Sadrian	ifmr->ifm_status = mii->mii_media_status;
662235288Sadrian}
663235288Sadrian
664253572Sloosstatic int
665253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf)
666253572Sloos{
667253572Sloos	struct arswitch_softc *sc;
668253572Sloos
669253572Sloos	sc = device_get_softc(dev);
670253572Sloos
671253572Sloos	/* Return the VLAN mode. */
672253572Sloos	conf->cmd = ETHERSWITCH_CONF_VLAN_MODE;
673253572Sloos	conf->vlan_mode = sc->vlan_mode;
674253572Sloos
675253572Sloos	return (0);
676253572Sloos}
677253572Sloos
678253572Sloosstatic int
679253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf)
680253572Sloos{
681253572Sloos	struct arswitch_softc *sc;
682253572Sloos	int err;
683253572Sloos
684253572Sloos	sc = device_get_softc(dev);
685253572Sloos
686253572Sloos	/* Set the VLAN mode. */
687253572Sloos	if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) {
688253572Sloos		err = arswitch_set_vlan_mode(sc, conf->vlan_mode);
689253572Sloos		if (err != 0)
690253572Sloos			return (err);
691253572Sloos	}
692253572Sloos
693253572Sloos	return (0);
694253572Sloos}
695253572Sloos
696235288Sadrianstatic device_method_t arswitch_methods[] = {
697235288Sadrian	/* Device interface */
698235288Sadrian	DEVMETHOD(device_probe,		arswitch_probe),
699235288Sadrian	DEVMETHOD(device_attach,	arswitch_attach),
700235288Sadrian	DEVMETHOD(device_detach,	arswitch_detach),
701235288Sadrian
702235288Sadrian	/* bus interface */
703235288Sadrian	DEVMETHOD(bus_add_child,	device_add_child_ordered),
704235288Sadrian
705235288Sadrian	/* MII interface */
706235288Sadrian	DEVMETHOD(miibus_readreg,	arswitch_readphy),
707235288Sadrian	DEVMETHOD(miibus_writereg,	arswitch_writephy),
708235288Sadrian	DEVMETHOD(miibus_statchg,	arswitch_statchg),
709235288Sadrian
710235288Sadrian	/* MDIO interface */
711235288Sadrian	DEVMETHOD(mdio_readreg,		arswitch_readphy),
712235288Sadrian	DEVMETHOD(mdio_writereg,	arswitch_writephy),
713235288Sadrian
714235288Sadrian	/* etherswitch interface */
715241578Sray	DEVMETHOD(etherswitch_lock,	arswitch_lock),
716241578Sray	DEVMETHOD(etherswitch_unlock,	arswitch_unlock),
717235288Sadrian	DEVMETHOD(etherswitch_getinfo,	arswitch_getinfo),
718235288Sadrian	DEVMETHOD(etherswitch_readreg,	arswitch_readreg),
719235288Sadrian	DEVMETHOD(etherswitch_writereg,	arswitch_writereg),
720235288Sadrian	DEVMETHOD(etherswitch_readphyreg,	arswitch_readphy),
721235288Sadrian	DEVMETHOD(etherswitch_writephyreg,	arswitch_writephy),
722235288Sadrian	DEVMETHOD(etherswitch_getport,	arswitch_getport),
723235288Sadrian	DEVMETHOD(etherswitch_setport,	arswitch_setport),
724235288Sadrian	DEVMETHOD(etherswitch_getvgroup,	arswitch_getvgroup),
725235288Sadrian	DEVMETHOD(etherswitch_setvgroup,	arswitch_setvgroup),
726253572Sloos	DEVMETHOD(etherswitch_getconf,	arswitch_getconf),
727253572Sloos	DEVMETHOD(etherswitch_setconf,	arswitch_setconf),
728235288Sadrian
729235288Sadrian	DEVMETHOD_END
730235288Sadrian};
731235288Sadrian
732235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods,
733235288Sadrian    sizeof(struct arswitch_softc));
734235288Sadrianstatic devclass_t arswitch_devclass;
735235288Sadrian
736235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0);
737235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0);
738235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0);
739235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0);
740235288SadrianMODULE_VERSION(arswitch, 1);
741235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */
742235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */
743