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