xref: /freebsd/sys/dev/mii/truephy.c (revision 0957b409) 
1 /*-
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright (c) 2007 The DragonFly Project.  All rights reserved.
5  *
6  * This code is derived from software contributed to The DragonFly Project
7  * by Sepherosa Ziehau <sepherosa@gmail.com>
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  *
13  * 1. Redistributions of source code must retain the above copyright
14  *    notice, this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright
16  *    notice, this list of conditions and the following disclaimer in
17  *    the documentation and/or other materials provided with the
18  *    distribution.
19  * 3. Neither the name of The DragonFly Project nor the names of its
20  *    contributors may be used to endorse or promote products derived
21  *    from this software without specific, prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
24  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
25  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
26  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE
27  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
28  * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
29  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
30  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
31  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
32  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
33  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34  * SUCH DAMAGE.
35  *
36  * $DragonFly: src/sys/dev/netif/mii_layer/truephy.c,v 1.3 2008/02/10 07:29:27 sephe Exp $
37  * $FreeBSD$
38  */
39 
40 #include <sys/param.h>
41 #include <sys/systm.h>
42 #include <sys/kernel.h>
43 #include <sys/socket.h>
44 #include <sys/errno.h>
45 #include <sys/module.h>
46 #include <sys/bus.h>
47 
48 #include <net/if.h>
49 #include <net/if_var.h>
50 #include <net/if_media.h>
51 #include <net/if_arp.h>
52 #include <net/ethernet.h>
53 #include <net/if_vlan_var.h>
54 
55 #include <dev/mii/mii.h>
56 #include <dev/mii/miivar.h>
57 #include "miidevs.h"
58 
59 #include <dev/mii/truephyreg.h>
60 
61 #include "miibus_if.h"
62 
63 #define	TRUEPHY_FRAMELEN(mtu)	\
64     (ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN + (mtu) + ETHER_CRC_LEN)
65 
66 static int	truephy_service(struct mii_softc *, struct mii_data *, int);
67 static int	truephy_attach(device_t);
68 static int	truephy_probe(device_t);
69 static void	truephy_reset(struct mii_softc *);
70 static void	truephy_status(struct mii_softc *);
71 
72 static device_method_t truephy_methods[] = {
73 	/* device interface */
74 	DEVMETHOD(device_probe,		truephy_probe),
75 	DEVMETHOD(device_attach,	truephy_attach),
76 	DEVMETHOD(device_detach,	mii_phy_detach),
77 	DEVMETHOD(device_shutdown,	bus_generic_shutdown),
78 	DEVMETHOD_END
79 };
80 
81 static const struct mii_phydesc truephys[] = {
82 	MII_PHY_DESC(AGERE,	ET1011),
83 	MII_PHY_DESC(AGERE,	ET1011C),
84 	MII_PHY_END
85 };
86 
87 static devclass_t truephy_devclass;
88 
89 static driver_t truephy_driver = {
90 	"truephy",
91 	truephy_methods,
92 	sizeof(struct mii_softc)
93 };
94 
95 DRIVER_MODULE(truephy, miibus, truephy_driver, truephy_devclass, 0, 0);
96 
97 static const struct mii_phy_funcs truephy_funcs = {
98 	truephy_service,
99 	truephy_status,
100 	truephy_reset
101 };
102 
103 static const struct truephy_dsp {
104 	uint16_t	index;
105 	uint16_t	data;
106 } truephy_dspcode[] = {
107 	{ 0x880b,	0x0926 },	/* AfeIfCreg4B1000Msbs */
108 	{ 0x880c,	0x0926 },	/* AfeIfCreg4B100Msbs */
109 	{ 0x880d,	0x0926 },	/* AfeIfCreg4B10Msbs */
110 
111 	{ 0x880e,	0xb4d3 },	/* AfeIfCreg4B1000Lsbs */
112 	{ 0x880f,	0xb4d3 },	/* AfeIfCreg4B100Lsbs */
113 	{ 0x8810,	0xb4d3 },	/* AfeIfCreg4B10Lsbs */
114 
115 	{ 0x8805,	0xb03e },	/* AfeIfCreg3B1000Msbs */
116 	{ 0x8806,	0xb03e },	/* AfeIfCreg3B100Msbs */
117 	{ 0x8807,	0xff00 },	/* AfeIfCreg3B10Msbs */
118 
119 	{ 0x8808,	0xe090 },	/* AfeIfCreg3B1000Lsbs */
120 	{ 0x8809,	0xe110 },	/* AfeIfCreg3B100Lsbs */
121 	{ 0x880a,	0x0000 },	/* AfeIfCreg3B10Lsbs */
122 
123 	{ 0x300d,	1      },	/* DisableNorm */
124 
125 	{ 0x280c,	0x0180 },	/* LinkHoldEnd */
126 
127 	{ 0x1c21,	0x0002 },	/* AlphaM */
128 
129 	{ 0x3821,	6      },	/* FfeLkgTx0 */
130 	{ 0x381d,	1      },	/* FfeLkg1g4 */
131 	{ 0x381e,	1      },	/* FfeLkg1g5 */
132 	{ 0x381f,	1      },	/* FfeLkg1g6 */
133 	{ 0x3820,	1      },	/* FfeLkg1g7 */
134 
135 	{ 0x8402,	0x01f0 },	/* Btinact */
136 	{ 0x800e,	20     },	/* LftrainTime */
137 	{ 0x800f,	24     },	/* DvguardTime */
138 	{ 0x8010,	46     }	/* IdlguardTime */
139 };
140 
141 static int
142 truephy_probe(device_t dev)
143 {
144 
145 	return (mii_phy_dev_probe(dev, truephys, BUS_PROBE_DEFAULT));
146 }
147 
148 static int
149 truephy_attach(device_t dev)
150 {
151 	struct mii_softc *sc;
152 
153 	sc = device_get_softc(dev);
154 
155 	mii_phy_dev_attach(dev, MIIF_NOISOLATE | MIIF_NOMANPAUSE,
156 	   &truephy_funcs, 0);
157 
158 	PHY_RESET(sc);
159 
160 	sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & sc->mii_capmask;
161 	if (sc->mii_capabilities & BMSR_EXTSTAT) {
162 		sc->mii_extcapabilities = PHY_READ(sc, MII_EXTSR);
163 		/* No 1000baseT half-duplex support */
164 		sc->mii_extcapabilities &= ~EXTSR_1000THDX;
165 	}
166 
167 	device_printf(dev, " ");
168 	mii_phy_add_media(sc);
169 	printf("\n");
170 
171 	MIIBUS_MEDIAINIT(sc->mii_dev);
172 	return (0);
173 }
174 
175 static int
176 truephy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
177 {
178 	struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
179 	int bmcr;
180 
181 	switch (cmd) {
182 	case MII_POLLSTAT:
183 		break;
184 
185 	case MII_MEDIACHG:
186 		if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) {
187 			bmcr = PHY_READ(sc, MII_BMCR) & ~BMCR_AUTOEN;
188 			PHY_WRITE(sc, MII_BMCR, bmcr);
189 			PHY_WRITE(sc, MII_BMCR, bmcr | BMCR_PDOWN);
190 		}
191 
192 		mii_phy_setmedia(sc);
193 
194 		if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) {
195 			bmcr = PHY_READ(sc, MII_BMCR) & ~BMCR_PDOWN;
196 			PHY_WRITE(sc, MII_BMCR, bmcr);
197 
198 			if (IFM_SUBTYPE(ife->ifm_media) == IFM_1000_T) {
199 				PHY_WRITE(sc, MII_BMCR,
200 				    bmcr | BMCR_AUTOEN | BMCR_STARTNEG);
201 			}
202 		}
203 		break;
204 
205 	case MII_TICK:
206 		if (mii_phy_tick(sc) == EJUSTRETURN)
207 			return (0);
208 		break;
209 	}
210 
211 	/* Update the media status. */
212 	PHY_STATUS(sc);
213 
214 	/* Callback if something changed. */
215 	mii_phy_update(sc, cmd);
216 	return (0);
217 }
218 
219 static void
220 truephy_reset(struct mii_softc *sc)
221 {
222 	int i;
223 
224 	if (sc->mii_mpd_model == MII_MODEL_AGERE_ET1011) {
225 		mii_phy_reset(sc);
226 		return;
227 	}
228 
229 	for (i = 0; i < 2; ++i) {
230 		PHY_READ(sc, MII_PHYIDR1);
231 		PHY_READ(sc, MII_PHYIDR2);
232 
233 		PHY_READ(sc, TRUEPHY_CTRL);
234 		PHY_WRITE(sc, TRUEPHY_CTRL,
235 			  TRUEPHY_CTRL_DIAG | TRUEPHY_CTRL_RSV1);
236 
237 		PHY_WRITE(sc, TRUEPHY_INDEX, TRUEPHY_INDEX_MAGIC);
238 		PHY_READ(sc, TRUEPHY_DATA);
239 
240 		PHY_WRITE(sc, TRUEPHY_CTRL, TRUEPHY_CTRL_RSV1);
241 	}
242 
243 	PHY_READ(sc, MII_BMCR);
244 	PHY_READ(sc, TRUEPHY_CTRL);
245 	PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_PDOWN | BMCR_S1000);
246 	PHY_WRITE(sc, TRUEPHY_CTRL,
247 		  TRUEPHY_CTRL_DIAG | TRUEPHY_CTRL_RSV1 | TRUEPHY_CTRL_RSV0);
248 
249 	for (i = 0; i < nitems(truephy_dspcode); ++i) {
250 		const struct truephy_dsp *dsp = &truephy_dspcode[i];
251 
252 		PHY_WRITE(sc, TRUEPHY_INDEX, dsp->index);
253 		PHY_WRITE(sc, TRUEPHY_DATA, dsp->data);
254 
255 		PHY_WRITE(sc, TRUEPHY_INDEX, dsp->index);
256 		PHY_READ(sc, TRUEPHY_DATA);
257 	}
258 
259 	PHY_READ(sc, MII_BMCR);
260 	PHY_READ(sc, TRUEPHY_CTRL);
261 	PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN |  BMCR_S1000);
262 	PHY_WRITE(sc, TRUEPHY_CTRL, TRUEPHY_CTRL_RSV1);
263 
264 	mii_phy_reset(sc);
265 
266 	if (TRUEPHY_FRAMELEN((if_getmtu(sc->mii_pdata->mii_ifp)) > 2048)) {
267 		int conf;
268 
269 		conf = PHY_READ(sc, TRUEPHY_CONF);
270 		conf &= ~TRUEPHY_CONF_TXFIFO_MASK;
271 		conf |= TRUEPHY_CONF_TXFIFO_24;
272 		PHY_WRITE(sc, TRUEPHY_CONF, conf);
273 	}
274 }
275 
276 static void
277 truephy_status(struct mii_softc *sc)
278 {
279 	struct mii_data *mii = sc->mii_pdata;
280 	int bmsr, bmcr, sr;
281 
282 	mii->mii_media_status = IFM_AVALID;
283 	mii->mii_media_active = IFM_ETHER;
284 
285 	sr = PHY_READ(sc, TRUEPHY_SR);
286 	bmcr = PHY_READ(sc, MII_BMCR);
287 
288 	bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
289 	if (bmsr & BMSR_LINK)
290 		mii->mii_media_status |= IFM_ACTIVE;
291 
292 	if (bmcr & BMCR_AUTOEN) {
293 		if ((bmsr & BMSR_ACOMP) == 0) {
294 			mii->mii_media_active |= IFM_NONE;
295 			return;
296 		}
297 	}
298 
299 	switch (sr & TRUEPHY_SR_SPD_MASK) {
300 	case TRUEPHY_SR_SPD_1000T:
301 		mii->mii_media_active |= IFM_1000_T;
302 		break;
303 	case TRUEPHY_SR_SPD_100TX:
304 		mii->mii_media_active |= IFM_100_TX;
305 		break;
306 	case TRUEPHY_SR_SPD_10T:
307 		mii->mii_media_active |= IFM_10_T;
308 		break;
309 	default:
310 		/* XXX will this ever happen? */
311 		printf("invalid media SR %#x\n", sr);
312 		mii->mii_media_active |= IFM_NONE;
313 		return;
314 	}
315 
316 	if (sr & TRUEPHY_SR_FDX)
317 		mii->mii_media_active |= IFM_FDX | mii_phy_flowstatus(sc);
318 	else
319 		mii->mii_media_active |= IFM_HDX;
320 }
321