1248dd603SAdrian Chadd /*-
24d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni *
4248dd603SAdrian Chadd * Copyright (c) 2013 Luiz Otavio O Souza.
5248dd603SAdrian Chadd * Copyright (c) 2011-2012 Stefan Bethke.
6248dd603SAdrian Chadd * Copyright (c) 2012 Adrian Chadd.
7248dd603SAdrian Chadd * All rights reserved.
8248dd603SAdrian Chadd *
9248dd603SAdrian Chadd * Redistribution and use in source and binary forms, with or without
10248dd603SAdrian Chadd * modification, are permitted provided that the following conditions
11248dd603SAdrian Chadd * are met:
12248dd603SAdrian Chadd * 1. Redistributions of source code must retain the above copyright
13248dd603SAdrian Chadd * notice, this list of conditions and the following disclaimer.
14248dd603SAdrian Chadd * 2. Redistributions in binary form must reproduce the above copyright
15248dd603SAdrian Chadd * notice, this list of conditions and the following disclaimer in the
16248dd603SAdrian Chadd * documentation and/or other materials provided with the distribution.
17248dd603SAdrian Chadd *
18248dd603SAdrian Chadd * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19248dd603SAdrian Chadd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20248dd603SAdrian Chadd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21248dd603SAdrian Chadd * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22248dd603SAdrian Chadd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23248dd603SAdrian Chadd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24248dd603SAdrian Chadd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25248dd603SAdrian Chadd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26248dd603SAdrian Chadd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27248dd603SAdrian Chadd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28248dd603SAdrian Chadd * SUCH DAMAGE.
29248dd603SAdrian Chadd */
30248dd603SAdrian Chadd
31a99badc2SAdrian Chadd #include "opt_platform.h"
32a99badc2SAdrian Chadd
33248dd603SAdrian Chadd #include <sys/param.h>
34248dd603SAdrian Chadd #include <sys/bus.h>
35248dd603SAdrian Chadd #include <sys/errno.h>
36248dd603SAdrian Chadd #include <sys/kernel.h>
374170452dSChristian Brueffer #include <sys/lock.h>
384170452dSChristian Brueffer #include <sys/malloc.h>
39248dd603SAdrian Chadd #include <sys/module.h>
404170452dSChristian Brueffer #include <sys/mutex.h>
41248dd603SAdrian Chadd #include <sys/socket.h>
42248dd603SAdrian Chadd #include <sys/sockio.h>
43248dd603SAdrian Chadd #include <sys/sysctl.h>
44248dd603SAdrian Chadd #include <sys/systm.h>
454170452dSChristian Brueffer #include <sys/types.h>
46248dd603SAdrian Chadd
47248dd603SAdrian Chadd #include <net/if.h>
48248dd603SAdrian Chadd #include <net/ethernet.h>
49248dd603SAdrian Chadd #include <net/if_media.h>
50248dd603SAdrian Chadd #include <net/if_types.h>
514170452dSChristian Brueffer #include <net/if_var.h>
52248dd603SAdrian Chadd
53248dd603SAdrian Chadd #include <machine/bus.h>
54248dd603SAdrian Chadd #include <dev/mii/mii.h>
55248dd603SAdrian Chadd #include <dev/mii/miivar.h>
5671e8eac4SAdrian Chadd #include <dev/mdio/mdio.h>
57248dd603SAdrian Chadd
58248dd603SAdrian Chadd #include <dev/etherswitch/etherswitch.h>
59248dd603SAdrian Chadd #include <dev/etherswitch/ip17x/ip17x_phy.h>
60248dd603SAdrian Chadd #include <dev/etherswitch/ip17x/ip17x_reg.h>
61248dd603SAdrian Chadd #include <dev/etherswitch/ip17x/ip17x_var.h>
62248dd603SAdrian Chadd #include <dev/etherswitch/ip17x/ip17x_vlans.h>
63248dd603SAdrian Chadd #include <dev/etherswitch/ip17x/ip175c.h>
64248dd603SAdrian Chadd #include <dev/etherswitch/ip17x/ip175d.h>
65248dd603SAdrian Chadd
66a99badc2SAdrian Chadd #ifdef FDT
67a99badc2SAdrian Chadd #include <dev/fdt/fdt_common.h>
68a99badc2SAdrian Chadd #include <dev/ofw/ofw_bus.h>
69a99badc2SAdrian Chadd #include <dev/ofw/ofw_bus_subr.h>
70a99badc2SAdrian Chadd #endif
71a99badc2SAdrian Chadd
72248dd603SAdrian Chadd #include "mdio_if.h"
73248dd603SAdrian Chadd #include "miibus_if.h"
74248dd603SAdrian Chadd #include "etherswitch_if.h"
75248dd603SAdrian Chadd
76248dd603SAdrian Chadd MALLOC_DECLARE(M_IP17X);
77248dd603SAdrian Chadd MALLOC_DEFINE(M_IP17X, "ip17x", "ip17x data structures");
78248dd603SAdrian Chadd
79248dd603SAdrian Chadd static void ip17x_tick(void *);
802e6a8c1aSJustin Hibbits static int ip17x_ifmedia_upd(if_t);
812e6a8c1aSJustin Hibbits static void ip17x_ifmedia_sts(if_t, struct ifmediareq *);
82248dd603SAdrian Chadd
83a99badc2SAdrian Chadd static void
ip17x_identify(driver_t * driver,device_t parent)84a99badc2SAdrian Chadd ip17x_identify(driver_t *driver, device_t parent)
85a99badc2SAdrian Chadd {
86a99badc2SAdrian Chadd if (device_find_child(parent, "ip17x", -1) == NULL)
87a99badc2SAdrian Chadd BUS_ADD_CHILD(parent, 0, "ip17x", -1);
88a99badc2SAdrian Chadd }
89a99badc2SAdrian Chadd
90248dd603SAdrian Chadd static int
ip17x_probe(device_t dev)91248dd603SAdrian Chadd ip17x_probe(device_t dev)
92248dd603SAdrian Chadd {
93248dd603SAdrian Chadd struct ip17x_softc *sc;
94248dd603SAdrian Chadd uint32_t oui, model, phy_id1, phy_id2;
95a99badc2SAdrian Chadd #ifdef FDT
96a99badc2SAdrian Chadd phandle_t ip17x_node;
97a99badc2SAdrian Chadd pcell_t cell;
98a99badc2SAdrian Chadd
99a99badc2SAdrian Chadd ip17x_node = fdt_find_compatible(OF_finddevice("/"),
100a99badc2SAdrian Chadd "icplus,ip17x", 0);
101a99badc2SAdrian Chadd
102a99badc2SAdrian Chadd if (ip17x_node == 0)
103a99badc2SAdrian Chadd return (ENXIO);
104a99badc2SAdrian Chadd #endif
105248dd603SAdrian Chadd
106248dd603SAdrian Chadd sc = device_get_softc(dev);
107248dd603SAdrian Chadd
108248dd603SAdrian Chadd /* Read ID from PHY 0. */
109248dd603SAdrian Chadd phy_id1 = MDIO_READREG(device_get_parent(dev), 0, MII_PHYIDR1);
110248dd603SAdrian Chadd phy_id2 = MDIO_READREG(device_get_parent(dev), 0, MII_PHYIDR2);
111248dd603SAdrian Chadd
112f0be707dSPedro F. Giffuni oui = MII_OUI(phy_id1, phy_id2);
113248dd603SAdrian Chadd model = MII_MODEL(phy_id2);
114248dd603SAdrian Chadd /* We only care about IC+ devices. */
115248dd603SAdrian Chadd if (oui != IP17X_OUI) {
116248dd603SAdrian Chadd device_printf(dev,
117248dd603SAdrian Chadd "Unsupported IC+ switch. Unknown OUI: %#x\n", oui);
118248dd603SAdrian Chadd return (ENXIO);
119248dd603SAdrian Chadd }
120248dd603SAdrian Chadd
121248dd603SAdrian Chadd switch (model) {
122248dd603SAdrian Chadd case IP17X_IP175A:
123248dd603SAdrian Chadd sc->sc_switchtype = IP17X_SWITCH_IP175A;
124248dd603SAdrian Chadd break;
125248dd603SAdrian Chadd case IP17X_IP175C:
126248dd603SAdrian Chadd sc->sc_switchtype = IP17X_SWITCH_IP175C;
127248dd603SAdrian Chadd break;
128248dd603SAdrian Chadd default:
129248dd603SAdrian Chadd device_printf(dev, "Unsupported IC+ switch model: %#x\n",
130248dd603SAdrian Chadd model);
131248dd603SAdrian Chadd return (ENXIO);
132248dd603SAdrian Chadd }
133248dd603SAdrian Chadd
134248dd603SAdrian Chadd /* IP175D has a specific ID register. */
135248dd603SAdrian Chadd model = MDIO_READREG(device_get_parent(dev), IP175D_ID_PHY,
136248dd603SAdrian Chadd IP175D_ID_REG);
137248dd603SAdrian Chadd if (model == 0x175d)
138248dd603SAdrian Chadd sc->sc_switchtype = IP17X_SWITCH_IP175D;
139248dd603SAdrian Chadd else {
140248dd603SAdrian Chadd /* IP178 has more PHYs. Try it. */
141248dd603SAdrian Chadd model = MDIO_READREG(device_get_parent(dev), 5, MII_PHYIDR1);
142248dd603SAdrian Chadd if (phy_id1 == model)
143248dd603SAdrian Chadd sc->sc_switchtype = IP17X_SWITCH_IP178C;
144248dd603SAdrian Chadd }
145248dd603SAdrian Chadd
146a99badc2SAdrian Chadd sc->miipoll = 1;
147a99badc2SAdrian Chadd #ifdef FDT
148a99badc2SAdrian Chadd if ((OF_getencprop(ip17x_node, "mii-poll",
149a99badc2SAdrian Chadd &cell, sizeof(cell))) > 0)
150a99badc2SAdrian Chadd sc->miipoll = cell ? 1 : 0;
151a99badc2SAdrian Chadd #else
152a99badc2SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev),
153a99badc2SAdrian Chadd "mii-poll", &sc->miipoll);
154a99badc2SAdrian Chadd #endif
155248dd603SAdrian Chadd device_set_desc_copy(dev, "IC+ IP17x switch driver");
156248dd603SAdrian Chadd return (BUS_PROBE_DEFAULT);
157248dd603SAdrian Chadd }
158248dd603SAdrian Chadd
159248dd603SAdrian Chadd static int
ip17x_attach_phys(struct ip17x_softc * sc)160248dd603SAdrian Chadd ip17x_attach_phys(struct ip17x_softc *sc)
161248dd603SAdrian Chadd {
162248dd603SAdrian Chadd int err, phy, port;
163248dd603SAdrian Chadd char name[IFNAMSIZ];
164248dd603SAdrian Chadd
165248dd603SAdrian Chadd port = err = 0;
166248dd603SAdrian Chadd
167248dd603SAdrian Chadd /* PHYs need an interface, so we generate a dummy one */
168248dd603SAdrian Chadd snprintf(name, IFNAMSIZ, "%sport", device_get_nameunit(sc->sc_dev));
169248dd603SAdrian Chadd for (phy = 0; phy < MII_NPHY; phy++) {
170248dd603SAdrian Chadd if (((1 << phy) & sc->phymask) == 0)
171248dd603SAdrian Chadd continue;
172248dd603SAdrian Chadd sc->phyport[phy] = port;
173248dd603SAdrian Chadd sc->portphy[port] = phy;
174248dd603SAdrian Chadd sc->ifp[port] = if_alloc(IFT_ETHER);
1750774131eSMichael Zhilin if (sc->ifp[port] == NULL) {
1760774131eSMichael Zhilin device_printf(sc->sc_dev, "couldn't allocate ifnet structure\n");
1770774131eSMichael Zhilin err = ENOMEM;
1780774131eSMichael Zhilin break;
1790774131eSMichael Zhilin }
1800774131eSMichael Zhilin
1812e6a8c1aSJustin Hibbits if_setsoftc(sc->ifp[port], sc);
1822e6a8c1aSJustin Hibbits if_setflags(sc->ifp[port], IFF_UP | IFF_BROADCAST |
1832e6a8c1aSJustin Hibbits IFF_DRV_RUNNING | IFF_SIMPLEX);
1848237ba8aSLuiz Otavio O Souza if_initname(sc->ifp[port], name, port);
185248dd603SAdrian Chadd sc->miibus[port] = malloc(sizeof(device_t), M_IP17X,
186248dd603SAdrian Chadd M_WAITOK | M_ZERO);
187248dd603SAdrian Chadd err = mii_attach(sc->sc_dev, sc->miibus[port], sc->ifp[port],
188248dd603SAdrian Chadd ip17x_ifmedia_upd, ip17x_ifmedia_sts, \
189248dd603SAdrian Chadd BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY, 0);
190248dd603SAdrian Chadd DPRINTF(sc->sc_dev, "%s attached to pseudo interface %s\n",
191248dd603SAdrian Chadd device_get_nameunit(*sc->miibus[port]),
1922e6a8c1aSJustin Hibbits if_name(sc->ifp[port]));
193248dd603SAdrian Chadd if (err != 0) {
194248dd603SAdrian Chadd device_printf(sc->sc_dev,
195248dd603SAdrian Chadd "attaching PHY %d failed\n",
196248dd603SAdrian Chadd phy);
197248dd603SAdrian Chadd break;
198248dd603SAdrian Chadd }
199248dd603SAdrian Chadd sc->info.es_nports = port + 1;
200248dd603SAdrian Chadd if (++port >= sc->numports)
201248dd603SAdrian Chadd break;
202248dd603SAdrian Chadd }
203248dd603SAdrian Chadd return (err);
204248dd603SAdrian Chadd }
205248dd603SAdrian Chadd
206248dd603SAdrian Chadd static int
ip17x_attach(device_t dev)207248dd603SAdrian Chadd ip17x_attach(device_t dev)
208248dd603SAdrian Chadd {
209248dd603SAdrian Chadd struct ip17x_softc *sc;
210248dd603SAdrian Chadd int err;
211248dd603SAdrian Chadd
212248dd603SAdrian Chadd sc = device_get_softc(dev);
213248dd603SAdrian Chadd
214248dd603SAdrian Chadd sc->sc_dev = dev;
215248dd603SAdrian Chadd mtx_init(&sc->sc_mtx, "ip17x", NULL, MTX_DEF);
216248dd603SAdrian Chadd strlcpy(sc->info.es_name, device_get_desc(dev),
217248dd603SAdrian Chadd sizeof(sc->info.es_name));
218248dd603SAdrian Chadd
219248dd603SAdrian Chadd /* XXX Defaults */
220248dd603SAdrian Chadd sc->phymask = 0x0f;
221248dd603SAdrian Chadd sc->media = 100;
222248dd603SAdrian Chadd
223248dd603SAdrian Chadd (void) resource_int_value(device_get_name(dev), device_get_unit(dev),
224248dd603SAdrian Chadd "phymask", &sc->phymask);
225248dd603SAdrian Chadd
226248dd603SAdrian Chadd /* Number of vlans supported by the switch. */
227248dd603SAdrian Chadd sc->info.es_nvlangroups = IP17X_MAX_VLANS;
228248dd603SAdrian Chadd
229248dd603SAdrian Chadd /* Attach the switch related functions. */
230248dd603SAdrian Chadd if (IP17X_IS_SWITCH(sc, IP175C))
231248dd603SAdrian Chadd ip175c_attach(sc);
232248dd603SAdrian Chadd else if (IP17X_IS_SWITCH(sc, IP175D))
233248dd603SAdrian Chadd ip175d_attach(sc);
234248dd603SAdrian Chadd else
235248dd603SAdrian Chadd /* We don't have support to all the models yet :-/ */
236248dd603SAdrian Chadd return (ENXIO);
237248dd603SAdrian Chadd
238248dd603SAdrian Chadd /* Always attach the cpu port. */
239248dd603SAdrian Chadd sc->phymask |= (1 << sc->cpuport);
240248dd603SAdrian Chadd
2412e6a8c1aSJustin Hibbits sc->ifp = malloc(sizeof(if_t) * sc->numports, M_IP17X,
242248dd603SAdrian Chadd M_WAITOK | M_ZERO);
243248dd603SAdrian Chadd sc->pvid = malloc(sizeof(uint32_t) * sc->numports, M_IP17X,
244248dd603SAdrian Chadd M_WAITOK | M_ZERO);
245248dd603SAdrian Chadd sc->miibus = malloc(sizeof(device_t *) * sc->numports, M_IP17X,
246248dd603SAdrian Chadd M_WAITOK | M_ZERO);
247248dd603SAdrian Chadd sc->portphy = malloc(sizeof(int) * sc->numports, M_IP17X,
248248dd603SAdrian Chadd M_WAITOK | M_ZERO);
249248dd603SAdrian Chadd
250248dd603SAdrian Chadd /* Initialize the switch. */
251248dd603SAdrian Chadd sc->hal.ip17x_reset(sc);
252248dd603SAdrian Chadd
253248dd603SAdrian Chadd /*
254248dd603SAdrian Chadd * Attach the PHYs and complete the bus enumeration.
255248dd603SAdrian Chadd */
256248dd603SAdrian Chadd err = ip17x_attach_phys(sc);
257248dd603SAdrian Chadd if (err != 0)
258248dd603SAdrian Chadd return (err);
259248dd603SAdrian Chadd
260248dd603SAdrian Chadd /*
261248dd603SAdrian Chadd * Set the switch to port based vlans or disabled (if not supported
262248dd603SAdrian Chadd * on this model).
263248dd603SAdrian Chadd */
264248dd603SAdrian Chadd sc->hal.ip17x_set_vlan_mode(sc, ETHERSWITCH_VLAN_PORT);
265248dd603SAdrian Chadd
266248dd603SAdrian Chadd bus_generic_probe(dev);
267248dd603SAdrian Chadd bus_enumerate_hinted_children(dev);
268248dd603SAdrian Chadd err = bus_generic_attach(dev);
269248dd603SAdrian Chadd if (err != 0)
270248dd603SAdrian Chadd return (err);
271248dd603SAdrian Chadd
272a99badc2SAdrian Chadd if (sc->miipoll) {
273248dd603SAdrian Chadd callout_init(&sc->callout_tick, 0);
274248dd603SAdrian Chadd
275248dd603SAdrian Chadd ip17x_tick(sc);
276a99badc2SAdrian Chadd }
277248dd603SAdrian Chadd
278248dd603SAdrian Chadd return (0);
279248dd603SAdrian Chadd }
280248dd603SAdrian Chadd
281248dd603SAdrian Chadd static int
ip17x_detach(device_t dev)282248dd603SAdrian Chadd ip17x_detach(device_t dev)
283248dd603SAdrian Chadd {
284248dd603SAdrian Chadd struct ip17x_softc *sc;
285248dd603SAdrian Chadd int i, port;
286248dd603SAdrian Chadd
287248dd603SAdrian Chadd sc = device_get_softc(dev);
288a99badc2SAdrian Chadd if (sc->miipoll)
289248dd603SAdrian Chadd callout_drain(&sc->callout_tick);
290248dd603SAdrian Chadd
291248dd603SAdrian Chadd for (i=0; i < MII_NPHY; i++) {
292248dd603SAdrian Chadd if (((1 << i) & sc->phymask) == 0)
293248dd603SAdrian Chadd continue;
294248dd603SAdrian Chadd port = sc->phyport[i];
295248dd603SAdrian Chadd if (sc->miibus[port] != NULL)
296248dd603SAdrian Chadd device_delete_child(dev, (*sc->miibus[port]));
297248dd603SAdrian Chadd if (sc->ifp[port] != NULL)
298248dd603SAdrian Chadd if_free(sc->ifp[port]);
299248dd603SAdrian Chadd free(sc->miibus[port], M_IP17X);
300248dd603SAdrian Chadd }
301248dd603SAdrian Chadd
302248dd603SAdrian Chadd free(sc->portphy, M_IP17X);
303248dd603SAdrian Chadd free(sc->miibus, M_IP17X);
304248dd603SAdrian Chadd free(sc->pvid, M_IP17X);
305248dd603SAdrian Chadd free(sc->ifp, M_IP17X);
306248dd603SAdrian Chadd
307248dd603SAdrian Chadd /* Reset the switch. */
308248dd603SAdrian Chadd sc->hal.ip17x_reset(sc);
309248dd603SAdrian Chadd
310248dd603SAdrian Chadd bus_generic_detach(dev);
311248dd603SAdrian Chadd mtx_destroy(&sc->sc_mtx);
312248dd603SAdrian Chadd
313248dd603SAdrian Chadd return (0);
314248dd603SAdrian Chadd }
315248dd603SAdrian Chadd
316248dd603SAdrian Chadd static inline struct mii_data *
ip17x_miiforport(struct ip17x_softc * sc,int port)317248dd603SAdrian Chadd ip17x_miiforport(struct ip17x_softc *sc, int port)
318248dd603SAdrian Chadd {
319248dd603SAdrian Chadd
320248dd603SAdrian Chadd if (port < 0 || port > sc->numports)
321248dd603SAdrian Chadd return (NULL);
322248dd603SAdrian Chadd return (device_get_softc(*sc->miibus[port]));
323248dd603SAdrian Chadd }
324248dd603SAdrian Chadd
3252e6a8c1aSJustin Hibbits static inline if_t
ip17x_ifpforport(struct ip17x_softc * sc,int port)326248dd603SAdrian Chadd ip17x_ifpforport(struct ip17x_softc *sc, int port)
327248dd603SAdrian Chadd {
328248dd603SAdrian Chadd
329248dd603SAdrian Chadd if (port < 0 || port > sc->numports)
330248dd603SAdrian Chadd return (NULL);
331248dd603SAdrian Chadd return (sc->ifp[port]);
332248dd603SAdrian Chadd }
333248dd603SAdrian Chadd
334248dd603SAdrian Chadd /*
335248dd603SAdrian Chadd * Poll the status for all PHYs.
336248dd603SAdrian Chadd */
337248dd603SAdrian Chadd static void
ip17x_miipollstat(struct ip17x_softc * sc)338248dd603SAdrian Chadd ip17x_miipollstat(struct ip17x_softc *sc)
339248dd603SAdrian Chadd {
340248dd603SAdrian Chadd struct mii_softc *miisc;
341248dd603SAdrian Chadd struct mii_data *mii;
342248dd603SAdrian Chadd int i, port;
343248dd603SAdrian Chadd
344248dd603SAdrian Chadd IP17X_LOCK_ASSERT(sc, MA_NOTOWNED);
345248dd603SAdrian Chadd
346248dd603SAdrian Chadd for (i = 0; i < MII_NPHY; i++) {
347248dd603SAdrian Chadd if (((1 << i) & sc->phymask) == 0)
348248dd603SAdrian Chadd continue;
349248dd603SAdrian Chadd port = sc->phyport[i];
350248dd603SAdrian Chadd if ((*sc->miibus[port]) == NULL)
351248dd603SAdrian Chadd continue;
352248dd603SAdrian Chadd mii = device_get_softc(*sc->miibus[port]);
353248dd603SAdrian Chadd LIST_FOREACH(miisc, &mii->mii_phys, mii_list) {
354248dd603SAdrian Chadd if (IFM_INST(mii->mii_media.ifm_cur->ifm_media) !=
355248dd603SAdrian Chadd miisc->mii_inst)
356248dd603SAdrian Chadd continue;
357248dd603SAdrian Chadd ukphy_status(miisc);
358248dd603SAdrian Chadd mii_phy_update(miisc, MII_POLLSTAT);
359248dd603SAdrian Chadd }
360248dd603SAdrian Chadd }
361248dd603SAdrian Chadd }
362248dd603SAdrian Chadd
363248dd603SAdrian Chadd static void
ip17x_tick(void * arg)364248dd603SAdrian Chadd ip17x_tick(void *arg)
365248dd603SAdrian Chadd {
366248dd603SAdrian Chadd struct ip17x_softc *sc;
367248dd603SAdrian Chadd
368248dd603SAdrian Chadd sc = arg;
369248dd603SAdrian Chadd ip17x_miipollstat(sc);
370248dd603SAdrian Chadd callout_reset(&sc->callout_tick, hz, ip17x_tick, sc);
371248dd603SAdrian Chadd }
372248dd603SAdrian Chadd
373248dd603SAdrian Chadd static void
ip17x_lock(device_t dev)374248dd603SAdrian Chadd ip17x_lock(device_t dev)
375248dd603SAdrian Chadd {
376248dd603SAdrian Chadd struct ip17x_softc *sc;
377248dd603SAdrian Chadd
378248dd603SAdrian Chadd sc = device_get_softc(dev);
379248dd603SAdrian Chadd IP17X_LOCK_ASSERT(sc, MA_NOTOWNED);
380248dd603SAdrian Chadd IP17X_LOCK(sc);
381248dd603SAdrian Chadd }
382248dd603SAdrian Chadd
383248dd603SAdrian Chadd static void
ip17x_unlock(device_t dev)384248dd603SAdrian Chadd ip17x_unlock(device_t dev)
385248dd603SAdrian Chadd {
386248dd603SAdrian Chadd struct ip17x_softc *sc;
387248dd603SAdrian Chadd
388248dd603SAdrian Chadd sc = device_get_softc(dev);
389248dd603SAdrian Chadd IP17X_LOCK_ASSERT(sc, MA_OWNED);
390248dd603SAdrian Chadd IP17X_UNLOCK(sc);
391248dd603SAdrian Chadd }
392248dd603SAdrian Chadd
393248dd603SAdrian Chadd static etherswitch_info_t *
ip17x_getinfo(device_t dev)394248dd603SAdrian Chadd ip17x_getinfo(device_t dev)
395248dd603SAdrian Chadd {
396248dd603SAdrian Chadd struct ip17x_softc *sc;
397248dd603SAdrian Chadd
398248dd603SAdrian Chadd sc = device_get_softc(dev);
399248dd603SAdrian Chadd return (&sc->info);
400248dd603SAdrian Chadd }
401248dd603SAdrian Chadd
402248dd603SAdrian Chadd static int
ip17x_getport(device_t dev,etherswitch_port_t * p)403248dd603SAdrian Chadd ip17x_getport(device_t dev, etherswitch_port_t *p)
404248dd603SAdrian Chadd {
405248dd603SAdrian Chadd struct ip17x_softc *sc;
406248dd603SAdrian Chadd struct ifmediareq *ifmr;
407248dd603SAdrian Chadd struct mii_data *mii;
408248dd603SAdrian Chadd int err, phy;
409248dd603SAdrian Chadd
410248dd603SAdrian Chadd sc = device_get_softc(dev);
411248dd603SAdrian Chadd if (p->es_port < 0 || p->es_port >= sc->numports)
412248dd603SAdrian Chadd return (ENXIO);
413248dd603SAdrian Chadd
414248dd603SAdrian Chadd phy = sc->portphy[p->es_port];
415248dd603SAdrian Chadd
416248dd603SAdrian Chadd /* Retrieve the PVID. */
417248dd603SAdrian Chadd p->es_pvid = sc->pvid[phy];
418248dd603SAdrian Chadd
419248dd603SAdrian Chadd /* Port flags. */
420248dd603SAdrian Chadd if (sc->addtag & (1 << phy))
421248dd603SAdrian Chadd p->es_flags |= ETHERSWITCH_PORT_ADDTAG;
422248dd603SAdrian Chadd if (sc->striptag & (1 << phy))
423248dd603SAdrian Chadd p->es_flags |= ETHERSWITCH_PORT_STRIPTAG;
424248dd603SAdrian Chadd
425248dd603SAdrian Chadd ifmr = &p->es_ifmr;
426248dd603SAdrian Chadd
427248dd603SAdrian Chadd /* No media settings ? */
428248dd603SAdrian Chadd if (p->es_ifmr.ifm_count == 0)
429248dd603SAdrian Chadd return (0);
430248dd603SAdrian Chadd
431248dd603SAdrian Chadd mii = ip17x_miiforport(sc, p->es_port);
432248dd603SAdrian Chadd if (mii == NULL)
433248dd603SAdrian Chadd return (ENXIO);
434248dd603SAdrian Chadd if (phy == sc->cpuport) {
435248dd603SAdrian Chadd /* fill in fixed values for CPU port */
436248dd603SAdrian Chadd p->es_flags |= ETHERSWITCH_PORT_CPU;
437248dd603SAdrian Chadd ifmr->ifm_count = 0;
438248dd603SAdrian Chadd if (sc->media == 100)
439248dd603SAdrian Chadd ifmr->ifm_current = ifmr->ifm_active =
440248dd603SAdrian Chadd IFM_ETHER | IFM_100_TX | IFM_FDX;
441248dd603SAdrian Chadd else
442248dd603SAdrian Chadd ifmr->ifm_current = ifmr->ifm_active =
443248dd603SAdrian Chadd IFM_ETHER | IFM_1000_T | IFM_FDX;
444248dd603SAdrian Chadd ifmr->ifm_mask = 0;
445248dd603SAdrian Chadd ifmr->ifm_status = IFM_ACTIVE | IFM_AVALID;
446248dd603SAdrian Chadd } else {
447248dd603SAdrian Chadd err = ifmedia_ioctl(mii->mii_ifp, &p->es_ifr,
448248dd603SAdrian Chadd &mii->mii_media, SIOCGIFMEDIA);
449248dd603SAdrian Chadd if (err)
450248dd603SAdrian Chadd return (err);
451248dd603SAdrian Chadd }
452248dd603SAdrian Chadd return (0);
453248dd603SAdrian Chadd }
454248dd603SAdrian Chadd
455248dd603SAdrian Chadd static int
ip17x_setport(device_t dev,etherswitch_port_t * p)456248dd603SAdrian Chadd ip17x_setport(device_t dev, etherswitch_port_t *p)
457248dd603SAdrian Chadd {
458248dd603SAdrian Chadd struct ip17x_softc *sc;
459248dd603SAdrian Chadd struct ifmedia *ifm;
4602e6a8c1aSJustin Hibbits if_t ifp;
461248dd603SAdrian Chadd struct mii_data *mii;
462248dd603SAdrian Chadd int phy;
463248dd603SAdrian Chadd
464248dd603SAdrian Chadd sc = device_get_softc(dev);
465248dd603SAdrian Chadd if (p->es_port < 0 || p->es_port >= sc->numports)
466248dd603SAdrian Chadd return (ENXIO);
467248dd603SAdrian Chadd
468248dd603SAdrian Chadd phy = sc->portphy[p->es_port];
469248dd603SAdrian Chadd ifp = ip17x_ifpforport(sc, p->es_port);
470248dd603SAdrian Chadd mii = ip17x_miiforport(sc, p->es_port);
471248dd603SAdrian Chadd if (ifp == NULL || mii == NULL)
472248dd603SAdrian Chadd return (ENXIO);
473248dd603SAdrian Chadd
474248dd603SAdrian Chadd /* Port flags. */
475248dd603SAdrian Chadd if (sc->vlan_mode == ETHERSWITCH_VLAN_DOT1Q) {
476248dd603SAdrian Chadd
477248dd603SAdrian Chadd /* Set the PVID. */
478248dd603SAdrian Chadd if (p->es_pvid != 0) {
479248dd603SAdrian Chadd if (IP17X_IS_SWITCH(sc, IP175C) &&
480248dd603SAdrian Chadd p->es_pvid > IP175C_LAST_VLAN)
481248dd603SAdrian Chadd return (ENXIO);
482248dd603SAdrian Chadd sc->pvid[phy] = p->es_pvid;
483248dd603SAdrian Chadd }
484248dd603SAdrian Chadd
485248dd603SAdrian Chadd /* Mutually exclusive. */
486248dd603SAdrian Chadd if (p->es_flags & ETHERSWITCH_PORT_ADDTAG &&
487248dd603SAdrian Chadd p->es_flags & ETHERSWITCH_PORT_STRIPTAG)
488248dd603SAdrian Chadd return (EINVAL);
489248dd603SAdrian Chadd
490248dd603SAdrian Chadd /* Reset the settings for this port. */
491248dd603SAdrian Chadd sc->addtag &= ~(1 << phy);
492248dd603SAdrian Chadd sc->striptag &= ~(1 << phy);
493248dd603SAdrian Chadd
494248dd603SAdrian Chadd /* And then set it to the new value. */
495248dd603SAdrian Chadd if (p->es_flags & ETHERSWITCH_PORT_ADDTAG)
496248dd603SAdrian Chadd sc->addtag |= (1 << phy);
497248dd603SAdrian Chadd if (p->es_flags & ETHERSWITCH_PORT_STRIPTAG)
498248dd603SAdrian Chadd sc->striptag |= (1 << phy);
499248dd603SAdrian Chadd }
500248dd603SAdrian Chadd
501248dd603SAdrian Chadd /* Update the switch configuration. */
502248dd603SAdrian Chadd if (sc->hal.ip17x_hw_setup(sc))
503248dd603SAdrian Chadd return (ENXIO);
504248dd603SAdrian Chadd
505248dd603SAdrian Chadd /* Do not allow media changes on CPU port. */
506248dd603SAdrian Chadd if (phy == sc->cpuport)
507248dd603SAdrian Chadd return (0);
508248dd603SAdrian Chadd
509248dd603SAdrian Chadd /* No media settings ? */
510248dd603SAdrian Chadd if (p->es_ifmr.ifm_count == 0)
511248dd603SAdrian Chadd return (0);
512248dd603SAdrian Chadd
513248dd603SAdrian Chadd ifm = &mii->mii_media;
514248dd603SAdrian Chadd return (ifmedia_ioctl(ifp, &p->es_ifr, ifm, SIOCSIFMEDIA));
515248dd603SAdrian Chadd }
516248dd603SAdrian Chadd
517248dd603SAdrian Chadd static void
ip17x_statchg(device_t dev)518248dd603SAdrian Chadd ip17x_statchg(device_t dev)
519248dd603SAdrian Chadd {
520248dd603SAdrian Chadd
521248dd603SAdrian Chadd DPRINTF(dev, "%s\n", __func__);
522248dd603SAdrian Chadd }
523248dd603SAdrian Chadd
524248dd603SAdrian Chadd static int
ip17x_ifmedia_upd(if_t ifp)5252e6a8c1aSJustin Hibbits ip17x_ifmedia_upd(if_t ifp)
526248dd603SAdrian Chadd {
527248dd603SAdrian Chadd struct ip17x_softc *sc;
528248dd603SAdrian Chadd struct mii_data *mii;
529248dd603SAdrian Chadd
5302e6a8c1aSJustin Hibbits sc = if_getsoftc(ifp);
5318237ba8aSLuiz Otavio O Souza DPRINTF(sc->sc_dev, "%s\n", __func__);
5322e6a8c1aSJustin Hibbits mii = ip17x_miiforport(sc, if_getdunit(ifp));
533248dd603SAdrian Chadd if (mii == NULL)
534248dd603SAdrian Chadd return (ENXIO);
535248dd603SAdrian Chadd mii_mediachg(mii);
5368237ba8aSLuiz Otavio O Souza
537248dd603SAdrian Chadd return (0);
538248dd603SAdrian Chadd }
539248dd603SAdrian Chadd
540248dd603SAdrian Chadd static void
ip17x_ifmedia_sts(if_t ifp,struct ifmediareq * ifmr)5412e6a8c1aSJustin Hibbits ip17x_ifmedia_sts(if_t ifp, struct ifmediareq *ifmr)
542248dd603SAdrian Chadd {
543248dd603SAdrian Chadd struct ip17x_softc *sc;
544248dd603SAdrian Chadd struct mii_data *mii;
545248dd603SAdrian Chadd
5462e6a8c1aSJustin Hibbits sc = if_getsoftc(ifp);
5478237ba8aSLuiz Otavio O Souza DPRINTF(sc->sc_dev, "%s\n", __func__);
5482e6a8c1aSJustin Hibbits mii = ip17x_miiforport(sc, if_getdunit(ifp));
549248dd603SAdrian Chadd if (mii == NULL)
550248dd603SAdrian Chadd return;
551248dd603SAdrian Chadd mii_pollstat(mii);
552248dd603SAdrian Chadd ifmr->ifm_active = mii->mii_media_active;
553248dd603SAdrian Chadd ifmr->ifm_status = mii->mii_media_status;
554248dd603SAdrian Chadd }
555248dd603SAdrian Chadd
556248dd603SAdrian Chadd static int
ip17x_readreg(device_t dev,int addr)557248dd603SAdrian Chadd ip17x_readreg(device_t dev, int addr)
558248dd603SAdrian Chadd {
559*82f43db3SEd Maste struct ip17x_softc *sc __diagused;
560248dd603SAdrian Chadd
561248dd603SAdrian Chadd sc = device_get_softc(dev);
562248dd603SAdrian Chadd IP17X_LOCK_ASSERT(sc, MA_OWNED);
563248dd603SAdrian Chadd
564248dd603SAdrian Chadd /* Not supported. */
565248dd603SAdrian Chadd return (0);
566248dd603SAdrian Chadd }
567248dd603SAdrian Chadd
568248dd603SAdrian Chadd static int
ip17x_writereg(device_t dev,int addr,int value)569248dd603SAdrian Chadd ip17x_writereg(device_t dev, int addr, int value)
570248dd603SAdrian Chadd {
571*82f43db3SEd Maste struct ip17x_softc *sc __diagused;
572248dd603SAdrian Chadd
573248dd603SAdrian Chadd sc = device_get_softc(dev);
574248dd603SAdrian Chadd IP17X_LOCK_ASSERT(sc, MA_OWNED);
575248dd603SAdrian Chadd
576248dd603SAdrian Chadd /* Not supported. */
577248dd603SAdrian Chadd return (0);
578248dd603SAdrian Chadd }
579248dd603SAdrian Chadd
580248dd603SAdrian Chadd static int
ip17x_getconf(device_t dev,etherswitch_conf_t * conf)581248dd603SAdrian Chadd ip17x_getconf(device_t dev, etherswitch_conf_t *conf)
582248dd603SAdrian Chadd {
583248dd603SAdrian Chadd struct ip17x_softc *sc;
584248dd603SAdrian Chadd
585248dd603SAdrian Chadd sc = device_get_softc(dev);
586248dd603SAdrian Chadd
587248dd603SAdrian Chadd /* Return the VLAN mode. */
588248dd603SAdrian Chadd conf->cmd = ETHERSWITCH_CONF_VLAN_MODE;
589248dd603SAdrian Chadd conf->vlan_mode = sc->hal.ip17x_get_vlan_mode(sc);
590248dd603SAdrian Chadd
591248dd603SAdrian Chadd return (0);
592248dd603SAdrian Chadd }
593248dd603SAdrian Chadd
594248dd603SAdrian Chadd static int
ip17x_setconf(device_t dev,etherswitch_conf_t * conf)595248dd603SAdrian Chadd ip17x_setconf(device_t dev, etherswitch_conf_t *conf)
596248dd603SAdrian Chadd {
597248dd603SAdrian Chadd struct ip17x_softc *sc;
598248dd603SAdrian Chadd
599248dd603SAdrian Chadd sc = device_get_softc(dev);
600248dd603SAdrian Chadd
601248dd603SAdrian Chadd /* Set the VLAN mode. */
602248dd603SAdrian Chadd if (conf->cmd & ETHERSWITCH_CONF_VLAN_MODE)
603248dd603SAdrian Chadd sc->hal.ip17x_set_vlan_mode(sc, conf->vlan_mode);
604248dd603SAdrian Chadd
605248dd603SAdrian Chadd return (0);
606248dd603SAdrian Chadd }
607248dd603SAdrian Chadd
608248dd603SAdrian Chadd static device_method_t ip17x_methods[] = {
609248dd603SAdrian Chadd /* Device interface */
610a99badc2SAdrian Chadd DEVMETHOD(device_identify, ip17x_identify),
611248dd603SAdrian Chadd DEVMETHOD(device_probe, ip17x_probe),
612248dd603SAdrian Chadd DEVMETHOD(device_attach, ip17x_attach),
613248dd603SAdrian Chadd DEVMETHOD(device_detach, ip17x_detach),
614248dd603SAdrian Chadd
615248dd603SAdrian Chadd /* bus interface */
616248dd603SAdrian Chadd DEVMETHOD(bus_add_child, device_add_child_ordered),
617248dd603SAdrian Chadd
618248dd603SAdrian Chadd /* MII interface */
619248dd603SAdrian Chadd DEVMETHOD(miibus_readreg, ip17x_readphy),
620248dd603SAdrian Chadd DEVMETHOD(miibus_writereg, ip17x_writephy),
621248dd603SAdrian Chadd DEVMETHOD(miibus_statchg, ip17x_statchg),
622248dd603SAdrian Chadd
623248dd603SAdrian Chadd /* MDIO interface */
624248dd603SAdrian Chadd DEVMETHOD(mdio_readreg, ip17x_readphy),
625248dd603SAdrian Chadd DEVMETHOD(mdio_writereg, ip17x_writephy),
626248dd603SAdrian Chadd
627248dd603SAdrian Chadd /* etherswitch interface */
628248dd603SAdrian Chadd DEVMETHOD(etherswitch_lock, ip17x_lock),
629248dd603SAdrian Chadd DEVMETHOD(etherswitch_unlock, ip17x_unlock),
630248dd603SAdrian Chadd DEVMETHOD(etherswitch_getinfo, ip17x_getinfo),
631248dd603SAdrian Chadd DEVMETHOD(etherswitch_readreg, ip17x_readreg),
632248dd603SAdrian Chadd DEVMETHOD(etherswitch_writereg, ip17x_writereg),
633248dd603SAdrian Chadd DEVMETHOD(etherswitch_readphyreg, ip17x_readphy),
634248dd603SAdrian Chadd DEVMETHOD(etherswitch_writephyreg, ip17x_writephy),
635248dd603SAdrian Chadd DEVMETHOD(etherswitch_getport, ip17x_getport),
636248dd603SAdrian Chadd DEVMETHOD(etherswitch_setport, ip17x_setport),
637248dd603SAdrian Chadd DEVMETHOD(etherswitch_getvgroup, ip17x_getvgroup),
638248dd603SAdrian Chadd DEVMETHOD(etherswitch_setvgroup, ip17x_setvgroup),
639248dd603SAdrian Chadd DEVMETHOD(etherswitch_getconf, ip17x_getconf),
640248dd603SAdrian Chadd DEVMETHOD(etherswitch_setconf, ip17x_setconf),
641248dd603SAdrian Chadd
642248dd603SAdrian Chadd DEVMETHOD_END
643248dd603SAdrian Chadd };
644248dd603SAdrian Chadd
645248dd603SAdrian Chadd DEFINE_CLASS_0(ip17x, ip17x_driver, ip17x_methods,
646248dd603SAdrian Chadd sizeof(struct ip17x_softc));
647248dd603SAdrian Chadd
64842726c2fSJohn Baldwin DRIVER_MODULE(ip17x, mdio, ip17x_driver, 0, 0);
6493e38757dSJohn Baldwin DRIVER_MODULE(miibus, ip17x, miibus_driver, 0, 0);
650829a13faSJohn Baldwin DRIVER_MODULE(etherswitch, ip17x, etherswitch_driver, 0, 0);
651248dd603SAdrian Chadd MODULE_VERSION(ip17x, 1);
652a99badc2SAdrian Chadd
653a99badc2SAdrian Chadd #ifdef FDT
654a99badc2SAdrian Chadd MODULE_DEPEND(ip17x, mdio, 1, 1, 1); /* XXX which versions? */
655a99badc2SAdrian Chadd #else
6568933f7d6SJohn Baldwin DRIVER_MODULE(mdio, ip17x, mdio_driver, 0, 0);
657248dd603SAdrian Chadd MODULE_DEPEND(ip17x, miibus, 1, 1, 1); /* XXX which versions? */
658248dd603SAdrian Chadd MODULE_DEPEND(ip17x, etherswitch, 1, 1, 1); /* XXX which versions? */
659a99badc2SAdrian Chadd #endif
660