arswitch.c revision 262201
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 262201 2014-02-19 04:30:53Z 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;
132235288Sadrian	default:
133235288Sadrian		chipname = NULL;
134235288Sadrian	}
135235323Sadrian
136235323Sadriandone:
137256582Sadrian
138256582Sadrian	DPRINTF(dev, "chipname=%s, id=%08x\n", chipname, id);
139235288Sadrian	if (chipname != NULL) {
140235288Sadrian		snprintf(desc, sizeof(desc),
141235288Sadrian		    "Atheros %s Ethernet Switch",
142235288Sadrian		    chipname);
143235288Sadrian		device_set_desc_copy(dev, desc);
144235288Sadrian		return (BUS_PROBE_DEFAULT);
145235288Sadrian	}
146235288Sadrian	return (ENXIO);
147235288Sadrian}
148235288Sadrian
149235288Sadrianstatic int
150235288Sadrianarswitch_attach_phys(struct arswitch_softc *sc)
151235288Sadrian{
152235288Sadrian	int phy, err = 0;
153235288Sadrian	char name[IFNAMSIZ];
154235288Sadrian
155235288Sadrian	/* PHYs need an interface, so we generate a dummy one */
156235288Sadrian	snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev));
157235288Sadrian	for (phy = 0; phy < sc->numphys; phy++) {
158235288Sadrian		sc->ifp[phy] = if_alloc(IFT_ETHER);
159235288Sadrian		sc->ifp[phy]->if_softc = sc;
160235288Sadrian		sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST |
161235288Sadrian		    IFF_DRV_RUNNING | IFF_SIMPLEX;
162235288Sadrian		sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK);
163235288Sadrian		bcopy(name, sc->ifname[phy], strlen(name)+1);
164235288Sadrian		if_initname(sc->ifp[phy], sc->ifname[phy],
165235288Sadrian		    arswitch_portforphy(phy));
166235288Sadrian		err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy],
167235288Sadrian		    arswitch_ifmedia_upd, arswitch_ifmedia_sts, \
168235288Sadrian		    BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0);
169235288Sadrian		DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n",
170235288Sadrian		    device_get_nameunit(sc->miibus[phy]),
171235288Sadrian		    sc->ifp[phy]->if_xname);
172235288Sadrian		if (err != 0) {
173235288Sadrian			device_printf(sc->sc_dev,
174235288Sadrian			    "attaching PHY %d failed\n",
175235288Sadrian			    phy);
176235288Sadrian		}
177235288Sadrian	}
178235288Sadrian	return (err);
179235288Sadrian}
180235288Sadrian
181235288Sadrianstatic int
182253572Sloosarswitch_reset(device_t dev)
183253572Sloos{
184253572Sloos
185253572Sloos	arswitch_writereg(dev, AR8X16_REG_MASK_CTRL,
186253572Sloos	    AR8X16_MASK_CTRL_SOFT_RESET);
187253572Sloos	DELAY(1000);
188253572Sloos	if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) &
189253572Sloos	    AR8X16_MASK_CTRL_SOFT_RESET) {
190253572Sloos		device_printf(dev, "unable to reset switch\n");
191253572Sloos		return (-1);
192253572Sloos	}
193253572Sloos	return (0);
194253572Sloos}
195253572Sloos
196253572Sloosstatic int
197253572Sloosarswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode)
198253572Sloos{
199253572Sloos
200253572Sloos	/* Check for invalid modes. */
201253572Sloos	if ((mode & sc->info.es_vlan_caps) != mode)
202253572Sloos		return (EINVAL);
203253572Sloos
204253572Sloos	switch (mode) {
205253572Sloos	case ETHERSWITCH_VLAN_DOT1Q:
206253572Sloos		sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q;
207253572Sloos		break;
208253572Sloos	case ETHERSWITCH_VLAN_PORT:
209253572Sloos		sc->vlan_mode = ETHERSWITCH_VLAN_PORT;
210253572Sloos		break;
211253572Sloos	default:
212253572Sloos		sc->vlan_mode = 0;
213253572Sloos	};
214253572Sloos
215253572Sloos	/* Reset VLANs. */
216253572Sloos	arswitch_reset_vlans(sc);
217253572Sloos
218253572Sloos	return (0);
219253572Sloos}
220253572Sloos
221253572Sloosstatic void
222253572Sloosarswitch_ports_init(struct arswitch_softc *sc)
223253572Sloos{
224253572Sloos	int port;
225253572Sloos
226253572Sloos	/* Port0 - CPU */
227253572Sloos	arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0),
228253572Sloos	    (AR8X16_IS_SWITCH(sc, AR8216) ?
229253572Sloos	    AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) |
230253572Sloos	    (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) |
231253572Sloos	    (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) |
232253572Sloos	    AR8X16_PORT_STS_RXMAC |
233253572Sloos	    AR8X16_PORT_STS_TXMAC |
234253572Sloos	    AR8X16_PORT_STS_DUPLEX);
235253572Sloos	arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0),
236253572Sloos	    arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) &
237253572Sloos	    ~AR8X16_PORT_CTRL_HEADER);
238253572Sloos
239253572Sloos	for (port = 1; port <= sc->numphys; port++) {
240253572Sloos		/* Set ports to auto negotiation. */
241253572Sloos		arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port),
242253572Sloos		    AR8X16_PORT_STS_LINK_AUTO);
243253572Sloos		arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port),
244253572Sloos		    arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) &
245253572Sloos		    ~AR8X16_PORT_CTRL_HEADER);
246253572Sloos	}
247253572Sloos}
248253572Sloos
249253572Sloosstatic int
250235288Sadrianarswitch_attach(device_t dev)
251235288Sadrian{
252235288Sadrian	struct arswitch_softc *sc;
253235288Sadrian	int err = 0;
254235288Sadrian
255235288Sadrian	sc = device_get_softc(dev);
256235288Sadrian
257235288Sadrian	/* sc->sc_switchtype is already decided in arswitch_probe() */
258235288Sadrian	sc->sc_dev = dev;
259235288Sadrian	mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF);
260235288Sadrian	sc->page = -1;
261235288Sadrian	strlcpy(sc->info.es_name, device_get_desc(dev),
262235288Sadrian	    sizeof(sc->info.es_name));
263235288Sadrian
264235288Sadrian	/*
265235288Sadrian	 * Attach switch related functions
266235288Sadrian	 */
267235323Sadrian	if (AR8X16_IS_SWITCH(sc, AR7240))
268235323Sadrian		ar7240_attach(sc);
269256582Sadrian	else if (AR8X16_IS_SWITCH(sc, AR9340))
270256582Sadrian		ar9340_attach(sc);
271235323Sadrian	else if (AR8X16_IS_SWITCH(sc, AR8216))
272235288Sadrian		ar8216_attach(sc);
273235288Sadrian	else if (AR8X16_IS_SWITCH(sc, AR8226))
274235288Sadrian		ar8226_attach(sc);
275235288Sadrian	else if (AR8X16_IS_SWITCH(sc, AR8316))
276235288Sadrian		ar8316_attach(sc);
277235288Sadrian	else
278235288Sadrian		return (ENXIO);
279235288Sadrian
280253572Sloos	/* Common defaults. */
281235288Sadrian	sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */
282235288Sadrian
283235288Sadrian	/* XXX Defaults for externally connected AR8316 */
284235288Sadrian	sc->numphys = 4;
285235288Sadrian	sc->phy4cpu = 1;
286235288Sadrian	sc->is_rgmii = 1;
287235288Sadrian	sc->is_gmii = 0;
288256582Sadrian	sc->is_mii = 0;
289235288Sadrian
290235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
291235288Sadrian	    "numphys", &sc->numphys);
292235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
293235288Sadrian	    "phy4cpu", &sc->phy4cpu);
294235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
295235288Sadrian	    "is_rgmii", &sc->is_rgmii);
296235288Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
297235288Sadrian	    "is_gmii", &sc->is_gmii);
298256582Sadrian	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
299256582Sadrian	    "is_mii", &sc->is_mii);
300235288Sadrian
301253572Sloos	if (sc->numphys > AR8X16_NUM_PHYS)
302253572Sloos		sc->numphys = AR8X16_NUM_PHYS;
303253572Sloos
304253572Sloos	/* Reset the switch. */
305253572Sloos	if (arswitch_reset(dev))
306235288Sadrian		return (ENXIO);
307235288Sadrian
308256582Sadrian	err = sc->hal.arswitch_hw_setup(sc);
309256582Sadrian	if (err != 0)
310256582Sadrian		return (err);
311256582Sadrian
312235288Sadrian	err = sc->hal.arswitch_hw_global_setup(sc);
313235288Sadrian	if (err != 0)
314235288Sadrian		return (err);
315235288Sadrian
316253572Sloos	/* Initialize the switch ports. */
317253572Sloos	arswitch_ports_init(sc);
318253572Sloos
319235288Sadrian	/*
320235288Sadrian	 * Attach the PHYs and complete the bus enumeration.
321235288Sadrian	 */
322235288Sadrian	err = arswitch_attach_phys(sc);
323235288Sadrian	if (err != 0)
324235288Sadrian		return (err);
325235288Sadrian
326253572Sloos	/* Default to ingress filters off. */
327253572Sloos	err = arswitch_set_vlan_mode(sc, 0);
328253572Sloos	if (err != 0)
329253572Sloos		return (err);
330253572Sloos
331235288Sadrian	bus_generic_probe(dev);
332235288Sadrian	bus_enumerate_hinted_children(dev);
333235288Sadrian	err = bus_generic_attach(dev);
334235288Sadrian	if (err != 0)
335235288Sadrian		return (err);
336235288Sadrian
337235288Sadrian	callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0);
338241578Sray
339241578Sray	ARSWITCH_LOCK(sc);
340235288Sadrian	arswitch_tick(sc);
341241578Sray	ARSWITCH_UNLOCK(sc);
342235288Sadrian
343235288Sadrian	return (err);
344235288Sadrian}
345235288Sadrian
346235288Sadrianstatic int
347235288Sadrianarswitch_detach(device_t dev)
348235288Sadrian{
349235288Sadrian	struct arswitch_softc *sc = device_get_softc(dev);
350235288Sadrian	int i;
351235288Sadrian
352235288Sadrian	callout_drain(&sc->callout_tick);
353235288Sadrian
354235288Sadrian	for (i=0; i < sc->numphys; i++) {
355235288Sadrian		if (sc->miibus[i] != NULL)
356235288Sadrian			device_delete_child(dev, sc->miibus[i]);
357235288Sadrian		if (sc->ifp[i] != NULL)
358235288Sadrian			if_free(sc->ifp[i]);
359235288Sadrian		free(sc->ifname[i], M_DEVBUF);
360235288Sadrian	}
361235288Sadrian
362235288Sadrian	bus_generic_detach(dev);
363235288Sadrian	mtx_destroy(&sc->sc_mtx);
364235288Sadrian
365235288Sadrian	return (0);
366235288Sadrian}
367235288Sadrian
368235288Sadrian/*
369235288Sadrian * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to
370235288Sadrian * port 2, etc.
371235288Sadrian */
372235288Sadrianstatic inline int
373235288Sadrianarswitch_portforphy(int phy)
374235288Sadrian{
375235288Sadrian	return (phy+1);
376235288Sadrian}
377235288Sadrian
378235288Sadrianstatic inline struct mii_data *
379235288Sadrianarswitch_miiforport(struct arswitch_softc *sc, int port)
380235288Sadrian{
381235288Sadrian	int phy = port-1;
382235288Sadrian
383235288Sadrian	if (phy < 0 || phy >= sc->numphys)
384235288Sadrian		return (NULL);
385235288Sadrian	return (device_get_softc(sc->miibus[phy]));
386235288Sadrian}
387235288Sadrian
388235288Sadrianstatic inline struct ifnet *
389235288Sadrianarswitch_ifpforport(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 (sc->ifp[phy]);
396235288Sadrian}
397235288Sadrian
398235288Sadrian/*
399235288Sadrian * Convert port status to ifmedia.
400235288Sadrian */
401235288Sadrianstatic void
402235288Sadrianarswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active)
403235288Sadrian{
404235288Sadrian	*media_active = IFM_ETHER;
405235288Sadrian	*media_status = IFM_AVALID;
406235288Sadrian
407235288Sadrian	if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0)
408235288Sadrian		*media_status |= IFM_ACTIVE;
409235288Sadrian	else {
410235288Sadrian		*media_active |= IFM_NONE;
411235288Sadrian		return;
412235288Sadrian	}
413235288Sadrian	switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) {
414235288Sadrian	case AR8X16_PORT_STS_SPEED_10:
415235288Sadrian		*media_active |= IFM_10_T;
416235288Sadrian		break;
417235288Sadrian	case AR8X16_PORT_STS_SPEED_100:
418235288Sadrian		*media_active |= IFM_100_TX;
419235288Sadrian		break;
420235288Sadrian	case AR8X16_PORT_STS_SPEED_1000:
421235288Sadrian		*media_active |= IFM_1000_T;
422235288Sadrian		break;
423235288Sadrian	}
424235288Sadrian	if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0)
425235288Sadrian		*media_active |= IFM_FDX;
426235288Sadrian	else
427235288Sadrian		*media_active |= IFM_HDX;
428235288Sadrian	if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0)
429235288Sadrian		*media_active |= IFM_ETH_TXPAUSE;
430235288Sadrian	if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0)
431235288Sadrian		*media_active |= IFM_ETH_RXPAUSE;
432235288Sadrian}
433235288Sadrian
434235288Sadrian/*
435235288Sadrian * Poll the status for all PHYs.  We're using the switch port status because
436235288Sadrian * thats a lot quicker to read than talking to all the PHYs.  Care must be
437235288Sadrian * taken that the resulting ifmedia_active is identical to what the PHY will
438235288Sadrian * compute, or gratuitous link status changes will occur whenever the PHYs
439235288Sadrian * update function is called.
440235288Sadrian */
441235288Sadrianstatic void
442235288Sadrianarswitch_miipollstat(struct arswitch_softc *sc)
443235288Sadrian{
444235288Sadrian	int i;
445235288Sadrian	struct mii_data *mii;
446235288Sadrian	struct mii_softc *miisc;
447235288Sadrian	int portstatus;
448235288Sadrian
449241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
450241578Sray
451235288Sadrian	for (i = 0; i < sc->numphys; i++) {
452235288Sadrian		if (sc->miibus[i] == NULL)
453235288Sadrian			continue;
454235288Sadrian		mii = device_get_softc(sc->miibus[i]);
455235288Sadrian		portstatus = arswitch_readreg(sc->sc_dev,
456235288Sadrian		    AR8X16_REG_PORT_STS(arswitch_portforphy(i)));
457235288Sadrian#if 0
458235288Sadrian		DPRINTF(sc->sc_dev, "p[%d]=%b\n",
459256582Sadrian		    i,
460235288Sadrian		    portstatus,
461235288Sadrian		    "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7"
462235288Sadrian		    "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE");
463235288Sadrian#endif
464235288Sadrian		arswitch_update_ifmedia(portstatus, &mii->mii_media_status,
465235288Sadrian		    &mii->mii_media_active);
466235288Sadrian		LIST_FOREACH(miisc, &mii->mii_phys, mii_list) {
467235288Sadrian			if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) !=
468235288Sadrian			    miisc->mii_inst)
469235288Sadrian				continue;
470235288Sadrian			mii_phy_update(miisc, MII_POLLSTAT);
471235288Sadrian		}
472235288Sadrian	}
473235288Sadrian}
474235288Sadrian
475235288Sadrianstatic void
476235288Sadrianarswitch_tick(void *arg)
477235288Sadrian{
478235288Sadrian	struct arswitch_softc *sc = arg;
479235288Sadrian
480235288Sadrian	arswitch_miipollstat(sc);
481235288Sadrian	callout_reset(&sc->callout_tick, hz, arswitch_tick, sc);
482235288Sadrian}
483235288Sadrian
484241578Sraystatic void
485241578Srayarswitch_lock(device_t dev)
486241578Sray{
487241578Sray	struct arswitch_softc *sc = device_get_softc(dev);
488241578Sray
489241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED);
490241578Sray	ARSWITCH_LOCK(sc);
491241578Sray}
492241578Sray
493241578Sraystatic void
494241578Srayarswitch_unlock(device_t dev)
495241578Sray{
496241578Sray	struct arswitch_softc *sc = device_get_softc(dev);
497241578Sray
498241578Sray	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
499241578Sray	ARSWITCH_UNLOCK(sc);
500241578Sray}
501241578Sray
502235288Sadrianstatic etherswitch_info_t *
503235288Sadrianarswitch_getinfo(device_t dev)
504235288Sadrian{
505235288Sadrian	struct arswitch_softc *sc = device_get_softc(dev);
506235288Sadrian
507235288Sadrian	return (&sc->info);
508235288Sadrian}
509235288Sadrian
510235288Sadrianstatic int
511235288Sadrianarswitch_getport(device_t dev, etherswitch_port_t *p)
512235288Sadrian{
513253572Sloos	struct arswitch_softc *sc;
514253572Sloos	struct ifmediareq *ifmr;
515235288Sadrian	struct mii_data *mii;
516253572Sloos	uint32_t reg;
517235288Sadrian	int err;
518253572Sloos
519253572Sloos	sc = device_get_softc(dev);
520253572Sloos	if (p->es_port < 0 || p->es_port > sc->numphys)
521235288Sadrian		return (ENXIO);
522235288Sadrian
523253572Sloos	ARSWITCH_LOCK(sc);
524253572Sloos
525253572Sloos	/* Retrieve the PVID. */
526253572Sloos	arswitch_get_pvid(sc, p->es_port, &p->es_pvid);
527253572Sloos
528253572Sloos	/* Port flags. */
529253572Sloos	reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port));
530253572Sloos	if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG)
531253572Sloos		p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG;
532253572Sloos	reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
533253572Sloos	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD)
534253572Sloos		p->es_flags |= ETHERSWITCH_PORT_ADDTAG;
535253572Sloos	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP)
536253572Sloos		p->es_flags |= ETHERSWITCH_PORT_STRIPTAG;
537253572Sloos	ARSWITCH_UNLOCK(sc);
538253572Sloos
539235288Sadrian	mii = arswitch_miiforport(sc, p->es_port);
540235288Sadrian	if (p->es_port == 0) {
541235288Sadrian		/* fill in fixed values for CPU port */
542250383Sadrian		p->es_flags |= ETHERSWITCH_PORT_CPU;
543253572Sloos		ifmr = &p->es_ifmr;
544235288Sadrian		ifmr->ifm_count = 0;
545235288Sadrian		ifmr->ifm_current = ifmr->ifm_active =
546235288Sadrian		    IFM_ETHER | IFM_1000_T | IFM_FDX;
547235288Sadrian		ifmr->ifm_mask = 0;
548235288Sadrian		ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID;
549235288Sadrian	} else if (mii != NULL) {
550235288Sadrian		err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr,
551235288Sadrian		    &mii->mii_media, SIOCGIFMEDIA);
552235288Sadrian		if (err)
553235288Sadrian			return (err);
554235288Sadrian	} else {
555235288Sadrian		return (ENXIO);
556235288Sadrian	}
557235288Sadrian	return (0);
558235288Sadrian}
559235288Sadrian
560235288Sadrianstatic int
561235288Sadrianarswitch_setport(device_t dev, etherswitch_port_t *p)
562235288Sadrian{
563235288Sadrian	int err;
564253572Sloos	uint32_t reg;
565235288Sadrian	struct arswitch_softc *sc;
566235288Sadrian	struct ifmedia *ifm;
567235288Sadrian	struct mii_data *mii;
568235288Sadrian	struct ifnet *ifp;
569235288Sadrian
570253572Sloos	sc = device_get_softc(dev);
571253572Sloos	if (p->es_port < 0 || p->es_port > sc->numphys)
572235288Sadrian		return (ENXIO);
573235288Sadrian
574253572Sloos	/* Port flags. */
575253572Sloos	if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) {
576235288Sadrian
577253572Sloos		ARSWITCH_LOCK(sc);
578253572Sloos		/* Set the PVID. */
579253572Sloos		if (p->es_pvid != 0)
580253572Sloos			arswitch_set_pvid(sc, p->es_port, p->es_pvid);
581235288Sadrian
582253572Sloos		/* Mutually exclusive. */
583253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG &&
584253572Sloos		    p->es_flags & ETHERSWITCH_PORT_STRIPTAG) {
585253572Sloos			ARSWITCH_UNLOCK(sc);
586253572Sloos			return (EINVAL);
587253572Sloos		}
588253572Sloos
589253572Sloos		reg = 0;
590253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG)
591253572Sloos			reg |= AR8X16_PORT_CTRL_DOUBLE_TAG;
592253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG)
593253572Sloos			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD <<
594253572Sloos			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
595253572Sloos		if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG)
596253572Sloos			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP <<
597253572Sloos			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
598253572Sloos
599253572Sloos		err = arswitch_modifyreg(sc->sc_dev,
600253572Sloos		    AR8X16_REG_PORT_CTRL(p->es_port),
601253572Sloos		    0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT |
602253572Sloos		    AR8X16_PORT_CTRL_DOUBLE_TAG, reg);
603253572Sloos
604253572Sloos		ARSWITCH_UNLOCK(sc);
605253572Sloos		if (err)
606253572Sloos			return (err);
607253572Sloos        }
608253572Sloos
609253572Sloos	/* Do not allow media changes on CPU port. */
610253572Sloos	if (p->es_port == AR8X16_PORT_CPU)
611253572Sloos		return (0);
612253572Sloos
613235288Sadrian	mii = arswitch_miiforport(sc, p->es_port);
614235288Sadrian	if (mii == NULL)
615235288Sadrian		return (ENXIO);
616235288Sadrian
617235288Sadrian	ifp = arswitch_ifpforport(sc, p->es_port);
618235288Sadrian
619235288Sadrian	ifm = &mii->mii_media;
620253572Sloos	return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA));
621235288Sadrian}
622235288Sadrian
623235288Sadrianstatic void
624235288Sadrianarswitch_statchg(device_t dev)
625235288Sadrian{
626235288Sadrian
627235288Sadrian	DPRINTF(dev, "%s\n", __func__);
628235288Sadrian}
629235288Sadrian
630235288Sadrianstatic int
631235288Sadrianarswitch_ifmedia_upd(struct ifnet *ifp)
632235288Sadrian{
633235288Sadrian	struct arswitch_softc *sc = ifp->if_softc;
634235288Sadrian	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
635235288Sadrian
636235288Sadrian	if (mii == NULL)
637235288Sadrian		return (ENXIO);
638235288Sadrian	mii_mediachg(mii);
639235288Sadrian	return (0);
640235288Sadrian}
641235288Sadrian
642235288Sadrianstatic void
643235288Sadrianarswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
644235288Sadrian{
645235288Sadrian	struct arswitch_softc *sc = ifp->if_softc;
646235288Sadrian	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
647235288Sadrian
648235288Sadrian	DPRINTF(sc->sc_dev, "%s\n", __func__);
649235288Sadrian
650235288Sadrian	if (mii == NULL)
651235288Sadrian		return;
652235288Sadrian	mii_pollstat(mii);
653235288Sadrian	ifmr->ifm_active = mii->mii_media_active;
654235288Sadrian	ifmr->ifm_status = mii->mii_media_status;
655235288Sadrian}
656235288Sadrian
657253572Sloosstatic int
658253572Sloosarswitch_getconf(device_t dev, etherswitch_conf_t *conf)
659253572Sloos{
660253572Sloos	struct arswitch_softc *sc;
661253572Sloos
662253572Sloos	sc = device_get_softc(dev);
663253572Sloos
664253572Sloos	/* Return the VLAN mode. */
665253572Sloos	conf->cmd = ETHERSWITCH_CONF_VLAN_MODE;
666253572Sloos	conf->vlan_mode = sc->vlan_mode;
667253572Sloos
668253572Sloos	return (0);
669253572Sloos}
670253572Sloos
671253572Sloosstatic int
672253572Sloosarswitch_setconf(device_t dev, etherswitch_conf_t *conf)
673253572Sloos{
674253572Sloos	struct arswitch_softc *sc;
675253572Sloos	int err;
676253572Sloos
677253572Sloos	sc = device_get_softc(dev);
678253572Sloos
679253572Sloos	/* Set the VLAN mode. */
680253572Sloos	if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) {
681253572Sloos		err = arswitch_set_vlan_mode(sc, conf->vlan_mode);
682253572Sloos		if (err != 0)
683253572Sloos			return (err);
684253572Sloos	}
685253572Sloos
686253572Sloos	return (0);
687253572Sloos}
688253572Sloos
689235288Sadrianstatic device_method_t arswitch_methods[] = {
690235288Sadrian	/* Device interface */
691235288Sadrian	DEVMETHOD(device_probe,		arswitch_probe),
692235288Sadrian	DEVMETHOD(device_attach,	arswitch_attach),
693235288Sadrian	DEVMETHOD(device_detach,	arswitch_detach),
694235288Sadrian
695235288Sadrian	/* bus interface */
696235288Sadrian	DEVMETHOD(bus_add_child,	device_add_child_ordered),
697235288Sadrian
698235288Sadrian	/* MII interface */
699235288Sadrian	DEVMETHOD(miibus_readreg,	arswitch_readphy),
700235288Sadrian	DEVMETHOD(miibus_writereg,	arswitch_writephy),
701235288Sadrian	DEVMETHOD(miibus_statchg,	arswitch_statchg),
702235288Sadrian
703235288Sadrian	/* MDIO interface */
704235288Sadrian	DEVMETHOD(mdio_readreg,		arswitch_readphy),
705235288Sadrian	DEVMETHOD(mdio_writereg,	arswitch_writephy),
706235288Sadrian
707235288Sadrian	/* etherswitch interface */
708241578Sray	DEVMETHOD(etherswitch_lock,	arswitch_lock),
709241578Sray	DEVMETHOD(etherswitch_unlock,	arswitch_unlock),
710235288Sadrian	DEVMETHOD(etherswitch_getinfo,	arswitch_getinfo),
711235288Sadrian	DEVMETHOD(etherswitch_readreg,	arswitch_readreg),
712235288Sadrian	DEVMETHOD(etherswitch_writereg,	arswitch_writereg),
713235288Sadrian	DEVMETHOD(etherswitch_readphyreg,	arswitch_readphy),
714235288Sadrian	DEVMETHOD(etherswitch_writephyreg,	arswitch_writephy),
715235288Sadrian	DEVMETHOD(etherswitch_getport,	arswitch_getport),
716235288Sadrian	DEVMETHOD(etherswitch_setport,	arswitch_setport),
717235288Sadrian	DEVMETHOD(etherswitch_getvgroup,	arswitch_getvgroup),
718235288Sadrian	DEVMETHOD(etherswitch_setvgroup,	arswitch_setvgroup),
719253572Sloos	DEVMETHOD(etherswitch_getconf,	arswitch_getconf),
720253572Sloos	DEVMETHOD(etherswitch_setconf,	arswitch_setconf),
721235288Sadrian
722235288Sadrian	DEVMETHOD_END
723235288Sadrian};
724235288Sadrian
725235288SadrianDEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods,
726235288Sadrian    sizeof(struct arswitch_softc));
727235288Sadrianstatic devclass_t arswitch_devclass;
728235288Sadrian
729235288SadrianDRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0);
730235288SadrianDRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0);
731235288SadrianDRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0);
732235288SadrianDRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0);
733235288SadrianMODULE_VERSION(arswitch, 1);
734235288SadrianMODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */
735235288SadrianMODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */
736