xref: /freebsd/sys/dev/etherswitch/arswitch/arswitch.c (revision dd843f87d3d53b558884a311fb01d6df51b43cd0)
1a043e8c7SAdrian Chadd /*-
2a043e8c7SAdrian Chadd  * Copyright (c) 2011-2012 Stefan Bethke.
3a043e8c7SAdrian Chadd  * Copyright (c) 2012 Adrian Chadd.
4a043e8c7SAdrian Chadd  * All rights reserved.
5a043e8c7SAdrian Chadd  *
6a043e8c7SAdrian Chadd  * Redistribution and use in source and binary forms, with or without
7a043e8c7SAdrian Chadd  * modification, are permitted provided that the following conditions
8a043e8c7SAdrian Chadd  * are met:
9a043e8c7SAdrian Chadd  * 1. Redistributions of source code must retain the above copyright
10a043e8c7SAdrian Chadd  *    notice, this list of conditions and the following disclaimer.
11a043e8c7SAdrian Chadd  * 2. Redistributions in binary form must reproduce the above copyright
12a043e8c7SAdrian Chadd  *    notice, this list of conditions and the following disclaimer in the
13a043e8c7SAdrian Chadd  *    documentation and/or other materials provided with the distribution.
14a043e8c7SAdrian Chadd  *
15a043e8c7SAdrian Chadd  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16a043e8c7SAdrian Chadd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17a043e8c7SAdrian Chadd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18a043e8c7SAdrian Chadd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19a043e8c7SAdrian Chadd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20a043e8c7SAdrian Chadd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21a043e8c7SAdrian Chadd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22a043e8c7SAdrian Chadd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23a043e8c7SAdrian Chadd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24a043e8c7SAdrian Chadd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25a043e8c7SAdrian Chadd  * SUCH DAMAGE.
26a043e8c7SAdrian Chadd  *
27a043e8c7SAdrian Chadd  * $FreeBSD$
28a043e8c7SAdrian Chadd  */
29a043e8c7SAdrian Chadd 
30a043e8c7SAdrian Chadd #include <sys/param.h>
31a043e8c7SAdrian Chadd #include <sys/bus.h>
32a043e8c7SAdrian Chadd #include <sys/errno.h>
33a043e8c7SAdrian Chadd #include <sys/kernel.h>
34104dc214SGleb Smirnoff #include <sys/malloc.h>
35a043e8c7SAdrian Chadd #include <sys/module.h>
36a043e8c7SAdrian Chadd #include <sys/socket.h>
37a043e8c7SAdrian Chadd #include <sys/sockio.h>
38a043e8c7SAdrian Chadd #include <sys/sysctl.h>
39a043e8c7SAdrian Chadd #include <sys/systm.h>
40a043e8c7SAdrian Chadd 
41a043e8c7SAdrian Chadd #include <net/if.h>
42104dc214SGleb Smirnoff #include <net/if_var.h>
43a043e8c7SAdrian Chadd #include <net/if_arp.h>
44a043e8c7SAdrian Chadd #include <net/ethernet.h>
45a043e8c7SAdrian Chadd #include <net/if_dl.h>
46a043e8c7SAdrian Chadd #include <net/if_media.h>
47a043e8c7SAdrian Chadd #include <net/if_types.h>
48a043e8c7SAdrian Chadd 
49a043e8c7SAdrian Chadd #include <machine/bus.h>
50a043e8c7SAdrian Chadd #include <dev/iicbus/iic.h>
51a043e8c7SAdrian Chadd #include <dev/iicbus/iiconf.h>
52a043e8c7SAdrian Chadd #include <dev/iicbus/iicbus.h>
53a043e8c7SAdrian Chadd #include <dev/mii/mii.h>
54a043e8c7SAdrian Chadd #include <dev/mii/miivar.h>
55a043e8c7SAdrian Chadd #include <dev/etherswitch/mdio.h>
56a043e8c7SAdrian Chadd 
57a043e8c7SAdrian Chadd #include <dev/etherswitch/etherswitch.h>
58a043e8c7SAdrian Chadd 
59a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitchreg.h>
60a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitchvar.h>
61a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_reg.h>
62a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_phy.h>
63b9f07b86SLuiz Otavio O Souza #include <dev/etherswitch/arswitch/arswitch_vlans.h>
64a043e8c7SAdrian Chadd 
6527a2ecaaSAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_7240.h>
66a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_8216.h>
67a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_8226.h>
68a043e8c7SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_8316.h>
69b2152161SAdrian Chadd #include <dev/etherswitch/arswitch/arswitch_9340.h>
70a043e8c7SAdrian Chadd 
71a043e8c7SAdrian Chadd #include "mdio_if.h"
72a043e8c7SAdrian Chadd #include "miibus_if.h"
73a043e8c7SAdrian Chadd #include "etherswitch_if.h"
74a043e8c7SAdrian Chadd 
75a043e8c7SAdrian Chadd #if	defined(DEBUG)
76a043e8c7SAdrian Chadd static SYSCTL_NODE(_debug, OID_AUTO, arswitch, CTLFLAG_RD, 0, "arswitch");
77a043e8c7SAdrian Chadd #endif
78a043e8c7SAdrian Chadd 
79a043e8c7SAdrian Chadd static inline int arswitch_portforphy(int phy);
80a043e8c7SAdrian Chadd static void arswitch_tick(void *arg);
81a043e8c7SAdrian Chadd static int arswitch_ifmedia_upd(struct ifnet *);
82a043e8c7SAdrian Chadd static void arswitch_ifmedia_sts(struct ifnet *, struct ifmediareq *);
83a043e8c7SAdrian Chadd 
84a043e8c7SAdrian Chadd static int
85a043e8c7SAdrian Chadd arswitch_probe(device_t dev)
86a043e8c7SAdrian Chadd {
87a043e8c7SAdrian Chadd 	struct arswitch_softc *sc;
88a043e8c7SAdrian Chadd 	uint32_t id;
89a043e8c7SAdrian Chadd 	char *chipname, desc[256];
90a043e8c7SAdrian Chadd 
91a043e8c7SAdrian Chadd 	sc = device_get_softc(dev);
92a043e8c7SAdrian Chadd 	bzero(sc, sizeof(*sc));
93a043e8c7SAdrian Chadd 	sc->page = -1;
9427a2ecaaSAdrian Chadd 
9527a2ecaaSAdrian Chadd 	/* AR7240 probe */
9627a2ecaaSAdrian Chadd 	if (ar7240_probe(dev) == 0) {
9727a2ecaaSAdrian Chadd 		chipname = "AR7240";
9827a2ecaaSAdrian Chadd 		sc->sc_switchtype = AR8X16_SWITCH_AR7240;
99b2152161SAdrian Chadd 		sc->is_internal_switch = 1;
100b2152161SAdrian Chadd 		id = 0;
101b2152161SAdrian Chadd 		goto done;
102b2152161SAdrian Chadd 	}
103b2152161SAdrian Chadd 
104b2152161SAdrian Chadd 	/* AR9340 probe */
105b2152161SAdrian Chadd 	if (ar9340_probe(dev) == 0) {
106b2152161SAdrian Chadd 		chipname = "AR9340";
107b2152161SAdrian Chadd 		sc->sc_switchtype = AR8X16_SWITCH_AR9340;
108b2152161SAdrian Chadd 		sc->is_internal_switch = 1;
109daa4deacSAleksandr Rybalko 		id = 0;
11027a2ecaaSAdrian Chadd 		goto done;
11127a2ecaaSAdrian Chadd 	}
11227a2ecaaSAdrian Chadd 
11327a2ecaaSAdrian Chadd 	/* AR8xxx probe */
114a043e8c7SAdrian Chadd 	id = arswitch_readreg(dev, AR8X16_REG_MASK_CTRL);
115*dd843f87SAdrian Chadd 	sc->chip_rev = (id & AR8X16_MASK_CTRL_REV_MASK);
116*dd843f87SAdrian Chadd 	sc->chip_ver = (id & AR8X16_MASK_CTRL_VER_MASK) > AR8X16_MASK_CTRL_VER_SHIFT;
117b2152161SAdrian Chadd 	switch (id & (AR8X16_MASK_CTRL_VER_MASK | AR8X16_MASK_CTRL_REV_MASK)) {
118b2152161SAdrian Chadd 	case 0x0101:
119a043e8c7SAdrian Chadd 		chipname = "AR8216";
120a043e8c7SAdrian Chadd 		sc->sc_switchtype = AR8X16_SWITCH_AR8216;
121a043e8c7SAdrian Chadd 		break;
122b2152161SAdrian Chadd 	case 0x0201:
123a043e8c7SAdrian Chadd 		chipname = "AR8226";
124a043e8c7SAdrian Chadd 		sc->sc_switchtype = AR8X16_SWITCH_AR8226;
125a043e8c7SAdrian Chadd 		break;
126b2152161SAdrian Chadd 	/* 0x0301 - AR8236 */
127b2152161SAdrian Chadd 	case 0x1000:
128b2152161SAdrian Chadd 	case 0x1001:
129a043e8c7SAdrian Chadd 		chipname = "AR8316";
130a043e8c7SAdrian Chadd 		sc->sc_switchtype = AR8X16_SWITCH_AR8316;
131a043e8c7SAdrian Chadd 		break;
132a043e8c7SAdrian Chadd 	default:
133a043e8c7SAdrian Chadd 		chipname = NULL;
134a043e8c7SAdrian Chadd 	}
13527a2ecaaSAdrian Chadd 
13627a2ecaaSAdrian Chadd done:
137b2152161SAdrian Chadd 
138b2152161SAdrian Chadd 	DPRINTF(dev, "chipname=%s, id=%08x\n", chipname, id);
139a043e8c7SAdrian Chadd 	if (chipname != NULL) {
140a043e8c7SAdrian Chadd 		snprintf(desc, sizeof(desc),
141a043e8c7SAdrian Chadd 		    "Atheros %s Ethernet Switch",
142a043e8c7SAdrian Chadd 		    chipname);
143a043e8c7SAdrian Chadd 		device_set_desc_copy(dev, desc);
144a043e8c7SAdrian Chadd 		return (BUS_PROBE_DEFAULT);
145a043e8c7SAdrian Chadd 	}
146a043e8c7SAdrian Chadd 	return (ENXIO);
147a043e8c7SAdrian Chadd }
148a043e8c7SAdrian Chadd 
149a043e8c7SAdrian Chadd static int
150a043e8c7SAdrian Chadd arswitch_attach_phys(struct arswitch_softc *sc)
151a043e8c7SAdrian Chadd {
152a043e8c7SAdrian Chadd 	int phy, err = 0;
153a043e8c7SAdrian Chadd 	char name[IFNAMSIZ];
154a043e8c7SAdrian Chadd 
155a043e8c7SAdrian Chadd 	/* PHYs need an interface, so we generate a dummy one */
156a043e8c7SAdrian Chadd 	snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev));
157a043e8c7SAdrian Chadd 	for (phy = 0; phy < sc->numphys; phy++) {
158a043e8c7SAdrian Chadd 		sc->ifp[phy] = if_alloc(IFT_ETHER);
159a043e8c7SAdrian Chadd 		sc->ifp[phy]->if_softc = sc;
160a043e8c7SAdrian Chadd 		sc->ifp[phy]->if_flags |= IFF_UP | IFF_BROADCAST |
161a043e8c7SAdrian Chadd 		    IFF_DRV_RUNNING | IFF_SIMPLEX;
162a043e8c7SAdrian Chadd 		sc->ifname[phy] = malloc(strlen(name)+1, M_DEVBUF, M_WAITOK);
163a043e8c7SAdrian Chadd 		bcopy(name, sc->ifname[phy], strlen(name)+1);
164a043e8c7SAdrian Chadd 		if_initname(sc->ifp[phy], sc->ifname[phy],
165a043e8c7SAdrian Chadd 		    arswitch_portforphy(phy));
166a043e8c7SAdrian Chadd 		err = mii_attach(sc->sc_dev, &sc->miibus[phy], sc->ifp[phy],
167a043e8c7SAdrian Chadd 		    arswitch_ifmedia_upd, arswitch_ifmedia_sts, \
168a043e8c7SAdrian Chadd 		    BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0);
169a043e8c7SAdrian Chadd 		DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n",
170a043e8c7SAdrian Chadd 		    device_get_nameunit(sc->miibus[phy]),
171a043e8c7SAdrian Chadd 		    sc->ifp[phy]->if_xname);
172a043e8c7SAdrian Chadd 		if (err != 0) {
173a043e8c7SAdrian Chadd 			device_printf(sc->sc_dev,
174a043e8c7SAdrian Chadd 			    "attaching PHY %d failed\n",
175a043e8c7SAdrian Chadd 			    phy);
176a043e8c7SAdrian Chadd 		}
177a043e8c7SAdrian Chadd 	}
178a043e8c7SAdrian Chadd 	return (err);
179a043e8c7SAdrian Chadd }
180a043e8c7SAdrian Chadd 
181a043e8c7SAdrian Chadd static int
182b9f07b86SLuiz Otavio O Souza arswitch_reset(device_t dev)
183b9f07b86SLuiz Otavio O Souza {
184b9f07b86SLuiz Otavio O Souza 
185b9f07b86SLuiz Otavio O Souza 	arswitch_writereg(dev, AR8X16_REG_MASK_CTRL,
186b9f07b86SLuiz Otavio O Souza 	    AR8X16_MASK_CTRL_SOFT_RESET);
187b9f07b86SLuiz Otavio O Souza 	DELAY(1000);
188b9f07b86SLuiz Otavio O Souza 	if (arswitch_readreg(dev, AR8X16_REG_MASK_CTRL) &
189b9f07b86SLuiz Otavio O Souza 	    AR8X16_MASK_CTRL_SOFT_RESET) {
190b9f07b86SLuiz Otavio O Souza 		device_printf(dev, "unable to reset switch\n");
191b9f07b86SLuiz Otavio O Souza 		return (-1);
192b9f07b86SLuiz Otavio O Souza 	}
193b9f07b86SLuiz Otavio O Souza 	return (0);
194b9f07b86SLuiz Otavio O Souza }
195b9f07b86SLuiz Otavio O Souza 
196b9f07b86SLuiz Otavio O Souza static int
197b9f07b86SLuiz Otavio O Souza arswitch_set_vlan_mode(struct arswitch_softc *sc, uint32_t mode)
198b9f07b86SLuiz Otavio O Souza {
199b9f07b86SLuiz Otavio O Souza 
200b9f07b86SLuiz Otavio O Souza 	/* Check for invalid modes. */
201b9f07b86SLuiz Otavio O Souza 	if ((mode & sc->info.es_vlan_caps) != mode)
202b9f07b86SLuiz Otavio O Souza 		return (EINVAL);
203b9f07b86SLuiz Otavio O Souza 
204b9f07b86SLuiz Otavio O Souza 	switch (mode) {
205b9f07b86SLuiz Otavio O Souza 	case ETHERSWITCH_VLAN_DOT1Q:
206b9f07b86SLuiz Otavio O Souza 		sc->vlan_mode = ETHERSWITCH_VLAN_DOT1Q;
207b9f07b86SLuiz Otavio O Souza 		break;
208b9f07b86SLuiz Otavio O Souza 	case ETHERSWITCH_VLAN_PORT:
209b9f07b86SLuiz Otavio O Souza 		sc->vlan_mode = ETHERSWITCH_VLAN_PORT;
210b9f07b86SLuiz Otavio O Souza 		break;
211b9f07b86SLuiz Otavio O Souza 	default:
212b9f07b86SLuiz Otavio O Souza 		sc->vlan_mode = 0;
213b9f07b86SLuiz Otavio O Souza 	};
214b9f07b86SLuiz Otavio O Souza 
215b9f07b86SLuiz Otavio O Souza 	/* Reset VLANs. */
216b9f07b86SLuiz Otavio O Souza 	arswitch_reset_vlans(sc);
217b9f07b86SLuiz Otavio O Souza 
218b9f07b86SLuiz Otavio O Souza 	return (0);
219b9f07b86SLuiz Otavio O Souza }
220b9f07b86SLuiz Otavio O Souza 
221b9f07b86SLuiz Otavio O Souza static void
222b9f07b86SLuiz Otavio O Souza arswitch_ports_init(struct arswitch_softc *sc)
223b9f07b86SLuiz Otavio O Souza {
224b9f07b86SLuiz Otavio O Souza 	int port;
225b9f07b86SLuiz Otavio O Souza 
226b9f07b86SLuiz Otavio O Souza 	/* Port0 - CPU */
227b9f07b86SLuiz Otavio O Souza 	arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(0),
228b9f07b86SLuiz Otavio O Souza 	    (AR8X16_IS_SWITCH(sc, AR8216) ?
229b9f07b86SLuiz Otavio O Souza 	    AR8X16_PORT_STS_SPEED_100 : AR8X16_PORT_STS_SPEED_1000) |
230b9f07b86SLuiz Otavio O Souza 	    (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_RXFLOW) |
231b9f07b86SLuiz Otavio O Souza 	    (AR8X16_IS_SWITCH(sc, AR8216) ? 0 : AR8X16_PORT_STS_TXFLOW) |
232b9f07b86SLuiz Otavio O Souza 	    AR8X16_PORT_STS_RXMAC |
233b9f07b86SLuiz Otavio O Souza 	    AR8X16_PORT_STS_TXMAC |
234b9f07b86SLuiz Otavio O Souza 	    AR8X16_PORT_STS_DUPLEX);
235b9f07b86SLuiz Otavio O Souza 	arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0),
236b9f07b86SLuiz Otavio O Souza 	    arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(0)) &
237b9f07b86SLuiz Otavio O Souza 	    ~AR8X16_PORT_CTRL_HEADER);
238b9f07b86SLuiz Otavio O Souza 
239b9f07b86SLuiz Otavio O Souza 	for (port = 1; port <= sc->numphys; port++) {
240b9f07b86SLuiz Otavio O Souza 		/* Set ports to auto negotiation. */
241b9f07b86SLuiz Otavio O Souza 		arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_STS(port),
242b9f07b86SLuiz Otavio O Souza 		    AR8X16_PORT_STS_LINK_AUTO);
243b9f07b86SLuiz Otavio O Souza 		arswitch_writereg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port),
244b9f07b86SLuiz Otavio O Souza 		    arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(port)) &
245b9f07b86SLuiz Otavio O Souza 		    ~AR8X16_PORT_CTRL_HEADER);
246b9f07b86SLuiz Otavio O Souza 	}
247b9f07b86SLuiz Otavio O Souza }
248b9f07b86SLuiz Otavio O Souza 
249b9f07b86SLuiz Otavio O Souza static int
250a043e8c7SAdrian Chadd arswitch_attach(device_t dev)
251a043e8c7SAdrian Chadd {
252a043e8c7SAdrian Chadd 	struct arswitch_softc *sc;
253a043e8c7SAdrian Chadd 	int err = 0;
254a043e8c7SAdrian Chadd 
255a043e8c7SAdrian Chadd 	sc = device_get_softc(dev);
256a043e8c7SAdrian Chadd 
257a043e8c7SAdrian Chadd 	/* sc->sc_switchtype is already decided in arswitch_probe() */
258a043e8c7SAdrian Chadd 	sc->sc_dev = dev;
259a043e8c7SAdrian Chadd 	mtx_init(&sc->sc_mtx, "arswitch", NULL, MTX_DEF);
260a043e8c7SAdrian Chadd 	sc->page = -1;
261a043e8c7SAdrian Chadd 	strlcpy(sc->info.es_name, device_get_desc(dev),
262a043e8c7SAdrian Chadd 	    sizeof(sc->info.es_name));
263a043e8c7SAdrian Chadd 
264a043e8c7SAdrian Chadd 	/*
265a043e8c7SAdrian Chadd 	 * Attach switch related functions
266a043e8c7SAdrian Chadd 	 */
26727a2ecaaSAdrian Chadd 	if (AR8X16_IS_SWITCH(sc, AR7240))
26827a2ecaaSAdrian Chadd 		ar7240_attach(sc);
269b2152161SAdrian Chadd 	else if (AR8X16_IS_SWITCH(sc, AR9340))
270b2152161SAdrian Chadd 		ar9340_attach(sc);
27127a2ecaaSAdrian Chadd 	else if (AR8X16_IS_SWITCH(sc, AR8216))
272a043e8c7SAdrian Chadd 		ar8216_attach(sc);
273a043e8c7SAdrian Chadd 	else if (AR8X16_IS_SWITCH(sc, AR8226))
274a043e8c7SAdrian Chadd 		ar8226_attach(sc);
275a043e8c7SAdrian Chadd 	else if (AR8X16_IS_SWITCH(sc, AR8316))
276a043e8c7SAdrian Chadd 		ar8316_attach(sc);
277a043e8c7SAdrian Chadd 	else
278a043e8c7SAdrian Chadd 		return (ENXIO);
279a043e8c7SAdrian Chadd 
280b9f07b86SLuiz Otavio O Souza 	/* Common defaults. */
281a043e8c7SAdrian Chadd 	sc->info.es_nports = 5; /* XXX technically 6, but 6th not used */
282a043e8c7SAdrian Chadd 
283a043e8c7SAdrian Chadd 	/* XXX Defaults for externally connected AR8316 */
284a043e8c7SAdrian Chadd 	sc->numphys = 4;
285a043e8c7SAdrian Chadd 	sc->phy4cpu = 1;
286a043e8c7SAdrian Chadd 	sc->is_rgmii = 1;
287a043e8c7SAdrian Chadd 	sc->is_gmii = 0;
288b2152161SAdrian Chadd 	sc->is_mii = 0;
289a043e8c7SAdrian Chadd 
290a043e8c7SAdrian Chadd 	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
291a043e8c7SAdrian Chadd 	    "numphys", &sc->numphys);
292a043e8c7SAdrian Chadd 	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
293a043e8c7SAdrian Chadd 	    "phy4cpu", &sc->phy4cpu);
294a043e8c7SAdrian Chadd 	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
295a043e8c7SAdrian Chadd 	    "is_rgmii", &sc->is_rgmii);
296a043e8c7SAdrian Chadd 	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
297a043e8c7SAdrian Chadd 	    "is_gmii", &sc->is_gmii);
298b2152161SAdrian Chadd 	(void) resource_int_value(device_get_name(dev), device_get_unit(dev),
299b2152161SAdrian Chadd 	    "is_mii", &sc->is_mii);
300a043e8c7SAdrian Chadd 
301b9f07b86SLuiz Otavio O Souza 	if (sc->numphys > AR8X16_NUM_PHYS)
302b9f07b86SLuiz Otavio O Souza 		sc->numphys = AR8X16_NUM_PHYS;
303a043e8c7SAdrian Chadd 
304b9f07b86SLuiz Otavio O Souza 	/* Reset the switch. */
305b9f07b86SLuiz Otavio O Souza 	if (arswitch_reset(dev))
306b9f07b86SLuiz Otavio O Souza 		return (ENXIO);
307a043e8c7SAdrian Chadd 
308b2152161SAdrian Chadd 	err = sc->hal.arswitch_hw_setup(sc);
309b2152161SAdrian Chadd 	if (err != 0)
310b2152161SAdrian Chadd 		return (err);
311b2152161SAdrian Chadd 
312a043e8c7SAdrian Chadd 	err = sc->hal.arswitch_hw_global_setup(sc);
313a043e8c7SAdrian Chadd 	if (err != 0)
314a043e8c7SAdrian Chadd 		return (err);
315a043e8c7SAdrian Chadd 
316b9f07b86SLuiz Otavio O Souza 	/* Initialize the switch ports. */
317b9f07b86SLuiz Otavio O Souza 	arswitch_ports_init(sc);
318b9f07b86SLuiz Otavio O Souza 
319a043e8c7SAdrian Chadd 	/*
320a043e8c7SAdrian Chadd 	 * Attach the PHYs and complete the bus enumeration.
321a043e8c7SAdrian Chadd 	 */
322a043e8c7SAdrian Chadd 	err = arswitch_attach_phys(sc);
323a043e8c7SAdrian Chadd 	if (err != 0)
324a043e8c7SAdrian Chadd 		return (err);
325a043e8c7SAdrian Chadd 
326b9f07b86SLuiz Otavio O Souza 	/* Default to ingress filters off. */
327b9f07b86SLuiz Otavio O Souza 	err = arswitch_set_vlan_mode(sc, 0);
328b9f07b86SLuiz Otavio O Souza 	if (err != 0)
329b9f07b86SLuiz Otavio O Souza 		return (err);
330b9f07b86SLuiz Otavio O Souza 
331a043e8c7SAdrian Chadd 	bus_generic_probe(dev);
332a043e8c7SAdrian Chadd 	bus_enumerate_hinted_children(dev);
333a043e8c7SAdrian Chadd 	err = bus_generic_attach(dev);
334a043e8c7SAdrian Chadd 	if (err != 0)
335a043e8c7SAdrian Chadd 		return (err);
336a043e8c7SAdrian Chadd 
337a043e8c7SAdrian Chadd 	callout_init_mtx(&sc->callout_tick, &sc->sc_mtx, 0);
338454d507aSAleksandr Rybalko 
339454d507aSAleksandr Rybalko 	ARSWITCH_LOCK(sc);
340a043e8c7SAdrian Chadd 	arswitch_tick(sc);
341454d507aSAleksandr Rybalko 	ARSWITCH_UNLOCK(sc);
342a043e8c7SAdrian Chadd 
343a043e8c7SAdrian Chadd 	return (err);
344a043e8c7SAdrian Chadd }
345a043e8c7SAdrian Chadd 
346a043e8c7SAdrian Chadd static int
347a043e8c7SAdrian Chadd arswitch_detach(device_t dev)
348a043e8c7SAdrian Chadd {
349a043e8c7SAdrian Chadd 	struct arswitch_softc *sc = device_get_softc(dev);
350a043e8c7SAdrian Chadd 	int i;
351a043e8c7SAdrian Chadd 
352a043e8c7SAdrian Chadd 	callout_drain(&sc->callout_tick);
353a043e8c7SAdrian Chadd 
354a043e8c7SAdrian Chadd 	for (i=0; i < sc->numphys; i++) {
355a043e8c7SAdrian Chadd 		if (sc->miibus[i] != NULL)
356a043e8c7SAdrian Chadd 			device_delete_child(dev, sc->miibus[i]);
357a043e8c7SAdrian Chadd 		if (sc->ifp[i] != NULL)
358a043e8c7SAdrian Chadd 			if_free(sc->ifp[i]);
359a043e8c7SAdrian Chadd 		free(sc->ifname[i], M_DEVBUF);
360a043e8c7SAdrian Chadd 	}
361a043e8c7SAdrian Chadd 
362a043e8c7SAdrian Chadd 	bus_generic_detach(dev);
363a043e8c7SAdrian Chadd 	mtx_destroy(&sc->sc_mtx);
364a043e8c7SAdrian Chadd 
365a043e8c7SAdrian Chadd 	return (0);
366a043e8c7SAdrian Chadd }
367a043e8c7SAdrian Chadd 
368a043e8c7SAdrian Chadd /*
369a043e8c7SAdrian Chadd  * Convert PHY number to port number. PHY0 is connected to port 1, PHY1 to
370a043e8c7SAdrian Chadd  * port 2, etc.
371a043e8c7SAdrian Chadd  */
372a043e8c7SAdrian Chadd static inline int
373a043e8c7SAdrian Chadd arswitch_portforphy(int phy)
374a043e8c7SAdrian Chadd {
375a043e8c7SAdrian Chadd 	return (phy+1);
376a043e8c7SAdrian Chadd }
377a043e8c7SAdrian Chadd 
378a043e8c7SAdrian Chadd static inline struct mii_data *
379a043e8c7SAdrian Chadd arswitch_miiforport(struct arswitch_softc *sc, int port)
380a043e8c7SAdrian Chadd {
381a043e8c7SAdrian Chadd 	int phy = port-1;
382a043e8c7SAdrian Chadd 
383a043e8c7SAdrian Chadd 	if (phy < 0 || phy >= sc->numphys)
384a043e8c7SAdrian Chadd 		return (NULL);
385a043e8c7SAdrian Chadd 	return (device_get_softc(sc->miibus[phy]));
386a043e8c7SAdrian Chadd }
387a043e8c7SAdrian Chadd 
388a043e8c7SAdrian Chadd static inline struct ifnet *
389a043e8c7SAdrian Chadd arswitch_ifpforport(struct arswitch_softc *sc, int port)
390a043e8c7SAdrian Chadd {
391a043e8c7SAdrian Chadd 	int phy = port-1;
392a043e8c7SAdrian Chadd 
393a043e8c7SAdrian Chadd 	if (phy < 0 || phy >= sc->numphys)
394a043e8c7SAdrian Chadd 		return (NULL);
395a043e8c7SAdrian Chadd 	return (sc->ifp[phy]);
396a043e8c7SAdrian Chadd }
397a043e8c7SAdrian Chadd 
398a043e8c7SAdrian Chadd /*
399a043e8c7SAdrian Chadd  * Convert port status to ifmedia.
400a043e8c7SAdrian Chadd  */
401a043e8c7SAdrian Chadd static void
402a043e8c7SAdrian Chadd arswitch_update_ifmedia(int portstatus, u_int *media_status, u_int *media_active)
403a043e8c7SAdrian Chadd {
404a043e8c7SAdrian Chadd 	*media_active = IFM_ETHER;
405a043e8c7SAdrian Chadd 	*media_status = IFM_AVALID;
406a043e8c7SAdrian Chadd 
407a043e8c7SAdrian Chadd 	if ((portstatus & AR8X16_PORT_STS_LINK_UP) != 0)
408a043e8c7SAdrian Chadd 		*media_status |= IFM_ACTIVE;
409a043e8c7SAdrian Chadd 	else {
410a043e8c7SAdrian Chadd 		*media_active |= IFM_NONE;
411a043e8c7SAdrian Chadd 		return;
412a043e8c7SAdrian Chadd 	}
413a043e8c7SAdrian Chadd 	switch (portstatus & AR8X16_PORT_STS_SPEED_MASK) {
414a043e8c7SAdrian Chadd 	case AR8X16_PORT_STS_SPEED_10:
415a043e8c7SAdrian Chadd 		*media_active |= IFM_10_T;
416a043e8c7SAdrian Chadd 		break;
417a043e8c7SAdrian Chadd 	case AR8X16_PORT_STS_SPEED_100:
418a043e8c7SAdrian Chadd 		*media_active |= IFM_100_TX;
419a043e8c7SAdrian Chadd 		break;
420a043e8c7SAdrian Chadd 	case AR8X16_PORT_STS_SPEED_1000:
421a043e8c7SAdrian Chadd 		*media_active |= IFM_1000_T;
422a043e8c7SAdrian Chadd 		break;
423a043e8c7SAdrian Chadd 	}
424a043e8c7SAdrian Chadd 	if ((portstatus & AR8X16_PORT_STS_DUPLEX) == 0)
425a043e8c7SAdrian Chadd 		*media_active |= IFM_FDX;
426a043e8c7SAdrian Chadd 	else
427a043e8c7SAdrian Chadd 		*media_active |= IFM_HDX;
428a043e8c7SAdrian Chadd 	if ((portstatus & AR8X16_PORT_STS_TXFLOW) != 0)
429a043e8c7SAdrian Chadd 		*media_active |= IFM_ETH_TXPAUSE;
430a043e8c7SAdrian Chadd 	if ((portstatus & AR8X16_PORT_STS_RXFLOW) != 0)
431a043e8c7SAdrian Chadd 		*media_active |= IFM_ETH_RXPAUSE;
432a043e8c7SAdrian Chadd }
433a043e8c7SAdrian Chadd 
434a043e8c7SAdrian Chadd /*
435a043e8c7SAdrian Chadd  * Poll the status for all PHYs.  We're using the switch port status because
436a043e8c7SAdrian Chadd  * thats a lot quicker to read than talking to all the PHYs.  Care must be
437a043e8c7SAdrian Chadd  * taken that the resulting ifmedia_active is identical to what the PHY will
438a043e8c7SAdrian Chadd  * compute, or gratuitous link status changes will occur whenever the PHYs
439a043e8c7SAdrian Chadd  * update function is called.
440a043e8c7SAdrian Chadd  */
441a043e8c7SAdrian Chadd static void
442a043e8c7SAdrian Chadd arswitch_miipollstat(struct arswitch_softc *sc)
443a043e8c7SAdrian Chadd {
444a043e8c7SAdrian Chadd 	int i;
445a043e8c7SAdrian Chadd 	struct mii_data *mii;
446a043e8c7SAdrian Chadd 	struct mii_softc *miisc;
447a043e8c7SAdrian Chadd 	int portstatus;
448a043e8c7SAdrian Chadd 
449454d507aSAleksandr Rybalko 	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
450454d507aSAleksandr Rybalko 
451a043e8c7SAdrian Chadd 	for (i = 0; i < sc->numphys; i++) {
452a043e8c7SAdrian Chadd 		if (sc->miibus[i] == NULL)
453a043e8c7SAdrian Chadd 			continue;
454a043e8c7SAdrian Chadd 		mii = device_get_softc(sc->miibus[i]);
455a043e8c7SAdrian Chadd 		portstatus = arswitch_readreg(sc->sc_dev,
456a043e8c7SAdrian Chadd 		    AR8X16_REG_PORT_STS(arswitch_portforphy(i)));
457a043e8c7SAdrian Chadd #if 0
458a043e8c7SAdrian Chadd 		DPRINTF(sc->sc_dev, "p[%d]=%b\n",
459b2152161SAdrian Chadd 		    i,
460a043e8c7SAdrian Chadd 		    portstatus,
461a043e8c7SAdrian Chadd 		    "\20\3TXMAC\4RXMAC\5TXFLOW\6RXFLOW\7"
462a043e8c7SAdrian Chadd 		    "DUPLEX\11LINK_UP\12LINK_AUTO\13LINK_PAUSE");
463a043e8c7SAdrian Chadd #endif
464a043e8c7SAdrian Chadd 		arswitch_update_ifmedia(portstatus, &mii->mii_media_status,
465a043e8c7SAdrian Chadd 		    &mii->mii_media_active);
466a043e8c7SAdrian Chadd 		LIST_FOREACH(miisc, &mii->mii_phys, mii_list) {
467a043e8c7SAdrian Chadd 			if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) !=
468a043e8c7SAdrian Chadd 			    miisc->mii_inst)
469a043e8c7SAdrian Chadd 				continue;
470a043e8c7SAdrian Chadd 			mii_phy_update(miisc, MII_POLLSTAT);
471a043e8c7SAdrian Chadd 		}
472a043e8c7SAdrian Chadd 	}
473a043e8c7SAdrian Chadd }
474a043e8c7SAdrian Chadd 
475a043e8c7SAdrian Chadd static void
476a043e8c7SAdrian Chadd arswitch_tick(void *arg)
477a043e8c7SAdrian Chadd {
478a043e8c7SAdrian Chadd 	struct arswitch_softc *sc = arg;
479a043e8c7SAdrian Chadd 
480a043e8c7SAdrian Chadd 	arswitch_miipollstat(sc);
481a043e8c7SAdrian Chadd 	callout_reset(&sc->callout_tick, hz, arswitch_tick, sc);
482a043e8c7SAdrian Chadd }
483a043e8c7SAdrian Chadd 
484454d507aSAleksandr Rybalko static void
485454d507aSAleksandr Rybalko arswitch_lock(device_t dev)
486454d507aSAleksandr Rybalko {
487454d507aSAleksandr Rybalko 	struct arswitch_softc *sc = device_get_softc(dev);
488454d507aSAleksandr Rybalko 
489454d507aSAleksandr Rybalko 	ARSWITCH_LOCK_ASSERT(sc, MA_NOTOWNED);
490454d507aSAleksandr Rybalko 	ARSWITCH_LOCK(sc);
491454d507aSAleksandr Rybalko }
492454d507aSAleksandr Rybalko 
493454d507aSAleksandr Rybalko static void
494454d507aSAleksandr Rybalko arswitch_unlock(device_t dev)
495454d507aSAleksandr Rybalko {
496454d507aSAleksandr Rybalko 	struct arswitch_softc *sc = device_get_softc(dev);
497454d507aSAleksandr Rybalko 
498454d507aSAleksandr Rybalko 	ARSWITCH_LOCK_ASSERT(sc, MA_OWNED);
499454d507aSAleksandr Rybalko 	ARSWITCH_UNLOCK(sc);
500454d507aSAleksandr Rybalko }
501454d507aSAleksandr Rybalko 
502a043e8c7SAdrian Chadd static etherswitch_info_t *
503a043e8c7SAdrian Chadd arswitch_getinfo(device_t dev)
504a043e8c7SAdrian Chadd {
505a043e8c7SAdrian Chadd 	struct arswitch_softc *sc = device_get_softc(dev);
506a043e8c7SAdrian Chadd 
507a043e8c7SAdrian Chadd 	return (&sc->info);
508a043e8c7SAdrian Chadd }
509a043e8c7SAdrian Chadd 
510a043e8c7SAdrian Chadd static int
511a043e8c7SAdrian Chadd arswitch_getport(device_t dev, etherswitch_port_t *p)
512a043e8c7SAdrian Chadd {
513b9f07b86SLuiz Otavio O Souza 	struct arswitch_softc *sc;
514b9f07b86SLuiz Otavio O Souza 	struct ifmediareq *ifmr;
515a043e8c7SAdrian Chadd 	struct mii_data *mii;
516b9f07b86SLuiz Otavio O Souza 	uint32_t reg;
517a043e8c7SAdrian Chadd 	int err;
518a043e8c7SAdrian Chadd 
519b9f07b86SLuiz Otavio O Souza 	sc = device_get_softc(dev);
520b9f07b86SLuiz Otavio O Souza 	if (p->es_port < 0 || p->es_port > sc->numphys)
521a043e8c7SAdrian Chadd 		return (ENXIO);
522b9f07b86SLuiz Otavio O Souza 
523b9f07b86SLuiz Otavio O Souza 	ARSWITCH_LOCK(sc);
524b9f07b86SLuiz Otavio O Souza 
525b9f07b86SLuiz Otavio O Souza 	/* Retrieve the PVID. */
526b9f07b86SLuiz Otavio O Souza 	arswitch_get_pvid(sc, p->es_port, &p->es_pvid);
527b9f07b86SLuiz Otavio O Souza 
528b9f07b86SLuiz Otavio O Souza 	/* Port flags. */
529b9f07b86SLuiz Otavio O Souza 	reg = arswitch_readreg(sc->sc_dev, AR8X16_REG_PORT_CTRL(p->es_port));
530b9f07b86SLuiz Otavio O Souza 	if (reg & AR8X16_PORT_CTRL_DOUBLE_TAG)
531b9f07b86SLuiz Otavio O Souza 		p->es_flags |= ETHERSWITCH_PORT_DOUBLE_TAG;
532b9f07b86SLuiz Otavio O Souza 	reg >>= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
533b9f07b86SLuiz Otavio O Souza 	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD)
534b9f07b86SLuiz Otavio O Souza 		p->es_flags |= ETHERSWITCH_PORT_ADDTAG;
535b9f07b86SLuiz Otavio O Souza 	if ((reg & 0x3) == AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP)
536b9f07b86SLuiz Otavio O Souza 		p->es_flags |= ETHERSWITCH_PORT_STRIPTAG;
537b9f07b86SLuiz Otavio O Souza 	ARSWITCH_UNLOCK(sc);
538a043e8c7SAdrian Chadd 
539a043e8c7SAdrian Chadd 	mii = arswitch_miiforport(sc, p->es_port);
540a043e8c7SAdrian Chadd 	if (p->es_port == 0) {
541a043e8c7SAdrian Chadd 		/* fill in fixed values for CPU port */
542f47857dcSAdrian Chadd 		p->es_flags |= ETHERSWITCH_PORT_CPU;
543b9f07b86SLuiz Otavio O Souza 		ifmr = &p->es_ifmr;
544a043e8c7SAdrian Chadd 		ifmr->ifm_count = 0;
545a043e8c7SAdrian Chadd 		ifmr->ifm_current = ifmr->ifm_active =
546a043e8c7SAdrian Chadd 		    IFM_ETHER | IFM_1000_T | IFM_FDX;
547a043e8c7SAdrian Chadd 		ifmr->ifm_mask = 0;
548a043e8c7SAdrian Chadd 		ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID;
549a043e8c7SAdrian Chadd 	} else if (mii != NULL) {
550a043e8c7SAdrian Chadd 		err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr,
551a043e8c7SAdrian Chadd 		    &mii->mii_media, SIOCGIFMEDIA);
552a043e8c7SAdrian Chadd 		if (err)
553a043e8c7SAdrian Chadd 			return (err);
554a043e8c7SAdrian Chadd 	} else {
555a043e8c7SAdrian Chadd 		return (ENXIO);
556a043e8c7SAdrian Chadd 	}
557a043e8c7SAdrian Chadd 	return (0);
558a043e8c7SAdrian Chadd }
559a043e8c7SAdrian Chadd 
560a043e8c7SAdrian Chadd static int
561a043e8c7SAdrian Chadd arswitch_setport(device_t dev, etherswitch_port_t *p)
562a043e8c7SAdrian Chadd {
563a043e8c7SAdrian Chadd 	int err;
564b9f07b86SLuiz Otavio O Souza 	uint32_t reg;
565a043e8c7SAdrian Chadd 	struct arswitch_softc *sc;
566a043e8c7SAdrian Chadd 	struct ifmedia *ifm;
567a043e8c7SAdrian Chadd 	struct mii_data *mii;
568a043e8c7SAdrian Chadd 	struct ifnet *ifp;
569a043e8c7SAdrian Chadd 
570b9f07b86SLuiz Otavio O Souza 	sc = device_get_softc(dev);
571b9f07b86SLuiz Otavio O Souza 	if (p->es_port < 0 || p->es_port > sc->numphys)
572a043e8c7SAdrian Chadd 		return (ENXIO);
573a043e8c7SAdrian Chadd 
574b9f07b86SLuiz Otavio O Souza 	/* Port flags. */
575b9f07b86SLuiz Otavio O Souza 	if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) {
576a043e8c7SAdrian Chadd 
577b9f07b86SLuiz Otavio O Souza 		ARSWITCH_LOCK(sc);
578b9f07b86SLuiz Otavio O Souza 		/* Set the PVID. */
579b9f07b86SLuiz Otavio O Souza 		if (p->es_pvid != 0)
580b9f07b86SLuiz Otavio O Souza 			arswitch_set_pvid(sc, p->es_port, p->es_pvid);
581b9f07b86SLuiz Otavio O Souza 
582b9f07b86SLuiz Otavio O Souza 		/* Mutually exclusive. */
583b9f07b86SLuiz Otavio O Souza 		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG &&
584b9f07b86SLuiz Otavio O Souza 		    p->es_flags & ETHERSWITCH_PORT_STRIPTAG) {
585b9f07b86SLuiz Otavio O Souza 			ARSWITCH_UNLOCK(sc);
586b9f07b86SLuiz Otavio O Souza 			return (EINVAL);
587b9f07b86SLuiz Otavio O Souza 		}
588b9f07b86SLuiz Otavio O Souza 
589b9f07b86SLuiz Otavio O Souza 		reg = 0;
590b9f07b86SLuiz Otavio O Souza 		if (p->es_flags & ETHERSWITCH_PORT_DOUBLE_TAG)
591b9f07b86SLuiz Otavio O Souza 			reg |= AR8X16_PORT_CTRL_DOUBLE_TAG;
592b9f07b86SLuiz Otavio O Souza 		if (p->es_flags & ETHERSWITCH_PORT_ADDTAG)
593b9f07b86SLuiz Otavio O Souza 			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_ADD <<
594b9f07b86SLuiz Otavio O Souza 			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
595b9f07b86SLuiz Otavio O Souza 		if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG)
596b9f07b86SLuiz Otavio O Souza 			reg |= AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_STRIP <<
597b9f07b86SLuiz Otavio O Souza 			    AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT;
598b9f07b86SLuiz Otavio O Souza 
599b9f07b86SLuiz Otavio O Souza 		err = arswitch_modifyreg(sc->sc_dev,
600b9f07b86SLuiz Otavio O Souza 		    AR8X16_REG_PORT_CTRL(p->es_port),
601b9f07b86SLuiz Otavio O Souza 		    0x3 << AR8X16_PORT_CTRL_EGRESS_VLAN_MODE_SHIFT |
602b9f07b86SLuiz Otavio O Souza 		    AR8X16_PORT_CTRL_DOUBLE_TAG, reg);
603b9f07b86SLuiz Otavio O Souza 
604b9f07b86SLuiz Otavio O Souza 		ARSWITCH_UNLOCK(sc);
605b9f07b86SLuiz Otavio O Souza 		if (err)
606b9f07b86SLuiz Otavio O Souza 			return (err);
607b9f07b86SLuiz Otavio O Souza         }
608b9f07b86SLuiz Otavio O Souza 
609b9f07b86SLuiz Otavio O Souza 	/* Do not allow media changes on CPU port. */
610b9f07b86SLuiz Otavio O Souza 	if (p->es_port == AR8X16_PORT_CPU)
611b9f07b86SLuiz Otavio O Souza 		return (0);
612a043e8c7SAdrian Chadd 
613a043e8c7SAdrian Chadd 	mii = arswitch_miiforport(sc, p->es_port);
614a043e8c7SAdrian Chadd 	if (mii == NULL)
615a043e8c7SAdrian Chadd 		return (ENXIO);
616a043e8c7SAdrian Chadd 
617a043e8c7SAdrian Chadd 	ifp = arswitch_ifpforport(sc, p->es_port);
618a043e8c7SAdrian Chadd 
619a043e8c7SAdrian Chadd 	ifm = &mii->mii_media;
620b9f07b86SLuiz Otavio O Souza 	return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA));
621a043e8c7SAdrian Chadd }
622a043e8c7SAdrian Chadd 
623a043e8c7SAdrian Chadd static void
624a043e8c7SAdrian Chadd arswitch_statchg(device_t dev)
625a043e8c7SAdrian Chadd {
626a043e8c7SAdrian Chadd 
627a043e8c7SAdrian Chadd 	DPRINTF(dev, "%s\n", __func__);
628a043e8c7SAdrian Chadd }
629a043e8c7SAdrian Chadd 
630a043e8c7SAdrian Chadd static int
631a043e8c7SAdrian Chadd arswitch_ifmedia_upd(struct ifnet *ifp)
632a043e8c7SAdrian Chadd {
633a043e8c7SAdrian Chadd 	struct arswitch_softc *sc = ifp->if_softc;
634a043e8c7SAdrian Chadd 	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
635a043e8c7SAdrian Chadd 
636a043e8c7SAdrian Chadd 	if (mii == NULL)
637a043e8c7SAdrian Chadd 		return (ENXIO);
638a043e8c7SAdrian Chadd 	mii_mediachg(mii);
639a043e8c7SAdrian Chadd 	return (0);
640a043e8c7SAdrian Chadd }
641a043e8c7SAdrian Chadd 
642a043e8c7SAdrian Chadd static void
643a043e8c7SAdrian Chadd arswitch_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
644a043e8c7SAdrian Chadd {
645a043e8c7SAdrian Chadd 	struct arswitch_softc *sc = ifp->if_softc;
646a043e8c7SAdrian Chadd 	struct mii_data *mii = arswitch_miiforport(sc, ifp->if_dunit);
647a043e8c7SAdrian Chadd 
648a043e8c7SAdrian Chadd 	DPRINTF(sc->sc_dev, "%s\n", __func__);
649a043e8c7SAdrian Chadd 
650a043e8c7SAdrian Chadd 	if (mii == NULL)
651a043e8c7SAdrian Chadd 		return;
652a043e8c7SAdrian Chadd 	mii_pollstat(mii);
653a043e8c7SAdrian Chadd 	ifmr->ifm_active = mii->mii_media_active;
654a043e8c7SAdrian Chadd 	ifmr->ifm_status = mii->mii_media_status;
655a043e8c7SAdrian Chadd }
656a043e8c7SAdrian Chadd 
657b9f07b86SLuiz Otavio O Souza static int
658b9f07b86SLuiz Otavio O Souza arswitch_getconf(device_t dev, etherswitch_conf_t *conf)
659b9f07b86SLuiz Otavio O Souza {
660b9f07b86SLuiz Otavio O Souza 	struct arswitch_softc *sc;
661b9f07b86SLuiz Otavio O Souza 
662b9f07b86SLuiz Otavio O Souza 	sc = device_get_softc(dev);
663b9f07b86SLuiz Otavio O Souza 
664b9f07b86SLuiz Otavio O Souza 	/* Return the VLAN mode. */
665b9f07b86SLuiz Otavio O Souza 	conf->cmd = ETHERSWITCH_CONF_VLAN_MODE;
666b9f07b86SLuiz Otavio O Souza 	conf->vlan_mode = sc->vlan_mode;
667b9f07b86SLuiz Otavio O Souza 
668b9f07b86SLuiz Otavio O Souza 	return (0);
669b9f07b86SLuiz Otavio O Souza }
670b9f07b86SLuiz Otavio O Souza 
671b9f07b86SLuiz Otavio O Souza static int
672b9f07b86SLuiz Otavio O Souza arswitch_setconf(device_t dev, etherswitch_conf_t *conf)
673b9f07b86SLuiz Otavio O Souza {
674b9f07b86SLuiz Otavio O Souza 	struct arswitch_softc *sc;
675b9f07b86SLuiz Otavio O Souza 	int err;
676b9f07b86SLuiz Otavio O Souza 
677b9f07b86SLuiz Otavio O Souza 	sc = device_get_softc(dev);
678b9f07b86SLuiz Otavio O Souza 
679b9f07b86SLuiz Otavio O Souza 	/* Set the VLAN mode. */
680b9f07b86SLuiz Otavio O Souza 	if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE) {
681b9f07b86SLuiz Otavio O Souza 		err = arswitch_set_vlan_mode(sc, conf->vlan_mode);
682b9f07b86SLuiz Otavio O Souza 		if (err != 0)
683b9f07b86SLuiz Otavio O Souza 			return (err);
684b9f07b86SLuiz Otavio O Souza 	}
685b9f07b86SLuiz Otavio O Souza 
686b9f07b86SLuiz Otavio O Souza 	return (0);
687b9f07b86SLuiz Otavio O Souza }
688b9f07b86SLuiz Otavio O Souza 
689a043e8c7SAdrian Chadd static device_method_t arswitch_methods[] = {
690a043e8c7SAdrian Chadd 	/* Device interface */
691a043e8c7SAdrian Chadd 	DEVMETHOD(device_probe,		arswitch_probe),
692a043e8c7SAdrian Chadd 	DEVMETHOD(device_attach,	arswitch_attach),
693a043e8c7SAdrian Chadd 	DEVMETHOD(device_detach,	arswitch_detach),
694a043e8c7SAdrian Chadd 
695a043e8c7SAdrian Chadd 	/* bus interface */
696a043e8c7SAdrian Chadd 	DEVMETHOD(bus_add_child,	device_add_child_ordered),
697a043e8c7SAdrian Chadd 
698a043e8c7SAdrian Chadd 	/* MII interface */
699a043e8c7SAdrian Chadd 	DEVMETHOD(miibus_readreg,	arswitch_readphy),
700a043e8c7SAdrian Chadd 	DEVMETHOD(miibus_writereg,	arswitch_writephy),
701a043e8c7SAdrian Chadd 	DEVMETHOD(miibus_statchg,	arswitch_statchg),
702a043e8c7SAdrian Chadd 
703a043e8c7SAdrian Chadd 	/* MDIO interface */
704a043e8c7SAdrian Chadd 	DEVMETHOD(mdio_readreg,		arswitch_readphy),
705a043e8c7SAdrian Chadd 	DEVMETHOD(mdio_writereg,	arswitch_writephy),
706a043e8c7SAdrian Chadd 
707a043e8c7SAdrian Chadd 	/* etherswitch interface */
708454d507aSAleksandr Rybalko 	DEVMETHOD(etherswitch_lock,	arswitch_lock),
709454d507aSAleksandr Rybalko 	DEVMETHOD(etherswitch_unlock,	arswitch_unlock),
710a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_getinfo,	arswitch_getinfo),
711a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_readreg,	arswitch_readreg),
712a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_writereg,	arswitch_writereg),
713a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_readphyreg,	arswitch_readphy),
714a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_writephyreg,	arswitch_writephy),
715a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_getport,	arswitch_getport),
716a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_setport,	arswitch_setport),
717a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_getvgroup,	arswitch_getvgroup),
718a043e8c7SAdrian Chadd 	DEVMETHOD(etherswitch_setvgroup,	arswitch_setvgroup),
719b9f07b86SLuiz Otavio O Souza 	DEVMETHOD(etherswitch_getconf,	arswitch_getconf),
720b9f07b86SLuiz Otavio O Souza 	DEVMETHOD(etherswitch_setconf,	arswitch_setconf),
721a043e8c7SAdrian Chadd 
722a043e8c7SAdrian Chadd 	DEVMETHOD_END
723a043e8c7SAdrian Chadd };
724a043e8c7SAdrian Chadd 
725a043e8c7SAdrian Chadd DEFINE_CLASS_0(arswitch, arswitch_driver, arswitch_methods,
726a043e8c7SAdrian Chadd     sizeof(struct arswitch_softc));
727a043e8c7SAdrian Chadd static devclass_t arswitch_devclass;
728a043e8c7SAdrian Chadd 
729a043e8c7SAdrian Chadd DRIVER_MODULE(arswitch, mdio, arswitch_driver, arswitch_devclass, 0, 0);
730a043e8c7SAdrian Chadd DRIVER_MODULE(miibus, arswitch, miibus_driver, miibus_devclass, 0, 0);
731a043e8c7SAdrian Chadd DRIVER_MODULE(mdio, arswitch, mdio_driver, mdio_devclass, 0, 0);
732a043e8c7SAdrian Chadd DRIVER_MODULE(etherswitch, arswitch, etherswitch_driver, etherswitch_devclass, 0, 0);
733a043e8c7SAdrian Chadd MODULE_VERSION(arswitch, 1);
734a043e8c7SAdrian Chadd MODULE_DEPEND(arswitch, miibus, 1, 1, 1); /* XXX which versions? */
735a043e8c7SAdrian Chadd MODULE_DEPEND(arswitch, etherswitch, 1, 1, 1); /* XXX which versions? */
736