smcphy.c revision 221407 
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 221407 2011-05-03 19:51:29Z 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
66	{ 0, 0 }
67};
68
69static devclass_t smcphy_devclass;
70
71static driver_t smcphy_driver = {
72	"smcphy",
73	smcphy_methods,
74	sizeof(struct mii_softc)
75};
76
77DRIVER_MODULE(smcphy, miibus, smcphy_driver, smcphy_devclass, 0, 0);
78
79static const struct mii_phydesc smcphys[] = {
80	MII_PHY_DESC(SEEQ, 84220),
81	MII_PHY_END
82};
83
84static const struct mii_phy_funcs smcphy_funcs = {
85	smcphy_service,
86	ukphy_status,
87	smcphy_reset
88};
89
90static int
91smcphy_probe(device_t dev)
92{
93
94	return (mii_phy_dev_probe(dev, smcphys, BUS_PROBE_DEFAULT));
95}
96
97static int
98smcphy_attach(device_t dev)
99{
100	struct mii_softc *sc;
101
102	sc = device_get_softc(dev);
103
104	mii_phy_dev_attach(dev, MIIF_NOISOLATE | MIIF_NOMANPAUSE,
105	    &smcphy_funcs, 1);
106	mii_phy_setmedia(sc);
107
108	return (0);
109}
110
111static int
112smcphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
113{
114        struct	ifmedia_entry *ife;
115        int	reg;
116
117	ife = mii->mii_media.ifm_cur;
118
119        switch (cmd) {
120        case MII_POLLSTAT:
121                break;
122
123        case MII_MEDIACHG:
124                /*
125                 * If the interface is not up, don't do anything.
126                 */
127                if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
128                        break;
129
130		switch (IFM_SUBTYPE(ife->ifm_media)) {
131		case IFM_AUTO:
132			smcphy_auto(sc, ife->ifm_media);
133			break;
134
135		default:
136                	mii_phy_setmedia(sc);
137			break;
138		}
139
140                break;
141
142        case MII_TICK:
143		if ((mii->mii_ifp->if_flags & IFF_UP) == 0) {
144			return (0);
145		}
146
147		if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) {
148			break;
149		}
150
151		/* I have no idea why BMCR_ISO gets set. */
152		reg = PHY_READ(sc, MII_BMCR);
153		if (reg & BMCR_ISO) {
154			PHY_WRITE(sc, MII_BMCR, reg & ~BMCR_ISO);
155		}
156
157		reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
158		if (reg & BMSR_LINK) {
159			sc->mii_ticks = 0;
160			break;
161		}
162
163		if (++sc->mii_ticks <= MII_ANEGTICKS) {
164			break;
165		}
166
167		sc->mii_ticks = 0;
168		PHY_RESET(sc);
169		smcphy_auto(sc, ife->ifm_media);
170                break;
171        }
172
173        /* Update the media status. */
174        PHY_STATUS(sc);
175
176        /* Callback if something changed. */
177        mii_phy_update(sc, cmd);
178        return (0);
179}
180
181static void
182smcphy_reset(struct mii_softc *sc)
183{
184	u_int	bmcr;
185	int	timeout;
186
187	PHY_WRITE(sc, MII_BMCR, BMCR_RESET);
188
189	for (timeout = 2; timeout > 0; timeout--) {
190		DELAY(50000);
191		bmcr = PHY_READ(sc, MII_BMCR);
192		if ((bmcr & BMCR_RESET) == 0)
193			break;
194	}
195
196	if (bmcr & BMCR_RESET)
197		device_printf(sc->mii_dev, "reset failed\n");
198
199	PHY_WRITE(sc, MII_BMCR, 0x3000);
200
201	/* Mask interrupts, we poll instead. */
202	PHY_WRITE(sc, 0x1e, 0xffc0);
203}
204
205static void
206smcphy_auto(struct mii_softc *sc, int media)
207{
208	uint16_t	anar;
209
210	anar = BMSR_MEDIA_TO_ANAR(sc->mii_capabilities) |
211	    ANAR_CSMA;
212	if ((media & IFM_FLOW) != 0 || (sc->mii_flags & MIIF_FORCEPAUSE) != 0)
213		anar |= ANAR_FC;
214	PHY_WRITE(sc, MII_ANAR, anar);
215	/* Apparently this helps. */
216	anar = PHY_READ(sc, MII_ANAR);
217	PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_STARTNEG);
218}
219