smcphy.c revision 227908 
1/*-
2 * Copyright (c) 2006 Benno Rice.  All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions
6 * are met:
7 * 1. Redistributions of source code must retain the above copyright
8 *    notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 *    notice, this list of conditions and the following disclaimer in the
11 *    documentation and/or other materials provided with the distribution.
12 *
13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
14 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
15 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
16 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
17 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
18 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
19 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
20 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
21 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
22 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
23 */
24
25#include <sys/cdefs.h>
26__FBSDID("$FreeBSD: head/sys/dev/mii/smcphy.c 227908 2011-11-23 20:27:26Z marius $");
27
28/*
29 * Driver for the internal PHY on the SMSC LAN91C111.
30 */
31
32#include <sys/param.h>
33#include <sys/systm.h>
34#include <sys/kernel.h>
35#include <sys/socket.h>
36#include <sys/errno.h>
37#include <sys/module.h>
38#include <sys/bus.h>
39#include <sys/malloc.h>
40
41#include <machine/bus.h>
42
43#include <net/if.h>
44#include <net/if_media.h>
45
46#include <dev/mii/mii.h>
47#include <dev/mii/miivar.h>
48#include "miidevs.h"
49
50#include "miibus_if.h"
51
52static int	smcphy_probe(device_t);
53static int	smcphy_attach(device_t);
54
55static int	smcphy_service(struct mii_softc *, struct mii_data *, int);
56static void	smcphy_reset(struct mii_softc *);
57static void	smcphy_auto(struct mii_softc *, int);
58
59static device_method_t smcphy_methods[] = {
60	/* device interface */
61	DEVMETHOD(device_probe,		smcphy_probe),
62	DEVMETHOD(device_attach,	smcphy_attach),
63	DEVMETHOD(device_detach,	mii_phy_detach),
64	DEVMETHOD(device_shutdown,	bus_generic_shutdown),
65	DEVMETHOD_END
66};
67
68static devclass_t smcphy_devclass;
69
70static driver_t smcphy_driver = {
71	"smcphy",
72	smcphy_methods,
73	sizeof(struct mii_softc)
74};
75
76DRIVER_MODULE(smcphy, miibus, smcphy_driver, smcphy_devclass, 0, 0);
77
78static const struct mii_phydesc smcphys[] = {
79	MII_PHY_DESC(SEEQ, 84220),
80	MII_PHY_END
81};
82
83static const struct mii_phy_funcs smcphy_funcs = {
84	smcphy_service,
85	ukphy_status,
86	smcphy_reset
87};
88
89static int
90smcphy_probe(device_t dev)
91{
92
93	return (mii_phy_dev_probe(dev, smcphys, BUS_PROBE_DEFAULT));
94}
95
96static int
97smcphy_attach(device_t dev)
98{
99	struct mii_softc *sc;
100
101	sc = device_get_softc(dev);
102
103	mii_phy_dev_attach(dev, MIIF_NOISOLATE | MIIF_NOMANPAUSE,
104	    &smcphy_funcs, 1);
105	mii_phy_setmedia(sc);
106
107	return (0);
108}
109
110static int
111smcphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
112{
113        struct	ifmedia_entry *ife;
114        int	reg;
115
116	ife = mii->mii_media.ifm_cur;
117
118        switch (cmd) {
119        case MII_POLLSTAT:
120                break;
121
122        case MII_MEDIACHG:
123                /*
124                 * If the interface is not up, don't do anything.
125                 */
126                if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
127                        break;
128
129		switch (IFM_SUBTYPE(ife->ifm_media)) {
130		case IFM_AUTO:
131			smcphy_auto(sc, ife->ifm_media);
132			break;
133
134		default:
135                	mii_phy_setmedia(sc);
136			break;
137		}
138
139                break;
140
141        case MII_TICK:
142		if ((mii->mii_ifp->if_flags & IFF_UP) == 0) {
143			return (0);
144		}
145
146		if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) {
147			break;
148		}
149
150		/* I have no idea why BMCR_ISO gets set. */
151		reg = PHY_READ(sc, MII_BMCR);
152		if (reg & BMCR_ISO) {
153			PHY_WRITE(sc, MII_BMCR, reg & ~BMCR_ISO);
154		}
155
156		reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
157		if (reg & BMSR_LINK) {
158			sc->mii_ticks = 0;
159			break;
160		}
161
162		if (++sc->mii_ticks <= MII_ANEGTICKS) {
163			break;
164		}
165
166		sc->mii_ticks = 0;
167		PHY_RESET(sc);
168		smcphy_auto(sc, ife->ifm_media);
169                break;
170        }
171
172        /* Update the media status. */
173        PHY_STATUS(sc);
174
175        /* Callback if something changed. */
176        mii_phy_update(sc, cmd);
177        return (0);
178}
179
180static void
181smcphy_reset(struct mii_softc *sc)
182{
183	u_int	bmcr;
184	int	timeout;
185
186	PHY_WRITE(sc, MII_BMCR, BMCR_RESET);
187
188	for (timeout = 2; timeout > 0; timeout--) {
189		DELAY(50000);
190		bmcr = PHY_READ(sc, MII_BMCR);
191		if ((bmcr & BMCR_RESET) == 0)
192			break;
193	}
194
195	if (bmcr & BMCR_RESET)
196		device_printf(sc->mii_dev, "reset failed\n");
197
198	PHY_WRITE(sc, MII_BMCR, 0x3000);
199
200	/* Mask interrupts, we poll instead. */
201	PHY_WRITE(sc, 0x1e, 0xffc0);
202}
203
204static void
205smcphy_auto(struct mii_softc *sc, int media)
206{
207	uint16_t	anar;
208
209	anar = BMSR_MEDIA_TO_ANAR(sc->mii_capabilities) | ANAR_CSMA;
210	if ((media & IFM_FLOW) != 0 || (sc->mii_flags & MIIF_FORCEPAUSE) != 0)
211		anar |= ANAR_FC;
212	PHY_WRITE(sc, MII_ANAR, anar);
213	/* Apparently this helps. */
214	anar = PHY_READ(sc, MII_ANAR);
215	PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
216}
217