xref: /freebsd/sys/dev/my/if_my.c (revision 76039bc8)
1aad970f1SDavid E. O'Brien /*-
2aad970f1SDavid E. O'Brien  * Written by: yen_cw@myson.com.tw
3167aa833SJulian Elischer  * Copyright (c) 2002 Myson Technology Inc.
4167aa833SJulian Elischer  * All rights reserved.
5167aa833SJulian Elischer  *
6167aa833SJulian Elischer  * Redistribution and use in source and binary forms, with or without
7167aa833SJulian Elischer  * modification, are permitted provided that the following conditions
8167aa833SJulian Elischer  * are met:
9167aa833SJulian Elischer  * 1. Redistributions of source code must retain the above copyright
10167aa833SJulian Elischer  *    notice, this list of conditions, and the following disclaimer,
11167aa833SJulian Elischer  *    without modification, immediately at the beginning of the file.
12167aa833SJulian Elischer  * 2. The name of the author may not be used to endorse or promote products
13167aa833SJulian Elischer  *    derived from this software without specific prior written permission.
14167aa833SJulian Elischer  *
15167aa833SJulian Elischer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16167aa833SJulian Elischer  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17167aa833SJulian Elischer  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18167aa833SJulian Elischer  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
19167aa833SJulian Elischer  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20167aa833SJulian Elischer  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21167aa833SJulian Elischer  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22167aa833SJulian Elischer  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23167aa833SJulian Elischer  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24167aa833SJulian Elischer  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25167aa833SJulian Elischer  * SUCH DAMAGE.
26167aa833SJulian Elischer  *
27aad970f1SDavid E. O'Brien  * Myson fast ethernet PCI NIC driver, available at: http://www.myson.com.tw/
28167aa833SJulian Elischer  */
298368cf8fSDavid E. O'Brien 
308368cf8fSDavid E. O'Brien #include <sys/cdefs.h>
318368cf8fSDavid E. O'Brien __FBSDID("$FreeBSD$");
328368cf8fSDavid E. O'Brien 
33167aa833SJulian Elischer #include <sys/param.h>
34167aa833SJulian Elischer #include <sys/systm.h>
35167aa833SJulian Elischer #include <sys/sockio.h>
36167aa833SJulian Elischer #include <sys/mbuf.h>
37167aa833SJulian Elischer #include <sys/malloc.h>
38167aa833SJulian Elischer #include <sys/kernel.h>
39167aa833SJulian Elischer #include <sys/socket.h>
40167aa833SJulian Elischer #include <sys/queue.h>
41167aa833SJulian Elischer #include <sys/types.h>
42167aa833SJulian Elischer #include <sys/module.h>
43d4f567eeSJulian Elischer #include <sys/lock.h>
44d4f567eeSJulian Elischer #include <sys/mutex.h>
45167aa833SJulian Elischer 
46167aa833SJulian Elischer #define NBPFILTER	1
47167aa833SJulian Elischer 
48167aa833SJulian Elischer #include <net/if.h>
4976039bc8SGleb Smirnoff #include <net/if_var.h>
50167aa833SJulian Elischer #include <net/if_arp.h>
51167aa833SJulian Elischer #include <net/ethernet.h>
52167aa833SJulian Elischer #include <net/if_media.h>
53fc74a9f9SBrooks Davis #include <net/if_types.h>
54167aa833SJulian Elischer #include <net/if_dl.h>
55167aa833SJulian Elischer #include <net/bpf.h>
56167aa833SJulian Elischer 
57167aa833SJulian Elischer #include <vm/vm.h>		/* for vtophys */
58167aa833SJulian Elischer #include <vm/pmap.h>		/* for vtophys */
59167aa833SJulian Elischer #include <machine/bus.h>
60167aa833SJulian Elischer #include <machine/resource.h>
61167aa833SJulian Elischer #include <sys/bus.h>
62167aa833SJulian Elischer #include <sys/rman.h>
63167aa833SJulian Elischer 
6438d8c994SWarner Losh #include <dev/pci/pcireg.h>
6538d8c994SWarner Losh #include <dev/pci/pcivar.h>
66167aa833SJulian Elischer 
67167aa833SJulian Elischer /*
68167aa833SJulian Elischer  * #define MY_USEIOSPACE
69167aa833SJulian Elischer  */
70167aa833SJulian Elischer 
71167aa833SJulian Elischer static int      MY_USEIOSPACE = 1;
72167aa833SJulian Elischer 
733238c6bdSRuslan Ermilov #ifdef MY_USEIOSPACE
74167aa833SJulian Elischer #define MY_RES                  SYS_RES_IOPORT
75167aa833SJulian Elischer #define MY_RID                  MY_PCI_LOIO
76167aa833SJulian Elischer #else
77167aa833SJulian Elischer #define MY_RES                  SYS_RES_MEMORY
78167aa833SJulian Elischer #define MY_RID                  MY_PCI_LOMEM
79167aa833SJulian Elischer #endif
80167aa833SJulian Elischer 
81167aa833SJulian Elischer 
82167aa833SJulian Elischer #include <dev/my/if_myreg.h>
83167aa833SJulian Elischer 
84167aa833SJulian Elischer #ifndef lint
85167aa833SJulian Elischer static          const char rcsid[] =
8638d8c994SWarner Losh "$Id: if_my.c,v 1.16 2003/04/15 06:37:25 mdodd Exp $";
87167aa833SJulian Elischer #endif
88167aa833SJulian Elischer 
89167aa833SJulian Elischer /*
90167aa833SJulian Elischer  * Various supported device vendors/types and their names.
91167aa833SJulian Elischer  */
92167aa833SJulian Elischer struct my_type *my_info_tmp;
93167aa833SJulian Elischer static struct my_type my_devs[] = {
94167aa833SJulian Elischer 	{MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"},
95167aa833SJulian Elischer 	{MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"},
96167aa833SJulian Elischer 	{MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"},
97167aa833SJulian Elischer 	{0, 0, NULL}
98167aa833SJulian Elischer };
99167aa833SJulian Elischer 
100167aa833SJulian Elischer /*
101167aa833SJulian Elischer  * Various supported PHY vendors/types and their names. Note that this driver
102167aa833SJulian Elischer  * will work with pretty much any MII-compliant PHY, so failure to positively
103167aa833SJulian Elischer  * identify the chip is not a fatal error.
104167aa833SJulian Elischer  */
105167aa833SJulian Elischer static struct my_type my_phys[] = {
106167aa833SJulian Elischer 	{MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"},
107167aa833SJulian Elischer 	{SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"},
108167aa833SJulian Elischer 	{AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"},
109167aa833SJulian Elischer 	{MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"},
110167aa833SJulian Elischer 	{LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"},
111167aa833SJulian Elischer 	{0, 0, "<MII-compliant physical interface>"}
112167aa833SJulian Elischer };
113167aa833SJulian Elischer 
114167aa833SJulian Elischer static int      my_probe(device_t);
115167aa833SJulian Elischer static int      my_attach(device_t);
116167aa833SJulian Elischer static int      my_detach(device_t);
117167aa833SJulian Elischer static int      my_newbuf(struct my_softc *, struct my_chain_onefrag *);
118167aa833SJulian Elischer static int      my_encap(struct my_softc *, struct my_chain *, struct mbuf *);
119167aa833SJulian Elischer static void     my_rxeof(struct my_softc *);
120167aa833SJulian Elischer static void     my_txeof(struct my_softc *);
121167aa833SJulian Elischer static void     my_txeoc(struct my_softc *);
122167aa833SJulian Elischer static void     my_intr(void *);
123167aa833SJulian Elischer static void     my_start(struct ifnet *);
124ca5fc32dSJohn Baldwin static void     my_start_locked(struct ifnet *);
125167aa833SJulian Elischer static int      my_ioctl(struct ifnet *, u_long, caddr_t);
126167aa833SJulian Elischer static void     my_init(void *);
127ca5fc32dSJohn Baldwin static void     my_init_locked(struct my_softc *);
128167aa833SJulian Elischer static void     my_stop(struct my_softc *);
129d4e576c4SJohn Baldwin static void     my_autoneg_timeout(void *);
130d4e576c4SJohn Baldwin static void     my_watchdog(void *);
131174ed15eSWarner Losh static int      my_shutdown(device_t);
132167aa833SJulian Elischer static int      my_ifmedia_upd(struct ifnet *);
133167aa833SJulian Elischer static void     my_ifmedia_sts(struct ifnet *, struct ifmediareq *);
134167aa833SJulian Elischer static u_int16_t my_phy_readreg(struct my_softc *, int);
135167aa833SJulian Elischer static void     my_phy_writereg(struct my_softc *, int, int);
136167aa833SJulian Elischer static void     my_autoneg_xmit(struct my_softc *);
137167aa833SJulian Elischer static void     my_autoneg_mii(struct my_softc *, int, int);
138167aa833SJulian Elischer static void     my_setmode_mii(struct my_softc *, int);
139167aa833SJulian Elischer static void     my_getmode_mii(struct my_softc *);
140167aa833SJulian Elischer static void     my_setcfg(struct my_softc *, int);
141167aa833SJulian Elischer static void     my_setmulti(struct my_softc *);
142167aa833SJulian Elischer static void     my_reset(struct my_softc *);
143167aa833SJulian Elischer static int      my_list_rx_init(struct my_softc *);
144167aa833SJulian Elischer static int      my_list_tx_init(struct my_softc *);
145167aa833SJulian Elischer static long     my_send_cmd_to_phy(struct my_softc *, int, int);
146167aa833SJulian Elischer 
14729f19445SAlfred Perlstein #define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x))
14829f19445SAlfred Perlstein #define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x))
149167aa833SJulian Elischer 
150167aa833SJulian Elischer static device_method_t my_methods[] = {
151167aa833SJulian Elischer 	/* Device interface */
152167aa833SJulian Elischer 	DEVMETHOD(device_probe, my_probe),
153167aa833SJulian Elischer 	DEVMETHOD(device_attach, my_attach),
154167aa833SJulian Elischer 	DEVMETHOD(device_detach, my_detach),
155167aa833SJulian Elischer 	DEVMETHOD(device_shutdown, my_shutdown),
156167aa833SJulian Elischer 
15761bfd867SSofian Brabez 	DEVMETHOD_END
158167aa833SJulian Elischer };
159167aa833SJulian Elischer 
160167aa833SJulian Elischer static driver_t my_driver = {
161167aa833SJulian Elischer 	"my",
162167aa833SJulian Elischer 	my_methods,
163167aa833SJulian Elischer 	sizeof(struct my_softc)
164167aa833SJulian Elischer };
165167aa833SJulian Elischer 
166167aa833SJulian Elischer static devclass_t my_devclass;
167167aa833SJulian Elischer 
168f246e4a1SMatthew N. Dodd DRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0);
169f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, pci, 1, 1, 1);
170f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, ether, 1, 1, 1);
171167aa833SJulian Elischer 
172167aa833SJulian Elischer static long
173167aa833SJulian Elischer my_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad)
174167aa833SJulian Elischer {
175167aa833SJulian Elischer 	long            miir;
176167aa833SJulian Elischer 	int             i;
177167aa833SJulian Elischer 	int             mask, data;
178167aa833SJulian Elischer 
179ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
180167aa833SJulian Elischer 
181167aa833SJulian Elischer 	/* enable MII output */
182167aa833SJulian Elischer 	miir = CSR_READ_4(sc, MY_MANAGEMENT);
183167aa833SJulian Elischer 	miir &= 0xfffffff0;
184167aa833SJulian Elischer 
185167aa833SJulian Elischer 	miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO;
186167aa833SJulian Elischer 
187167aa833SJulian Elischer 	/* send 32 1's preamble */
188167aa833SJulian Elischer 	for (i = 0; i < 32; i++) {
189167aa833SJulian Elischer 		/* low MDC; MDO is already high (miir) */
190167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
191167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
192167aa833SJulian Elischer 
193167aa833SJulian Elischer 		/* high MDC */
194167aa833SJulian Elischer 		miir |= MY_MASK_MIIR_MII_MDC;
195167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
196167aa833SJulian Elischer 	}
197167aa833SJulian Elischer 
198167aa833SJulian Elischer 	/* calculate ST+OP+PHYAD+REGAD+TA */
199167aa833SJulian Elischer 	data = opcode | (sc->my_phy_addr << 7) | (regad << 2);
200167aa833SJulian Elischer 
201167aa833SJulian Elischer 	/* sent out */
202167aa833SJulian Elischer 	mask = 0x8000;
203167aa833SJulian Elischer 	while (mask) {
204167aa833SJulian Elischer 		/* low MDC, prepare MDO */
205167aa833SJulian Elischer 		miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
206167aa833SJulian Elischer 		if (mask & data)
207167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDO;
208167aa833SJulian Elischer 
209167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
210167aa833SJulian Elischer 		/* high MDC */
211167aa833SJulian Elischer 		miir |= MY_MASK_MIIR_MII_MDC;
212167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
213167aa833SJulian Elischer 		DELAY(30);
214167aa833SJulian Elischer 
215167aa833SJulian Elischer 		/* next */
216167aa833SJulian Elischer 		mask >>= 1;
217167aa833SJulian Elischer 		if (mask == 0x2 && opcode == MY_OP_READ)
218167aa833SJulian Elischer 			miir &= ~MY_MASK_MIIR_MII_WRITE;
219167aa833SJulian Elischer 	}
220167aa833SJulian Elischer 
221167aa833SJulian Elischer 	return miir;
222167aa833SJulian Elischer }
223167aa833SJulian Elischer 
224167aa833SJulian Elischer 
225167aa833SJulian Elischer static u_int16_t
226167aa833SJulian Elischer my_phy_readreg(struct my_softc * sc, int reg)
227167aa833SJulian Elischer {
228167aa833SJulian Elischer 	long            miir;
229167aa833SJulian Elischer 	int             mask, data;
230167aa833SJulian Elischer 
231ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
232167aa833SJulian Elischer 
233167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
234167aa833SJulian Elischer 		data = CSR_READ_2(sc, MY_PHYBASE + reg * 2);
235167aa833SJulian Elischer 	else {
236167aa833SJulian Elischer 		miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg);
237167aa833SJulian Elischer 
238167aa833SJulian Elischer 		/* read data */
239167aa833SJulian Elischer 		mask = 0x8000;
240167aa833SJulian Elischer 		data = 0;
241167aa833SJulian Elischer 		while (mask) {
242167aa833SJulian Elischer 			/* low MDC */
243167aa833SJulian Elischer 			miir &= ~MY_MASK_MIIR_MII_MDC;
244167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
245167aa833SJulian Elischer 
246167aa833SJulian Elischer 			/* read MDI */
247167aa833SJulian Elischer 			miir = CSR_READ_4(sc, MY_MANAGEMENT);
248167aa833SJulian Elischer 			if (miir & MY_MASK_MIIR_MII_MDI)
249167aa833SJulian Elischer 				data |= mask;
250167aa833SJulian Elischer 
251167aa833SJulian Elischer 			/* high MDC, and wait */
252167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDC;
253167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
254167aa833SJulian Elischer 			DELAY(30);
255167aa833SJulian Elischer 
256167aa833SJulian Elischer 			/* next */
257167aa833SJulian Elischer 			mask >>= 1;
258167aa833SJulian Elischer 		}
259167aa833SJulian Elischer 
260167aa833SJulian Elischer 		/* low MDC */
261167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
262167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
263167aa833SJulian Elischer 	}
264167aa833SJulian Elischer 
265167aa833SJulian Elischer 	return (u_int16_t) data;
266167aa833SJulian Elischer }
267167aa833SJulian Elischer 
268167aa833SJulian Elischer 
269167aa833SJulian Elischer static void
270167aa833SJulian Elischer my_phy_writereg(struct my_softc * sc, int reg, int data)
271167aa833SJulian Elischer {
272167aa833SJulian Elischer 	long            miir;
273167aa833SJulian Elischer 	int             mask;
274167aa833SJulian Elischer 
275ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
276167aa833SJulian Elischer 
277167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
278167aa833SJulian Elischer 		CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data);
279167aa833SJulian Elischer 	else {
280167aa833SJulian Elischer 		miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg);
281167aa833SJulian Elischer 
282167aa833SJulian Elischer 		/* write data */
283167aa833SJulian Elischer 		mask = 0x8000;
284167aa833SJulian Elischer 		while (mask) {
285167aa833SJulian Elischer 			/* low MDC, prepare MDO */
286167aa833SJulian Elischer 			miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
287167aa833SJulian Elischer 			if (mask & data)
288167aa833SJulian Elischer 				miir |= MY_MASK_MIIR_MII_MDO;
289167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
290167aa833SJulian Elischer 			DELAY(1);
291167aa833SJulian Elischer 
292167aa833SJulian Elischer 			/* high MDC */
293167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDC;
294167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
295167aa833SJulian Elischer 			DELAY(1);
296167aa833SJulian Elischer 
297167aa833SJulian Elischer 			/* next */
298167aa833SJulian Elischer 			mask >>= 1;
299167aa833SJulian Elischer 		}
300167aa833SJulian Elischer 
301167aa833SJulian Elischer 		/* low MDC */
302167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
303167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
304167aa833SJulian Elischer 	}
305167aa833SJulian Elischer 	return;
306167aa833SJulian Elischer }
307167aa833SJulian Elischer 
308167aa833SJulian Elischer 
309167aa833SJulian Elischer /*
310167aa833SJulian Elischer  * Program the 64-bit multicast hash filter.
311167aa833SJulian Elischer  */
312167aa833SJulian Elischer static void
313167aa833SJulian Elischer my_setmulti(struct my_softc * sc)
314167aa833SJulian Elischer {
315167aa833SJulian Elischer 	struct ifnet   *ifp;
316167aa833SJulian Elischer 	int             h = 0;
317167aa833SJulian Elischer 	u_int32_t       hashes[2] = {0, 0};
318167aa833SJulian Elischer 	struct ifmultiaddr *ifma;
319167aa833SJulian Elischer 	u_int32_t       rxfilt;
320167aa833SJulian Elischer 	int             mcnt = 0;
321167aa833SJulian Elischer 
322ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
323167aa833SJulian Elischer 
324fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
325167aa833SJulian Elischer 
326167aa833SJulian Elischer 	rxfilt = CSR_READ_4(sc, MY_TCRRCR);
327167aa833SJulian Elischer 
328167aa833SJulian Elischer 	if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
329167aa833SJulian Elischer 		rxfilt |= MY_AM;
330167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
331167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF);
332167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF);
333167aa833SJulian Elischer 
334167aa833SJulian Elischer 		return;
335167aa833SJulian Elischer 	}
336167aa833SJulian Elischer 	/* first, zot all the existing hash bits */
337167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR0, 0);
338167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR1, 0);
339167aa833SJulian Elischer 
340167aa833SJulian Elischer 	/* now program new ones */
341eb956cd0SRobert Watson 	if_maddr_rlock(ifp);
342167aa833SJulian Elischer 	TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
343167aa833SJulian Elischer 		if (ifma->ifma_addr->sa_family != AF_LINK)
344167aa833SJulian Elischer 			continue;
3450e939c0cSChristian Weisgerber 		h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *)
3460e939c0cSChristian Weisgerber 		    ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
347167aa833SJulian Elischer 		if (h < 32)
348167aa833SJulian Elischer 			hashes[0] |= (1 << h);
349167aa833SJulian Elischer 		else
350167aa833SJulian Elischer 			hashes[1] |= (1 << (h - 32));
351167aa833SJulian Elischer 		mcnt++;
352167aa833SJulian Elischer 	}
353eb956cd0SRobert Watson 	if_maddr_runlock(ifp);
354167aa833SJulian Elischer 
355167aa833SJulian Elischer 	if (mcnt)
356167aa833SJulian Elischer 		rxfilt |= MY_AM;
357167aa833SJulian Elischer 	else
358167aa833SJulian Elischer 		rxfilt &= ~MY_AM;
359167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR0, hashes[0]);
360167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR1, hashes[1]);
361167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
362167aa833SJulian Elischer 	return;
363167aa833SJulian Elischer }
364167aa833SJulian Elischer 
365167aa833SJulian Elischer /*
366167aa833SJulian Elischer  * Initiate an autonegotiation session.
367167aa833SJulian Elischer  */
368167aa833SJulian Elischer static void
369167aa833SJulian Elischer my_autoneg_xmit(struct my_softc * sc)
370167aa833SJulian Elischer {
371167aa833SJulian Elischer 	u_int16_t       phy_sts = 0;
372167aa833SJulian Elischer 
373ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
374167aa833SJulian Elischer 
375167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET);
376167aa833SJulian Elischer 	DELAY(500);
377167aa833SJulian Elischer 	while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET);
378167aa833SJulian Elischer 
379167aa833SJulian Elischer 	phy_sts = my_phy_readreg(sc, PHY_BMCR);
380167aa833SJulian Elischer 	phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR;
381167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, phy_sts);
382167aa833SJulian Elischer 
383167aa833SJulian Elischer 	return;
384167aa833SJulian Elischer }
385167aa833SJulian Elischer 
386d4e576c4SJohn Baldwin static void
387d4e576c4SJohn Baldwin my_autoneg_timeout(void *arg)
388d4e576c4SJohn Baldwin {
389d4e576c4SJohn Baldwin 	struct my_softc *sc;
390d4e576c4SJohn Baldwin 
391d4e576c4SJohn Baldwin 	sc = arg;
392d4e576c4SJohn Baldwin 	MY_LOCK_ASSERT(sc);
393d4e576c4SJohn Baldwin 	my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1);
394d4e576c4SJohn Baldwin }
395167aa833SJulian Elischer 
396167aa833SJulian Elischer /*
397167aa833SJulian Elischer  * Invoke autonegotiation on a PHY.
398167aa833SJulian Elischer  */
399167aa833SJulian Elischer static void
400167aa833SJulian Elischer my_autoneg_mii(struct my_softc * sc, int flag, int verbose)
401167aa833SJulian Elischer {
402167aa833SJulian Elischer 	u_int16_t       phy_sts = 0, media, advert, ability;
403167aa833SJulian Elischer 	u_int16_t       ability2 = 0;
404167aa833SJulian Elischer 	struct ifnet   *ifp;
405167aa833SJulian Elischer 	struct ifmedia *ifm;
406167aa833SJulian Elischer 
407ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
408167aa833SJulian Elischer 
409167aa833SJulian Elischer 	ifm = &sc->ifmedia;
410fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
411167aa833SJulian Elischer 
412167aa833SJulian Elischer 	ifm->ifm_media = IFM_ETHER | IFM_AUTO;
413167aa833SJulian Elischer 
414167aa833SJulian Elischer #ifndef FORCE_AUTONEG_TFOUR
415167aa833SJulian Elischer 	/*
416167aa833SJulian Elischer 	 * First, see if autoneg is supported. If not, there's no point in
417167aa833SJulian Elischer 	 * continuing.
418167aa833SJulian Elischer 	 */
419167aa833SJulian Elischer 	phy_sts = my_phy_readreg(sc, PHY_BMSR);
420167aa833SJulian Elischer 	if (!(phy_sts & PHY_BMSR_CANAUTONEG)) {
421167aa833SJulian Elischer 		if (verbose)
4226b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
4236b9f5c94SGleb Smirnoff 			    "autonegotiation not supported\n");
424167aa833SJulian Elischer 		ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
425167aa833SJulian Elischer 		return;
426167aa833SJulian Elischer 	}
427167aa833SJulian Elischer #endif
428167aa833SJulian Elischer 	switch (flag) {
429167aa833SJulian Elischer 	case MY_FLAG_FORCEDELAY:
430167aa833SJulian Elischer 		/*
431167aa833SJulian Elischer 		 * XXX Never use this option anywhere but in the probe
432167aa833SJulian Elischer 		 * routine: making the kernel stop dead in its tracks for
433167aa833SJulian Elischer 		 * three whole seconds after we've gone multi-user is really
434167aa833SJulian Elischer 		 * bad manners.
435167aa833SJulian Elischer 		 */
436167aa833SJulian Elischer 		my_autoneg_xmit(sc);
437167aa833SJulian Elischer 		DELAY(5000000);
438167aa833SJulian Elischer 		break;
439167aa833SJulian Elischer 	case MY_FLAG_SCHEDDELAY:
440167aa833SJulian Elischer 		/*
441167aa833SJulian Elischer 		 * Wait for the transmitter to go idle before starting an
442167aa833SJulian Elischer 		 * autoneg session, otherwise my_start() may clobber our
443167aa833SJulian Elischer 		 * timeout, and we don't want to allow transmission during an
444167aa833SJulian Elischer 		 * autoneg session since that can screw it up.
445167aa833SJulian Elischer 		 */
446167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_head != NULL) {
447167aa833SJulian Elischer 			sc->my_want_auto = 1;
448167aa833SJulian Elischer 			MY_UNLOCK(sc);
449167aa833SJulian Elischer 			return;
450167aa833SJulian Elischer 		}
451167aa833SJulian Elischer 		my_autoneg_xmit(sc);
452d4e576c4SJohn Baldwin 		callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout,
453d4e576c4SJohn Baldwin 		    sc);
454167aa833SJulian Elischer 		sc->my_autoneg = 1;
455167aa833SJulian Elischer 		sc->my_want_auto = 0;
456167aa833SJulian Elischer 		return;
457167aa833SJulian Elischer 	case MY_FLAG_DELAYTIMEO:
458d4e576c4SJohn Baldwin 		callout_stop(&sc->my_autoneg_timer);
459167aa833SJulian Elischer 		sc->my_autoneg = 0;
460167aa833SJulian Elischer 		break;
461167aa833SJulian Elischer 	default:
4626b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag);
463167aa833SJulian Elischer 		return;
464167aa833SJulian Elischer 	}
465167aa833SJulian Elischer 
466167aa833SJulian Elischer 	if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) {
467167aa833SJulian Elischer 		if (verbose)
4686b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg complete, ");
469167aa833SJulian Elischer 		phy_sts = my_phy_readreg(sc, PHY_BMSR);
470167aa833SJulian Elischer 	} else {
471167aa833SJulian Elischer 		if (verbose)
4726b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg not complete, ");
473167aa833SJulian Elischer 	}
474167aa833SJulian Elischer 
475167aa833SJulian Elischer 	media = my_phy_readreg(sc, PHY_BMCR);
476167aa833SJulian Elischer 
477167aa833SJulian Elischer 	/* Link is good. Report modes and set duplex mode. */
478167aa833SJulian Elischer 	if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) {
479167aa833SJulian Elischer 		if (verbose)
4806b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "link status good. ");
481167aa833SJulian Elischer 		advert = my_phy_readreg(sc, PHY_ANAR);
482167aa833SJulian Elischer 		ability = my_phy_readreg(sc, PHY_LPAR);
483167aa833SJulian Elischer 		if ((sc->my_pinfo->my_vid == MarvellPHYID0) ||
484167aa833SJulian Elischer 		    (sc->my_pinfo->my_vid == LevelOnePHYID0)) {
485167aa833SJulian Elischer 			ability2 = my_phy_readreg(sc, PHY_1000SR);
486167aa833SJulian Elischer 			if (ability2 & PHY_1000SR_1000BTXFULL) {
487167aa833SJulian Elischer 				advert = 0;
488167aa833SJulian Elischer 				ability = 0;
489167aa833SJulian Elischer 				/*
490167aa833SJulian Elischer 				 * this version did not support 1000M,
491167aa833SJulian Elischer 				 * ifm->ifm_media =
492b418ad5cSPoul-Henning Kamp 				 * IFM_ETHER|IFM_1000_T|IFM_FDX;
493167aa833SJulian Elischer 				 */
494167aa833SJulian Elischer 				ifm->ifm_media =
495167aa833SJulian Elischer 				    IFM_ETHER | IFM_100_TX | IFM_FDX;
496167aa833SJulian Elischer 				media &= ~PHY_BMCR_SPEEDSEL;
497167aa833SJulian Elischer 				media |= PHY_BMCR_1000;
498167aa833SJulian Elischer 				media |= PHY_BMCR_DUPLEX;
499167aa833SJulian Elischer 				printf("(full-duplex, 1000Mbps)\n");
500167aa833SJulian Elischer 			} else if (ability2 & PHY_1000SR_1000BTXHALF) {
501167aa833SJulian Elischer 				advert = 0;
502167aa833SJulian Elischer 				ability = 0;
503167aa833SJulian Elischer 				/*
504167aa833SJulian Elischer 				 * this version did not support 1000M,
505b418ad5cSPoul-Henning Kamp 				 * ifm->ifm_media = IFM_ETHER|IFM_1000_T;
506167aa833SJulian Elischer 				 */
507167aa833SJulian Elischer 				ifm->ifm_media = IFM_ETHER | IFM_100_TX;
508167aa833SJulian Elischer 				media &= ~PHY_BMCR_SPEEDSEL;
509167aa833SJulian Elischer 				media &= ~PHY_BMCR_DUPLEX;
510167aa833SJulian Elischer 				media |= PHY_BMCR_1000;
511167aa833SJulian Elischer 				printf("(half-duplex, 1000Mbps)\n");
512167aa833SJulian Elischer 			}
513167aa833SJulian Elischer 		}
514167aa833SJulian Elischer 		if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) {
515167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_T4;
516167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
517167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
518167aa833SJulian Elischer 			printf("(100baseT4)\n");
519167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_100BTXFULL &&
520167aa833SJulian Elischer 			   ability & PHY_ANAR_100BTXFULL) {
521167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
522167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
523167aa833SJulian Elischer 			media |= PHY_BMCR_DUPLEX;
524167aa833SJulian Elischer 			printf("(full-duplex, 100Mbps)\n");
525167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_100BTXHALF &&
526167aa833SJulian Elischer 			   ability & PHY_ANAR_100BTXHALF) {
527167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
528167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
529167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
530167aa833SJulian Elischer 			printf("(half-duplex, 100Mbps)\n");
531167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_10BTFULL &&
532167aa833SJulian Elischer 			   ability & PHY_ANAR_10BTFULL) {
533167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
534167aa833SJulian Elischer 			media &= ~PHY_BMCR_SPEEDSEL;
535167aa833SJulian Elischer 			media |= PHY_BMCR_DUPLEX;
536167aa833SJulian Elischer 			printf("(full-duplex, 10Mbps)\n");
537167aa833SJulian Elischer 		} else if (advert) {
538167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
539167aa833SJulian Elischer 			media &= ~PHY_BMCR_SPEEDSEL;
540167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
541167aa833SJulian Elischer 			printf("(half-duplex, 10Mbps)\n");
542167aa833SJulian Elischer 		}
543167aa833SJulian Elischer 		media &= ~PHY_BMCR_AUTONEGENBL;
544167aa833SJulian Elischer 
545167aa833SJulian Elischer 		/* Set ASIC's duplex mode to match the PHY. */
546167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, media);
547167aa833SJulian Elischer 		my_setcfg(sc, media);
548167aa833SJulian Elischer 	} else {
549167aa833SJulian Elischer 		if (verbose)
5506b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "no carrier\n");
551167aa833SJulian Elischer 	}
552167aa833SJulian Elischer 
553ca5fc32dSJohn Baldwin 	my_init_locked(sc);
554167aa833SJulian Elischer 	if (sc->my_tx_pend) {
555167aa833SJulian Elischer 		sc->my_autoneg = 0;
556167aa833SJulian Elischer 		sc->my_tx_pend = 0;
557ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
558167aa833SJulian Elischer 	}
559167aa833SJulian Elischer 	return;
560167aa833SJulian Elischer }
561167aa833SJulian Elischer 
562167aa833SJulian Elischer /*
563167aa833SJulian Elischer  * To get PHY ability.
564167aa833SJulian Elischer  */
565167aa833SJulian Elischer static void
566167aa833SJulian Elischer my_getmode_mii(struct my_softc * sc)
567167aa833SJulian Elischer {
568167aa833SJulian Elischer 	u_int16_t       bmsr;
569167aa833SJulian Elischer 	struct ifnet   *ifp;
570167aa833SJulian Elischer 
571ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
572fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
573167aa833SJulian Elischer 	bmsr = my_phy_readreg(sc, PHY_BMSR);
574167aa833SJulian Elischer 	if (bootverbose)
5756b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "PHY status word: %x\n", bmsr);
576167aa833SJulian Elischer 
577167aa833SJulian Elischer 	/* fallback */
578167aa833SJulian Elischer 	sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
579167aa833SJulian Elischer 
580167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_10BTHALF) {
581167aa833SJulian Elischer 		if (bootverbose)
5826b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5836b9f5c94SGleb Smirnoff 			    "10Mbps half-duplex mode supported\n");
584167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX,
585167aa833SJulian Elischer 		    0, NULL);
586167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL);
587167aa833SJulian Elischer 	}
588167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_10BTFULL) {
589167aa833SJulian Elischer 		if (bootverbose)
5906b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5916b9f5c94SGleb Smirnoff 			    "10Mbps full-duplex mode supported\n");
592167aa833SJulian Elischer 
593167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX,
594167aa833SJulian Elischer 		    0, NULL);
595167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
596167aa833SJulian Elischer 	}
597167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BTXHALF) {
598167aa833SJulian Elischer 		if (bootverbose)
5996b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6006b9f5c94SGleb Smirnoff 			    "100Mbps half-duplex mode supported\n");
601167aa833SJulian Elischer 		ifp->if_baudrate = 100000000;
602167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL);
603167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX,
604167aa833SJulian Elischer 			    0, NULL);
605167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
606167aa833SJulian Elischer 	}
607167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BTXFULL) {
608167aa833SJulian Elischer 		if (bootverbose)
6096b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6106b9f5c94SGleb Smirnoff 			    "100Mbps full-duplex mode supported\n");
611167aa833SJulian Elischer 		ifp->if_baudrate = 100000000;
612167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX,
613167aa833SJulian Elischer 		    0, NULL);
614167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
615167aa833SJulian Elischer 	}
616167aa833SJulian Elischer 	/* Some also support 100BaseT4. */
617167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BT4) {
618167aa833SJulian Elischer 		if (bootverbose)
6196b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "100baseT4 mode supported\n");
620167aa833SJulian Elischer 		ifp->if_baudrate = 100000000;
621167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL);
622167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4;
623167aa833SJulian Elischer #ifdef FORCE_AUTONEG_TFOUR
624167aa833SJulian Elischer 		if (bootverbose)
6256b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6266b9f5c94SGleb Smirnoff 			    "forcing on autoneg support for BT4\n");
627167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL):
628167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
629167aa833SJulian Elischer #endif
630167aa833SJulian Elischer 	}
6310cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
632167aa833SJulian Elischer 	if (sc->my_pinfo->my_vid == MarvellPHYID0) {
633167aa833SJulian Elischer 		if (bootverbose)
6346b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6356b9f5c94SGleb Smirnoff 			    "1000Mbps half-duplex mode supported\n");
636167aa833SJulian Elischer 
637167aa833SJulian Elischer 		ifp->if_baudrate = 1000000000;
638b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL);
639b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX,
640167aa833SJulian Elischer 		    0, NULL);
641167aa833SJulian Elischer 		if (bootverbose)
6426b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6436b9f5c94SGleb Smirnoff 			    "1000Mbps full-duplex mode supported\n");
644167aa833SJulian Elischer 		ifp->if_baudrate = 1000000000;
645b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX,
646167aa833SJulian Elischer 		    0, NULL);
647b418ad5cSPoul-Henning Kamp 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX;
648167aa833SJulian Elischer 	}
649167aa833SJulian Elischer #endif
650167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_CANAUTONEG) {
651167aa833SJulian Elischer 		if (bootverbose)
6526b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg supported\n");
653167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL);
654167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
655167aa833SJulian Elischer 	}
656167aa833SJulian Elischer 	return;
657167aa833SJulian Elischer }
658167aa833SJulian Elischer 
659167aa833SJulian Elischer /*
660167aa833SJulian Elischer  * Set speed and duplex mode.
661167aa833SJulian Elischer  */
662167aa833SJulian Elischer static void
663167aa833SJulian Elischer my_setmode_mii(struct my_softc * sc, int media)
664167aa833SJulian Elischer {
665167aa833SJulian Elischer 	u_int16_t       bmcr;
666167aa833SJulian Elischer 	struct ifnet   *ifp;
667167aa833SJulian Elischer 
668ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
669fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
670167aa833SJulian Elischer 	/*
671167aa833SJulian Elischer 	 * If an autoneg session is in progress, stop it.
672167aa833SJulian Elischer 	 */
673167aa833SJulian Elischer 	if (sc->my_autoneg) {
6746b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "canceling autoneg session\n");
675d4e576c4SJohn Baldwin 		callout_stop(&sc->my_autoneg_timer);
676d4e576c4SJohn Baldwin 		sc->my_autoneg = sc->my_want_auto = 0;
677167aa833SJulian Elischer 		bmcr = my_phy_readreg(sc, PHY_BMCR);
678167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_AUTONEGENBL;
679167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, bmcr);
680167aa833SJulian Elischer 	}
6816b9f5c94SGleb Smirnoff 	device_printf(sc->my_dev, "selecting MII, ");
682167aa833SJulian Elischer 	bmcr = my_phy_readreg(sc, PHY_BMCR);
683167aa833SJulian Elischer 	bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 |
684167aa833SJulian Elischer 		  PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK);
6850cde2d13SJulian Elischer 
6860cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
687b418ad5cSPoul-Henning Kamp 	if (IFM_SUBTYPE(media) == IFM_1000_T) {
688167aa833SJulian Elischer 		printf("1000Mbps/T4, half-duplex\n");
689167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_SPEEDSEL;
690167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
691167aa833SJulian Elischer 		bmcr |= PHY_BMCR_1000;
692167aa833SJulian Elischer 	}
693167aa833SJulian Elischer #endif
694167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_100_T4) {
695167aa833SJulian Elischer 		printf("100Mbps/T4, half-duplex\n");
696167aa833SJulian Elischer 		bmcr |= PHY_BMCR_SPEEDSEL;
697167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
698167aa833SJulian Elischer 	}
699167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_100_TX) {
700167aa833SJulian Elischer 		printf("100Mbps, ");
701167aa833SJulian Elischer 		bmcr |= PHY_BMCR_SPEEDSEL;
702167aa833SJulian Elischer 	}
703167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_10_T) {
704167aa833SJulian Elischer 		printf("10Mbps, ");
705167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_SPEEDSEL;
706167aa833SJulian Elischer 	}
707167aa833SJulian Elischer 	if ((media & IFM_GMASK) == IFM_FDX) {
708167aa833SJulian Elischer 		printf("full duplex\n");
709167aa833SJulian Elischer 		bmcr |= PHY_BMCR_DUPLEX;
710167aa833SJulian Elischer 	} else {
711167aa833SJulian Elischer 		printf("half duplex\n");
712167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
713167aa833SJulian Elischer 	}
714167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, bmcr);
715167aa833SJulian Elischer 	my_setcfg(sc, bmcr);
716167aa833SJulian Elischer 	return;
717167aa833SJulian Elischer }
718167aa833SJulian Elischer 
719167aa833SJulian Elischer /*
720167aa833SJulian Elischer  * The Myson manual states that in order to fiddle with the 'full-duplex' and
721167aa833SJulian Elischer  * '100Mbps' bits in the netconfig register, we first have to put the
722167aa833SJulian Elischer  * transmit and/or receive logic in the idle state.
723167aa833SJulian Elischer  */
724167aa833SJulian Elischer static void
725167aa833SJulian Elischer my_setcfg(struct my_softc * sc, int bmcr)
726167aa833SJulian Elischer {
727167aa833SJulian Elischer 	int             i, restart = 0;
728167aa833SJulian Elischer 
729ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
730167aa833SJulian Elischer 	if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) {
731167aa833SJulian Elischer 		restart = 1;
732167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE));
733167aa833SJulian Elischer 		for (i = 0; i < MY_TIMEOUT; i++) {
734167aa833SJulian Elischer 			DELAY(10);
735167aa833SJulian Elischer 			if (!(CSR_READ_4(sc, MY_TCRRCR) &
736167aa833SJulian Elischer 			    (MY_TXRUN | MY_RXRUN)))
737167aa833SJulian Elischer 				break;
738167aa833SJulian Elischer 		}
739167aa833SJulian Elischer 		if (i == MY_TIMEOUT)
7406b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
74112611131SJohn Baldwin 			    "failed to force tx and rx to idle \n");
742167aa833SJulian Elischer 	}
743167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000);
744167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_PS10);
745167aa833SJulian Elischer 	if (bmcr & PHY_BMCR_1000)
746167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PS1000);
747167aa833SJulian Elischer 	else if (!(bmcr & PHY_BMCR_SPEEDSEL))
748167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PS10);
749167aa833SJulian Elischer 	if (bmcr & PHY_BMCR_DUPLEX)
750167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_FD);
751167aa833SJulian Elischer 	else
752167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_FD);
753167aa833SJulian Elischer 	if (restart)
754167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE);
755167aa833SJulian Elischer 	return;
756167aa833SJulian Elischer }
757167aa833SJulian Elischer 
758167aa833SJulian Elischer static void
759167aa833SJulian Elischer my_reset(struct my_softc * sc)
760167aa833SJulian Elischer {
761167aa833SJulian Elischer 	register int    i;
762167aa833SJulian Elischer 
763ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
764167aa833SJulian Elischer 	MY_SETBIT(sc, MY_BCR, MY_SWR);
765167aa833SJulian Elischer 	for (i = 0; i < MY_TIMEOUT; i++) {
766167aa833SJulian Elischer 		DELAY(10);
767167aa833SJulian Elischer 		if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR))
768167aa833SJulian Elischer 			break;
769167aa833SJulian Elischer 	}
770167aa833SJulian Elischer 	if (i == MY_TIMEOUT)
7716b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "reset never completed!\n");
772167aa833SJulian Elischer 
773167aa833SJulian Elischer 	/* Wait a little while for the chip to get its brains in order. */
774167aa833SJulian Elischer 	DELAY(1000);
775167aa833SJulian Elischer 	return;
776167aa833SJulian Elischer }
777167aa833SJulian Elischer 
778167aa833SJulian Elischer /*
779167aa833SJulian Elischer  * Probe for a Myson chip. Check the PCI vendor and device IDs against our
780167aa833SJulian Elischer  * list and return a device name if we find a match.
781167aa833SJulian Elischer  */
782167aa833SJulian Elischer static int
783167aa833SJulian Elischer my_probe(device_t dev)
784167aa833SJulian Elischer {
785167aa833SJulian Elischer 	struct my_type *t;
786167aa833SJulian Elischer 
787167aa833SJulian Elischer 	t = my_devs;
788167aa833SJulian Elischer 	while (t->my_name != NULL) {
789167aa833SJulian Elischer 		if ((pci_get_vendor(dev) == t->my_vid) &&
790167aa833SJulian Elischer 		    (pci_get_device(dev) == t->my_did)) {
791167aa833SJulian Elischer 			device_set_desc(dev, t->my_name);
792167aa833SJulian Elischer 			my_info_tmp = t;
7936b9907e7SWarner Losh 			return (BUS_PROBE_DEFAULT);
794167aa833SJulian Elischer 		}
795167aa833SJulian Elischer 		t++;
796167aa833SJulian Elischer 	}
797167aa833SJulian Elischer 	return (ENXIO);
798167aa833SJulian Elischer }
799167aa833SJulian Elischer 
800167aa833SJulian Elischer /*
801167aa833SJulian Elischer  * Attach the interface. Allocate softc structures, do ifmedia setup and
802167aa833SJulian Elischer  * ethernet/BPF attach.
803167aa833SJulian Elischer  */
804167aa833SJulian Elischer static int
805167aa833SJulian Elischer my_attach(device_t dev)
806167aa833SJulian Elischer {
807ca5fc32dSJohn Baldwin 	int             i;
808167aa833SJulian Elischer 	u_char          eaddr[ETHER_ADDR_LEN];
809bd295e68SJohn Baldwin 	u_int32_t       iobase;
810167aa833SJulian Elischer 	struct my_softc *sc;
811167aa833SJulian Elischer 	struct ifnet   *ifp;
812167aa833SJulian Elischer 	int             media = IFM_ETHER | IFM_100_TX | IFM_FDX;
813167aa833SJulian Elischer 	unsigned int    round;
814167aa833SJulian Elischer 	caddr_t         roundptr;
815167aa833SJulian Elischer 	struct my_type *p;
816167aa833SJulian Elischer 	u_int16_t       phy_vid, phy_did, phy_sts = 0;
81712611131SJohn Baldwin 	int             rid, error = 0;
818167aa833SJulian Elischer 
819167aa833SJulian Elischer 	sc = device_get_softc(dev);
8206b9f5c94SGleb Smirnoff 	sc->my_dev = dev;
821f269532cSJulian Elischer 	mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
822ca5fc32dSJohn Baldwin 	    MTX_DEF);
823d4e576c4SJohn Baldwin 	callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0);
824d4e576c4SJohn Baldwin 	callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0);
825167aa833SJulian Elischer 
826167aa833SJulian Elischer 	/*
827167aa833SJulian Elischer 	 * Map control/status registers.
828167aa833SJulian Elischer 	 */
829bd295e68SJohn Baldwin 	pci_enable_busmaster(dev);
830167aa833SJulian Elischer 
831167aa833SJulian Elischer 	if (my_info_tmp->my_did == MTD800ID) {
832167aa833SJulian Elischer 		iobase = pci_read_config(dev, MY_PCI_LOIO, 4);
833167aa833SJulian Elischer 		if (iobase & 0x300)
834167aa833SJulian Elischer 			MY_USEIOSPACE = 0;
835167aa833SJulian Elischer 	}
836167aa833SJulian Elischer 
837167aa833SJulian Elischer 	rid = MY_RID;
8385f96beb9SNate Lawson 	sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE);
839167aa833SJulian Elischer 
840167aa833SJulian Elischer 	if (sc->my_res == NULL) {
84112611131SJohn Baldwin 		device_printf(dev, "couldn't map ports/memory\n");
842167aa833SJulian Elischer 		error = ENXIO;
843ca5fc32dSJohn Baldwin 		goto destroy_mutex;
844167aa833SJulian Elischer 	}
845167aa833SJulian Elischer 	sc->my_btag = rman_get_bustag(sc->my_res);
846167aa833SJulian Elischer 	sc->my_bhandle = rman_get_bushandle(sc->my_res);
847167aa833SJulian Elischer 
848167aa833SJulian Elischer 	rid = 0;
8495f96beb9SNate Lawson 	sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
850167aa833SJulian Elischer 					    RF_SHAREABLE | RF_ACTIVE);
851167aa833SJulian Elischer 
852167aa833SJulian Elischer 	if (sc->my_irq == NULL) {
85312611131SJohn Baldwin 		device_printf(dev, "couldn't map interrupt\n");
854167aa833SJulian Elischer 		error = ENXIO;
855ca5fc32dSJohn Baldwin 		goto release_io;
856167aa833SJulian Elischer 	}
857167aa833SJulian Elischer 
858167aa833SJulian Elischer 	sc->my_info = my_info_tmp;
859167aa833SJulian Elischer 
860167aa833SJulian Elischer 	/* Reset the adapter. */
861ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
862167aa833SJulian Elischer 	my_reset(sc);
863ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
864167aa833SJulian Elischer 
865167aa833SJulian Elischer 	/*
866167aa833SJulian Elischer 	 * Get station address
867167aa833SJulian Elischer 	 */
868167aa833SJulian Elischer 	for (i = 0; i < ETHER_ADDR_LEN; ++i)
869167aa833SJulian Elischer 		eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i);
870167aa833SJulian Elischer 
871167aa833SJulian Elischer 	sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8,
872167aa833SJulian Elischer 				  M_DEVBUF, M_NOWAIT);
873167aa833SJulian Elischer 	if (sc->my_ldata_ptr == NULL) {
87412611131SJohn Baldwin 		device_printf(dev, "no memory for list buffers!\n");
875167aa833SJulian Elischer 		error = ENXIO;
876ca5fc32dSJohn Baldwin 		goto release_irq;
877167aa833SJulian Elischer 	}
878167aa833SJulian Elischer 	sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr;
8792fc606e2SJohn Baldwin 	round = (uintptr_t)sc->my_ldata_ptr & 0xF;
880167aa833SJulian Elischer 	roundptr = sc->my_ldata_ptr;
881167aa833SJulian Elischer 	for (i = 0; i < 8; i++) {
882167aa833SJulian Elischer 		if (round % 8) {
883167aa833SJulian Elischer 			round++;
884167aa833SJulian Elischer 			roundptr++;
885167aa833SJulian Elischer 		} else
886167aa833SJulian Elischer 			break;
887167aa833SJulian Elischer 	}
888167aa833SJulian Elischer 	sc->my_ldata = (struct my_list_data *) roundptr;
889167aa833SJulian Elischer 	bzero(sc->my_ldata, sizeof(struct my_list_data));
890167aa833SJulian Elischer 
891fc74a9f9SBrooks Davis 	ifp = sc->my_ifp = if_alloc(IFT_ETHER);
892fc74a9f9SBrooks Davis 	if (ifp == NULL) {
893fc74a9f9SBrooks Davis 		device_printf(dev, "can not if_alloc()\n");
894fc74a9f9SBrooks Davis 		error = ENOSPC;
895ca5fc32dSJohn Baldwin 		goto free_ldata;
896fc74a9f9SBrooks Davis 	}
897167aa833SJulian Elischer 	ifp->if_softc = sc;
8989bf40edeSBrooks Davis 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
899167aa833SJulian Elischer 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
900167aa833SJulian Elischer 	ifp->if_ioctl = my_ioctl;
901167aa833SJulian Elischer 	ifp->if_start = my_start;
902167aa833SJulian Elischer 	ifp->if_init = my_init;
903167aa833SJulian Elischer 	ifp->if_baudrate = 10000000;
904e50d35e6SMaxim Sobolev 	IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
905e50d35e6SMaxim Sobolev 	ifp->if_snd.ifq_drv_maxlen = ifqmaxlen;
9069522f75aSChristian Brueffer 	IFQ_SET_READY(&ifp->if_snd);
907167aa833SJulian Elischer 
908167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
909167aa833SJulian Elischer 		sc->my_pinfo = my_phys;
910167aa833SJulian Elischer 	else {
911167aa833SJulian Elischer 		if (bootverbose)
91212611131SJohn Baldwin 			device_printf(dev, "probing for a PHY\n");
913ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
914167aa833SJulian Elischer 		for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) {
915167aa833SJulian Elischer 			if (bootverbose)
91612611131SJohn Baldwin 				device_printf(dev, "checking address: %d\n", i);
917167aa833SJulian Elischer 			sc->my_phy_addr = i;
918167aa833SJulian Elischer 			phy_sts = my_phy_readreg(sc, PHY_BMSR);
919167aa833SJulian Elischer 			if ((phy_sts != 0) && (phy_sts != 0xffff))
920167aa833SJulian Elischer 				break;
921167aa833SJulian Elischer 			else
922167aa833SJulian Elischer 				phy_sts = 0;
923167aa833SJulian Elischer 		}
924167aa833SJulian Elischer 		if (phy_sts) {
925167aa833SJulian Elischer 			phy_vid = my_phy_readreg(sc, PHY_VENID);
926167aa833SJulian Elischer 			phy_did = my_phy_readreg(sc, PHY_DEVID);
927167aa833SJulian Elischer 			if (bootverbose) {
92812611131SJohn Baldwin 				device_printf(dev, "found PHY at address %d, ",
92912611131SJohn Baldwin 				    sc->my_phy_addr);
930167aa833SJulian Elischer 				printf("vendor id: %x device id: %x\n",
931167aa833SJulian Elischer 				    phy_vid, phy_did);
932167aa833SJulian Elischer 			}
933167aa833SJulian Elischer 			p = my_phys;
934167aa833SJulian Elischer 			while (p->my_vid) {
935167aa833SJulian Elischer 				if (phy_vid == p->my_vid) {
936167aa833SJulian Elischer 					sc->my_pinfo = p;
937167aa833SJulian Elischer 					break;
938167aa833SJulian Elischer 				}
939167aa833SJulian Elischer 				p++;
940167aa833SJulian Elischer 			}
941167aa833SJulian Elischer 			if (sc->my_pinfo == NULL)
942167aa833SJulian Elischer 				sc->my_pinfo = &my_phys[PHY_UNKNOWN];
943167aa833SJulian Elischer 			if (bootverbose)
94412611131SJohn Baldwin 				device_printf(dev, "PHY type: %s\n",
94512611131SJohn Baldwin 				       sc->my_pinfo->my_name);
946167aa833SJulian Elischer 		} else {
947ca5fc32dSJohn Baldwin 			MY_UNLOCK(sc);
94812611131SJohn Baldwin 			device_printf(dev, "MII without any phy!\n");
949167aa833SJulian Elischer 			error = ENXIO;
950ca5fc32dSJohn Baldwin 			goto free_if;
951167aa833SJulian Elischer 		}
952ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
953167aa833SJulian Elischer 	}
954167aa833SJulian Elischer 
955167aa833SJulian Elischer 	/* Do ifmedia setup. */
956167aa833SJulian Elischer 	ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts);
957ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
958167aa833SJulian Elischer 	my_getmode_mii(sc);
959167aa833SJulian Elischer 	my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1);
960167aa833SJulian Elischer 	media = sc->ifmedia.ifm_media;
961167aa833SJulian Elischer 	my_stop(sc);
962ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
963167aa833SJulian Elischer 	ifmedia_set(&sc->ifmedia, media);
964167aa833SJulian Elischer 
965673d9191SSam Leffler 	ether_ifattach(ifp, eaddr);
966167aa833SJulian Elischer 
967ca5fc32dSJohn Baldwin 	error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE,
968ef544f63SPaolo Pisati 			       NULL, my_intr, sc, &sc->my_intrhand);
969ca5fc32dSJohn Baldwin 
970ca5fc32dSJohn Baldwin 	if (error) {
971ca5fc32dSJohn Baldwin 		device_printf(dev, "couldn't set up irq\n");
972ca5fc32dSJohn Baldwin 		goto detach_if;
973ca5fc32dSJohn Baldwin 	}
974ca5fc32dSJohn Baldwin 
975167aa833SJulian Elischer 	return (0);
976167aa833SJulian Elischer 
977ca5fc32dSJohn Baldwin detach_if:
978ca5fc32dSJohn Baldwin 	ether_ifdetach(ifp);
979ca5fc32dSJohn Baldwin free_if:
980ca5fc32dSJohn Baldwin 	if_free(ifp);
981ca5fc32dSJohn Baldwin free_ldata:
982fc74a9f9SBrooks Davis 	free(sc->my_ldata_ptr, M_DEVBUF);
983ca5fc32dSJohn Baldwin release_irq:
984ca5fc32dSJohn Baldwin 	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
985ca5fc32dSJohn Baldwin release_io:
986ca5fc32dSJohn Baldwin 	bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
987ca5fc32dSJohn Baldwin destroy_mutex:
988ca5fc32dSJohn Baldwin 	mtx_destroy(&sc->my_mtx);
989167aa833SJulian Elischer 	return (error);
990167aa833SJulian Elischer }
991167aa833SJulian Elischer 
992167aa833SJulian Elischer static int
993167aa833SJulian Elischer my_detach(device_t dev)
994167aa833SJulian Elischer {
995167aa833SJulian Elischer 	struct my_softc *sc;
996167aa833SJulian Elischer 	struct ifnet   *ifp;
997167aa833SJulian Elischer 
998167aa833SJulian Elischer 	sc = device_get_softc(dev);
999d4e576c4SJohn Baldwin 	ifp = sc->my_ifp;
1000d4e576c4SJohn Baldwin 	ether_ifdetach(ifp);
1001167aa833SJulian Elischer 	MY_LOCK(sc);
1002ca5fc32dSJohn Baldwin 	my_stop(sc);
1003ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1004ca5fc32dSJohn Baldwin 	bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand);
1005d4e576c4SJohn Baldwin 	callout_drain(&sc->my_watchdog);
1006d4e576c4SJohn Baldwin 	callout_drain(&sc->my_autoneg_timer);
1007ca5fc32dSJohn Baldwin 
1008fc74a9f9SBrooks Davis 	if_free(ifp);
1009ca5fc32dSJohn Baldwin 	free(sc->my_ldata_ptr, M_DEVBUF);
1010167aa833SJulian Elischer 
1011167aa833SJulian Elischer 	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
1012167aa833SJulian Elischer 	bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
1013167aa833SJulian Elischer 	mtx_destroy(&sc->my_mtx);
1014167aa833SJulian Elischer 	return (0);
1015167aa833SJulian Elischer }
1016167aa833SJulian Elischer 
1017167aa833SJulian Elischer 
1018167aa833SJulian Elischer /*
1019167aa833SJulian Elischer  * Initialize the transmit descriptors.
1020167aa833SJulian Elischer  */
1021167aa833SJulian Elischer static int
1022167aa833SJulian Elischer my_list_tx_init(struct my_softc * sc)
1023167aa833SJulian Elischer {
1024167aa833SJulian Elischer 	struct my_chain_data *cd;
1025167aa833SJulian Elischer 	struct my_list_data *ld;
1026167aa833SJulian Elischer 	int             i;
1027167aa833SJulian Elischer 
1028ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1029167aa833SJulian Elischer 	cd = &sc->my_cdata;
1030167aa833SJulian Elischer 	ld = sc->my_ldata;
1031167aa833SJulian Elischer 	for (i = 0; i < MY_TX_LIST_CNT; i++) {
1032167aa833SJulian Elischer 		cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i];
1033167aa833SJulian Elischer 		if (i == (MY_TX_LIST_CNT - 1))
1034167aa833SJulian Elischer 			cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0];
1035167aa833SJulian Elischer 		else
1036167aa833SJulian Elischer 			cd->my_tx_chain[i].my_nextdesc =
1037167aa833SJulian Elischer 			    &cd->my_tx_chain[i + 1];
1038167aa833SJulian Elischer 	}
1039167aa833SJulian Elischer 	cd->my_tx_free = &cd->my_tx_chain[0];
1040167aa833SJulian Elischer 	cd->my_tx_tail = cd->my_tx_head = NULL;
1041167aa833SJulian Elischer 	return (0);
1042167aa833SJulian Elischer }
1043167aa833SJulian Elischer 
1044167aa833SJulian Elischer /*
1045167aa833SJulian Elischer  * Initialize the RX descriptors and allocate mbufs for them. Note that we
1046167aa833SJulian Elischer  * arrange the descriptors in a closed ring, so that the last descriptor
1047167aa833SJulian Elischer  * points back to the first.
1048167aa833SJulian Elischer  */
1049167aa833SJulian Elischer static int
1050167aa833SJulian Elischer my_list_rx_init(struct my_softc * sc)
1051167aa833SJulian Elischer {
1052167aa833SJulian Elischer 	struct my_chain_data *cd;
1053167aa833SJulian Elischer 	struct my_list_data *ld;
1054167aa833SJulian Elischer 	int             i;
1055167aa833SJulian Elischer 
1056ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1057167aa833SJulian Elischer 	cd = &sc->my_cdata;
1058167aa833SJulian Elischer 	ld = sc->my_ldata;
1059167aa833SJulian Elischer 	for (i = 0; i < MY_RX_LIST_CNT; i++) {
1060167aa833SJulian Elischer 		cd->my_rx_chain[i].my_ptr =
1061167aa833SJulian Elischer 		    (struct my_desc *) & ld->my_rx_list[i];
1062a86d27acSJulian Elischer 		if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) {
1063a86d27acSJulian Elischer 			MY_UNLOCK(sc);
1064167aa833SJulian Elischer 			return (ENOBUFS);
1065a86d27acSJulian Elischer 		}
1066167aa833SJulian Elischer 		if (i == (MY_RX_LIST_CNT - 1)) {
1067167aa833SJulian Elischer 			cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0];
1068167aa833SJulian Elischer 			ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]);
1069167aa833SJulian Elischer 		} else {
1070167aa833SJulian Elischer 			cd->my_rx_chain[i].my_nextdesc =
1071167aa833SJulian Elischer 			    &cd->my_rx_chain[i + 1];
1072167aa833SJulian Elischer 			ld->my_rx_list[i].my_next =
1073167aa833SJulian Elischer 			    vtophys(&ld->my_rx_list[i + 1]);
1074167aa833SJulian Elischer 		}
1075167aa833SJulian Elischer 	}
1076167aa833SJulian Elischer 	cd->my_rx_head = &cd->my_rx_chain[0];
1077167aa833SJulian Elischer 	return (0);
1078167aa833SJulian Elischer }
1079167aa833SJulian Elischer 
1080167aa833SJulian Elischer /*
1081167aa833SJulian Elischer  * Initialize an RX descriptor and attach an MBUF cluster.
1082167aa833SJulian Elischer  */
1083167aa833SJulian Elischer static int
1084167aa833SJulian Elischer my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c)
1085167aa833SJulian Elischer {
1086167aa833SJulian Elischer 	struct mbuf    *m_new = NULL;
1087167aa833SJulian Elischer 
1088ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1089c6499eccSGleb Smirnoff 	MGETHDR(m_new, M_NOWAIT, MT_DATA);
1090167aa833SJulian Elischer 	if (m_new == NULL) {
10916b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev,
109212611131SJohn Baldwin 		    "no memory for rx list -- packet dropped!\n");
1093167aa833SJulian Elischer 		return (ENOBUFS);
1094167aa833SJulian Elischer 	}
1095c6499eccSGleb Smirnoff 	MCLGET(m_new, M_NOWAIT);
1096167aa833SJulian Elischer 	if (!(m_new->m_flags & M_EXT)) {
10976b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev,
109812611131SJohn Baldwin 		    "no memory for rx list -- packet dropped!\n");
1099167aa833SJulian Elischer 		m_freem(m_new);
1100167aa833SJulian Elischer 		return (ENOBUFS);
1101167aa833SJulian Elischer 	}
1102167aa833SJulian Elischer 	c->my_mbuf = m_new;
1103167aa833SJulian Elischer 	c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t));
1104167aa833SJulian Elischer 	c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift;
1105167aa833SJulian Elischer 	c->my_ptr->my_status = MY_OWNByNIC;
1106167aa833SJulian Elischer 	return (0);
1107167aa833SJulian Elischer }
1108167aa833SJulian Elischer 
1109167aa833SJulian Elischer /*
1110167aa833SJulian Elischer  * A frame has been uploaded: pass the resulting mbuf chain up to the higher
1111167aa833SJulian Elischer  * level protocols.
1112167aa833SJulian Elischer  */
1113167aa833SJulian Elischer static void
1114167aa833SJulian Elischer my_rxeof(struct my_softc * sc)
1115167aa833SJulian Elischer {
1116167aa833SJulian Elischer 	struct ether_header *eh;
1117167aa833SJulian Elischer 	struct mbuf    *m;
1118167aa833SJulian Elischer 	struct ifnet   *ifp;
1119167aa833SJulian Elischer 	struct my_chain_onefrag *cur_rx;
1120167aa833SJulian Elischer 	int             total_len = 0;
1121167aa833SJulian Elischer 	u_int32_t       rxstat;
1122167aa833SJulian Elischer 
1123ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1124fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1125167aa833SJulian Elischer 	while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status)
1126167aa833SJulian Elischer 	    & MY_OWNByNIC)) {
1127167aa833SJulian Elischer 		cur_rx = sc->my_cdata.my_rx_head;
1128167aa833SJulian Elischer 		sc->my_cdata.my_rx_head = cur_rx->my_nextdesc;
1129167aa833SJulian Elischer 
1130167aa833SJulian Elischer 		if (rxstat & MY_ES) {	/* error summary: give up this rx pkt */
1131167aa833SJulian Elischer 			ifp->if_ierrors++;
1132167aa833SJulian Elischer 			cur_rx->my_ptr->my_status = MY_OWNByNIC;
1133167aa833SJulian Elischer 			continue;
1134167aa833SJulian Elischer 		}
1135167aa833SJulian Elischer 		/* No errors; receive the packet. */
1136167aa833SJulian Elischer 		total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift;
1137167aa833SJulian Elischer 		total_len -= ETHER_CRC_LEN;
1138167aa833SJulian Elischer 
1139167aa833SJulian Elischer 		if (total_len < MINCLSIZE) {
1140167aa833SJulian Elischer 			m = m_devget(mtod(cur_rx->my_mbuf, char *),
1141167aa833SJulian Elischer 			    total_len, 0, ifp, NULL);
1142167aa833SJulian Elischer 			cur_rx->my_ptr->my_status = MY_OWNByNIC;
1143167aa833SJulian Elischer 			if (m == NULL) {
1144167aa833SJulian Elischer 				ifp->if_ierrors++;
1145167aa833SJulian Elischer 				continue;
1146167aa833SJulian Elischer 			}
1147167aa833SJulian Elischer 		} else {
1148167aa833SJulian Elischer 			m = cur_rx->my_mbuf;
1149167aa833SJulian Elischer 			/*
1150167aa833SJulian Elischer 			 * Try to conjure up a new mbuf cluster. If that
1151167aa833SJulian Elischer 			 * fails, it means we have an out of memory condition
1152167aa833SJulian Elischer 			 * and should leave the buffer in place and continue.
1153167aa833SJulian Elischer 			 * This will result in a lost packet, but there's
1154167aa833SJulian Elischer 			 * little else we can do in this situation.
1155167aa833SJulian Elischer 			 */
1156167aa833SJulian Elischer 			if (my_newbuf(sc, cur_rx) == ENOBUFS) {
1157167aa833SJulian Elischer 				ifp->if_ierrors++;
1158167aa833SJulian Elischer 				cur_rx->my_ptr->my_status = MY_OWNByNIC;
1159167aa833SJulian Elischer 				continue;
1160167aa833SJulian Elischer 			}
1161167aa833SJulian Elischer 			m->m_pkthdr.rcvif = ifp;
1162167aa833SJulian Elischer 			m->m_pkthdr.len = m->m_len = total_len;
1163167aa833SJulian Elischer 		}
1164167aa833SJulian Elischer 		ifp->if_ipackets++;
1165167aa833SJulian Elischer 		eh = mtod(m, struct ether_header *);
1166167aa833SJulian Elischer #if NBPFILTER > 0
1167167aa833SJulian Elischer 		/*
1168167aa833SJulian Elischer 		 * Handle BPF listeners. Let the BPF user see the packet, but
1169167aa833SJulian Elischer 		 * don't pass it up to the ether_input() layer unless it's a
1170167aa833SJulian Elischer 		 * broadcast packet, multicast packet, matches our ethernet
1171167aa833SJulian Elischer 		 * address or the interface is in promiscuous mode.
1172167aa833SJulian Elischer 		 */
11730dea849aSJohn Baldwin 		if (bpf_peers_present(ifp->if_bpf)) {
117455834910SJohn Baldwin 			bpf_mtap(ifp->if_bpf, m);
1175167aa833SJulian Elischer 			if (ifp->if_flags & IFF_PROMISC &&
11764a0d6638SRuslan Ermilov 			    (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp),
1177167aa833SJulian Elischer 				ETHER_ADDR_LEN) &&
1178167aa833SJulian Elischer 			     (eh->ether_dhost[0] & 1) == 0)) {
1179167aa833SJulian Elischer 				m_freem(m);
1180167aa833SJulian Elischer 				continue;
1181167aa833SJulian Elischer 			}
1182167aa833SJulian Elischer 		}
1183167aa833SJulian Elischer #endif
11845120abbfSSam Leffler 		MY_UNLOCK(sc);
1185673d9191SSam Leffler 		(*ifp->if_input)(ifp, m);
11865120abbfSSam Leffler 		MY_LOCK(sc);
1187167aa833SJulian Elischer 	}
1188167aa833SJulian Elischer 	return;
1189167aa833SJulian Elischer }
1190167aa833SJulian Elischer 
1191167aa833SJulian Elischer 
1192167aa833SJulian Elischer /*
1193167aa833SJulian Elischer  * A frame was downloaded to the chip. It's safe for us to clean up the list
1194167aa833SJulian Elischer  * buffers.
1195167aa833SJulian Elischer  */
1196167aa833SJulian Elischer static void
1197167aa833SJulian Elischer my_txeof(struct my_softc * sc)
1198167aa833SJulian Elischer {
1199167aa833SJulian Elischer 	struct my_chain *cur_tx;
1200167aa833SJulian Elischer 	struct ifnet   *ifp;
1201167aa833SJulian Elischer 
1202ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1203fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1204167aa833SJulian Elischer 	/* Clear the timeout timer. */
1205d4e576c4SJohn Baldwin 	sc->my_timer = 0;
12068ac00c27SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL) {
1207167aa833SJulian Elischer 		return;
12088ac00c27SJulian Elischer 	}
1209167aa833SJulian Elischer 	/*
1210167aa833SJulian Elischer 	 * Go through our tx list and free mbufs for those frames that have
1211167aa833SJulian Elischer 	 * been transmitted.
1212167aa833SJulian Elischer 	 */
1213167aa833SJulian Elischer 	while (sc->my_cdata.my_tx_head->my_mbuf != NULL) {
1214167aa833SJulian Elischer 		u_int32_t       txstat;
1215167aa833SJulian Elischer 
1216167aa833SJulian Elischer 		cur_tx = sc->my_cdata.my_tx_head;
1217167aa833SJulian Elischer 		txstat = MY_TXSTATUS(cur_tx);
1218167aa833SJulian Elischer 		if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT)
1219167aa833SJulian Elischer 			break;
1220167aa833SJulian Elischer 		if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) {
1221167aa833SJulian Elischer 			if (txstat & MY_TXERR) {
1222167aa833SJulian Elischer 				ifp->if_oerrors++;
1223167aa833SJulian Elischer 				if (txstat & MY_EC) /* excessive collision */
1224167aa833SJulian Elischer 					ifp->if_collisions++;
1225167aa833SJulian Elischer 				if (txstat & MY_LC)	/* late collision */
1226167aa833SJulian Elischer 					ifp->if_collisions++;
1227167aa833SJulian Elischer 			}
1228167aa833SJulian Elischer 			ifp->if_collisions += (txstat & MY_NCRMASK) >>
1229167aa833SJulian Elischer 			    MY_NCRShift;
1230167aa833SJulian Elischer 		}
1231167aa833SJulian Elischer 		ifp->if_opackets++;
1232167aa833SJulian Elischer 		m_freem(cur_tx->my_mbuf);
1233167aa833SJulian Elischer 		cur_tx->my_mbuf = NULL;
1234167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) {
1235167aa833SJulian Elischer 			sc->my_cdata.my_tx_head = NULL;
1236167aa833SJulian Elischer 			sc->my_cdata.my_tx_tail = NULL;
1237167aa833SJulian Elischer 			break;
1238167aa833SJulian Elischer 		}
1239167aa833SJulian Elischer 		sc->my_cdata.my_tx_head = cur_tx->my_nextdesc;
1240167aa833SJulian Elischer 	}
1241167aa833SJulian Elischer 	if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) {
1242167aa833SJulian Elischer 		ifp->if_collisions += (CSR_READ_4(sc, MY_TSR) & MY_NCRMask);
1243167aa833SJulian Elischer 	}
1244167aa833SJulian Elischer 	return;
1245167aa833SJulian Elischer }
1246167aa833SJulian Elischer 
1247167aa833SJulian Elischer /*
1248167aa833SJulian Elischer  * TX 'end of channel' interrupt handler.
1249167aa833SJulian Elischer  */
1250167aa833SJulian Elischer static void
1251167aa833SJulian Elischer my_txeoc(struct my_softc * sc)
1252167aa833SJulian Elischer {
1253167aa833SJulian Elischer 	struct ifnet   *ifp;
1254167aa833SJulian Elischer 
1255ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1256fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1257d4e576c4SJohn Baldwin 	sc->my_timer = 0;
1258167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL) {
125913f4c340SRobert Watson 		ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1260167aa833SJulian Elischer 		sc->my_cdata.my_tx_tail = NULL;
1261167aa833SJulian Elischer 		if (sc->my_want_auto)
1262167aa833SJulian Elischer 			my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1263167aa833SJulian Elischer 	} else {
1264167aa833SJulian Elischer 		if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) {
1265167aa833SJulian Elischer 			MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC;
1266d4e576c4SJohn Baldwin 			sc->my_timer = 5;
1267167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);
1268167aa833SJulian Elischer 		}
1269167aa833SJulian Elischer 	}
1270167aa833SJulian Elischer 	return;
1271167aa833SJulian Elischer }
1272167aa833SJulian Elischer 
1273167aa833SJulian Elischer static void
1274167aa833SJulian Elischer my_intr(void *arg)
1275167aa833SJulian Elischer {
1276167aa833SJulian Elischer 	struct my_softc *sc;
1277167aa833SJulian Elischer 	struct ifnet   *ifp;
1278167aa833SJulian Elischer 	u_int32_t       status;
1279167aa833SJulian Elischer 
1280167aa833SJulian Elischer 	sc = arg;
1281167aa833SJulian Elischer 	MY_LOCK(sc);
1282fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1283167aa833SJulian Elischer 	if (!(ifp->if_flags & IFF_UP)) {
1284167aa833SJulian Elischer 		MY_UNLOCK(sc);
1285167aa833SJulian Elischer 		return;
1286167aa833SJulian Elischer 	}
1287167aa833SJulian Elischer 	/* Disable interrupts. */
1288167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1289167aa833SJulian Elischer 
1290167aa833SJulian Elischer 	for (;;) {
1291167aa833SJulian Elischer 		status = CSR_READ_4(sc, MY_ISR);
1292167aa833SJulian Elischer 		status &= MY_INTRS;
1293167aa833SJulian Elischer 		if (status)
1294167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_ISR, status);
1295167aa833SJulian Elischer 		else
1296167aa833SJulian Elischer 			break;
1297167aa833SJulian Elischer 
1298167aa833SJulian Elischer 		if (status & MY_RI)	/* receive interrupt */
1299167aa833SJulian Elischer 			my_rxeof(sc);
1300167aa833SJulian Elischer 
1301167aa833SJulian Elischer 		if ((status & MY_RBU) || (status & MY_RxErr)) {
1302167aa833SJulian Elischer 			/* rx buffer unavailable or rx error */
1303167aa833SJulian Elischer 			ifp->if_ierrors++;
1304167aa833SJulian Elischer #ifdef foo
1305167aa833SJulian Elischer 			my_stop(sc);
1306167aa833SJulian Elischer 			my_reset(sc);
1307ca5fc32dSJohn Baldwin 			my_init_locked(sc);
1308167aa833SJulian Elischer #endif
1309167aa833SJulian Elischer 		}
1310167aa833SJulian Elischer 		if (status & MY_TI)	/* tx interrupt */
1311167aa833SJulian Elischer 			my_txeof(sc);
1312167aa833SJulian Elischer 		if (status & MY_ETI)	/* tx early interrupt */
1313167aa833SJulian Elischer 			my_txeof(sc);
1314167aa833SJulian Elischer 		if (status & MY_TBU)	/* tx buffer unavailable */
1315167aa833SJulian Elischer 			my_txeoc(sc);
13160cde2d13SJulian Elischer 
13170cde2d13SJulian Elischer #if 0				/* 90/1/18 delete */
13180cde2d13SJulian Elischer 		if (status & MY_FBE) {
13190cde2d13SJulian Elischer 			my_reset(sc);
1320ca5fc32dSJohn Baldwin 			my_init_locked(sc);
13210cde2d13SJulian Elischer 		}
13220cde2d13SJulian Elischer #endif
13230cde2d13SJulian Elischer 
1324167aa833SJulian Elischer 	}
1325167aa833SJulian Elischer 
1326167aa833SJulian Elischer 	/* Re-enable interrupts. */
1327167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
13289522f75aSChristian Brueffer 	if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1329ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
1330167aa833SJulian Elischer 	MY_UNLOCK(sc);
1331167aa833SJulian Elischer 	return;
1332167aa833SJulian Elischer }
1333167aa833SJulian Elischer 
1334167aa833SJulian Elischer /*
1335167aa833SJulian Elischer  * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1336167aa833SJulian Elischer  * pointers to the fragment pointers.
1337167aa833SJulian Elischer  */
1338167aa833SJulian Elischer static int
1339167aa833SJulian Elischer my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head)
1340167aa833SJulian Elischer {
1341167aa833SJulian Elischer 	struct my_desc *f = NULL;
1342167aa833SJulian Elischer 	int             total_len;
1343167aa833SJulian Elischer 	struct mbuf    *m, *m_new = NULL;
1344167aa833SJulian Elischer 
1345ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1346167aa833SJulian Elischer 	/* calculate the total tx pkt length */
1347167aa833SJulian Elischer 	total_len = 0;
1348167aa833SJulian Elischer 	for (m = m_head; m != NULL; m = m->m_next)
1349167aa833SJulian Elischer 		total_len += m->m_len;
1350167aa833SJulian Elischer 	/*
1351167aa833SJulian Elischer 	 * Start packing the mbufs in this chain into the fragment pointers.
1352167aa833SJulian Elischer 	 * Stop when we run out of fragments or hit the end of the mbuf
1353167aa833SJulian Elischer 	 * chain.
1354167aa833SJulian Elischer 	 */
1355167aa833SJulian Elischer 	m = m_head;
1356c6499eccSGleb Smirnoff 	MGETHDR(m_new, M_NOWAIT, MT_DATA);
1357167aa833SJulian Elischer 	if (m_new == NULL) {
13586b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "no memory for tx list");
1359167aa833SJulian Elischer 		return (1);
1360167aa833SJulian Elischer 	}
1361167aa833SJulian Elischer 	if (m_head->m_pkthdr.len > MHLEN) {
1362c6499eccSGleb Smirnoff 		MCLGET(m_new, M_NOWAIT);
1363167aa833SJulian Elischer 		if (!(m_new->m_flags & M_EXT)) {
1364167aa833SJulian Elischer 			m_freem(m_new);
13656b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "no memory for tx list");
1366167aa833SJulian Elischer 			return (1);
1367167aa833SJulian Elischer 		}
1368167aa833SJulian Elischer 	}
1369167aa833SJulian Elischer 	m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t));
1370167aa833SJulian Elischer 	m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len;
1371167aa833SJulian Elischer 	m_freem(m_head);
1372167aa833SJulian Elischer 	m_head = m_new;
1373167aa833SJulian Elischer 	f = &c->my_ptr->my_frag[0];
1374167aa833SJulian Elischer 	f->my_status = 0;
1375167aa833SJulian Elischer 	f->my_data = vtophys(mtod(m_new, caddr_t));
1376167aa833SJulian Elischer 	total_len = m_new->m_len;
1377167aa833SJulian Elischer 	f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable;
1378167aa833SJulian Elischer 	f->my_ctl |= total_len << MY_PKTShift;	/* pkt size */
1379167aa833SJulian Elischer 	f->my_ctl |= total_len;	/* buffer size */
13802cc8ce3cSJulian Elischer 	/* 89/12/29 add, for mtd891 *//* [ 89? ] */
1381167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD891ID)
1382167aa833SJulian Elischer 		f->my_ctl |= MY_ETIControl | MY_RetryTxLC;
1383167aa833SJulian Elischer 	c->my_mbuf = m_head;
1384167aa833SJulian Elischer 	c->my_lastdesc = 0;
1385167aa833SJulian Elischer 	MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]);
1386167aa833SJulian Elischer 	return (0);
1387167aa833SJulian Elischer }
1388167aa833SJulian Elischer 
1389167aa833SJulian Elischer /*
1390167aa833SJulian Elischer  * Main transmit routine. To avoid having to do mbuf copies, we put pointers
1391167aa833SJulian Elischer  * to the mbuf data regions directly in the transmit lists. We also save a
1392167aa833SJulian Elischer  * copy of the pointers since the transmit list fragment pointers are
1393167aa833SJulian Elischer  * physical addresses.
1394167aa833SJulian Elischer  */
1395167aa833SJulian Elischer static void
1396167aa833SJulian Elischer my_start(struct ifnet * ifp)
1397167aa833SJulian Elischer {
1398167aa833SJulian Elischer 	struct my_softc *sc;
1399ca5fc32dSJohn Baldwin 
1400ca5fc32dSJohn Baldwin 	sc = ifp->if_softc;
1401ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
1402ca5fc32dSJohn Baldwin 	my_start_locked(ifp);
1403ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1404ca5fc32dSJohn Baldwin }
1405ca5fc32dSJohn Baldwin 
1406ca5fc32dSJohn Baldwin static void
1407ca5fc32dSJohn Baldwin my_start_locked(struct ifnet * ifp)
1408ca5fc32dSJohn Baldwin {
1409ca5fc32dSJohn Baldwin 	struct my_softc *sc;
1410167aa833SJulian Elischer 	struct mbuf    *m_head = NULL;
1411167aa833SJulian Elischer 	struct my_chain *cur_tx = NULL, *start_tx;
1412167aa833SJulian Elischer 
1413167aa833SJulian Elischer 	sc = ifp->if_softc;
1414ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1415167aa833SJulian Elischer 	if (sc->my_autoneg) {
1416167aa833SJulian Elischer 		sc->my_tx_pend = 1;
1417167aa833SJulian Elischer 		return;
1418167aa833SJulian Elischer 	}
1419167aa833SJulian Elischer 	/*
1420167aa833SJulian Elischer 	 * Check for an available queue slot. If there are none, punt.
1421167aa833SJulian Elischer 	 */
1422167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_free->my_mbuf != NULL) {
142313f4c340SRobert Watson 		ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1424167aa833SJulian Elischer 		return;
1425167aa833SJulian Elischer 	}
1426167aa833SJulian Elischer 	start_tx = sc->my_cdata.my_tx_free;
1427167aa833SJulian Elischer 	while (sc->my_cdata.my_tx_free->my_mbuf == NULL) {
14289522f75aSChristian Brueffer 		IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head);
1429167aa833SJulian Elischer 		if (m_head == NULL)
1430167aa833SJulian Elischer 			break;
1431167aa833SJulian Elischer 
1432167aa833SJulian Elischer 		/* Pick a descriptor off the free list. */
1433167aa833SJulian Elischer 		cur_tx = sc->my_cdata.my_tx_free;
1434167aa833SJulian Elischer 		sc->my_cdata.my_tx_free = cur_tx->my_nextdesc;
1435167aa833SJulian Elischer 
1436167aa833SJulian Elischer 		/* Pack the data into the descriptor. */
1437167aa833SJulian Elischer 		my_encap(sc, cur_tx, m_head);
1438167aa833SJulian Elischer 
1439167aa833SJulian Elischer 		if (cur_tx != start_tx)
1440167aa833SJulian Elischer 			MY_TXOWN(cur_tx) = MY_OWNByNIC;
1441167aa833SJulian Elischer #if NBPFILTER > 0
1442167aa833SJulian Elischer 		/*
1443167aa833SJulian Elischer 		 * If there's a BPF listener, bounce a copy of this frame to
1444167aa833SJulian Elischer 		 * him.
1445167aa833SJulian Elischer 		 */
1446673d9191SSam Leffler 		BPF_MTAP(ifp, cur_tx->my_mbuf);
1447167aa833SJulian Elischer #endif
1448167aa833SJulian Elischer 	}
1449167aa833SJulian Elischer 	/*
1450167aa833SJulian Elischer 	 * If there are no packets queued, bail.
1451167aa833SJulian Elischer 	 */
1452167aa833SJulian Elischer 	if (cur_tx == NULL) {
1453167aa833SJulian Elischer 		return;
1454167aa833SJulian Elischer 	}
1455167aa833SJulian Elischer 	/*
1456167aa833SJulian Elischer 	 * Place the request for the upload interrupt in the last descriptor
1457167aa833SJulian Elischer 	 * in the chain. This way, if we're chaining several packets at once,
1458976b0106SKevin Lo 	 * we'll only get an interrupt once for the whole chain rather than
1459167aa833SJulian Elischer 	 * once for each packet.
1460167aa833SJulian Elischer 	 */
1461167aa833SJulian Elischer 	MY_TXCTL(cur_tx) |= MY_TXIC;
1462167aa833SJulian Elischer 	cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC;
1463167aa833SJulian Elischer 	sc->my_cdata.my_tx_tail = cur_tx;
1464167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL)
1465167aa833SJulian Elischer 		sc->my_cdata.my_tx_head = start_tx;
1466167aa833SJulian Elischer 	MY_TXOWN(start_tx) = MY_OWNByNIC;
1467167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);	/* tx polling demand */
1468167aa833SJulian Elischer 
1469167aa833SJulian Elischer 	/*
1470167aa833SJulian Elischer 	 * Set a timeout in case the chip goes out to lunch.
1471167aa833SJulian Elischer 	 */
1472d4e576c4SJohn Baldwin 	sc->my_timer = 5;
1473167aa833SJulian Elischer 	return;
1474167aa833SJulian Elischer }
1475167aa833SJulian Elischer 
1476167aa833SJulian Elischer static void
1477167aa833SJulian Elischer my_init(void *xsc)
1478167aa833SJulian Elischer {
1479167aa833SJulian Elischer 	struct my_softc *sc = xsc;
1480167aa833SJulian Elischer 
1481167aa833SJulian Elischer 	MY_LOCK(sc);
1482ca5fc32dSJohn Baldwin 	my_init_locked(sc);
1483167aa833SJulian Elischer 	MY_UNLOCK(sc);
1484ca5fc32dSJohn Baldwin }
1485ca5fc32dSJohn Baldwin 
1486ca5fc32dSJohn Baldwin static void
1487ca5fc32dSJohn Baldwin my_init_locked(struct my_softc *sc)
1488ca5fc32dSJohn Baldwin {
1489ca5fc32dSJohn Baldwin 	struct ifnet   *ifp = sc->my_ifp;
1490ca5fc32dSJohn Baldwin 	u_int16_t       phy_bmcr = 0;
1491ca5fc32dSJohn Baldwin 
1492ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1493ca5fc32dSJohn Baldwin 	if (sc->my_autoneg) {
1494167aa833SJulian Elischer 		return;
1495167aa833SJulian Elischer 	}
1496167aa833SJulian Elischer 	if (sc->my_pinfo != NULL)
1497167aa833SJulian Elischer 		phy_bmcr = my_phy_readreg(sc, PHY_BMCR);
1498167aa833SJulian Elischer 	/*
1499167aa833SJulian Elischer 	 * Cancel pending I/O and free all RX/TX buffers.
1500167aa833SJulian Elischer 	 */
1501167aa833SJulian Elischer 	my_stop(sc);
1502167aa833SJulian Elischer 	my_reset(sc);
1503167aa833SJulian Elischer 
1504167aa833SJulian Elischer 	/*
1505167aa833SJulian Elischer 	 * Set cache alignment and burst length.
1506167aa833SJulian Elischer 	 */
15070cde2d13SJulian Elischer #if 0				/* 89/9/1 modify,  */
15080cde2d13SJulian Elischer 	CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512);
15090cde2d13SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF);
15100cde2d13SJulian Elischer #endif
1511167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_BCR, MY_PBL8);
1512167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512);
1513167aa833SJulian Elischer 	/*
1514167aa833SJulian Elischer 	 * 89/12/29 add, for mtd891,
1515167aa833SJulian Elischer 	 */
1516167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD891ID) {
1517167aa833SJulian Elischer 		MY_SETBIT(sc, MY_BCR, MY_PROG);
1518167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced);
1519167aa833SJulian Elischer 	}
1520167aa833SJulian Elischer 	my_setcfg(sc, phy_bmcr);
1521167aa833SJulian Elischer 	/* Init circular RX list. */
1522167aa833SJulian Elischer 	if (my_list_rx_init(sc) == ENOBUFS) {
15236b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "init failed: no memory for rx buffers\n");
1524167aa833SJulian Elischer 		my_stop(sc);
1525167aa833SJulian Elischer 		return;
1526167aa833SJulian Elischer 	}
1527167aa833SJulian Elischer 	/* Init TX descriptors. */
1528167aa833SJulian Elischer 	my_list_tx_init(sc);
1529167aa833SJulian Elischer 
1530167aa833SJulian Elischer 	/* If we want promiscuous mode, set the allframes bit. */
1531167aa833SJulian Elischer 	if (ifp->if_flags & IFF_PROMISC)
1532167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PROM);
1533167aa833SJulian Elischer 	else
1534167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_PROM);
1535167aa833SJulian Elischer 
1536167aa833SJulian Elischer 	/*
1537167aa833SJulian Elischer 	 * Set capture broadcast bit to capture broadcast frames.
1538167aa833SJulian Elischer 	 */
1539167aa833SJulian Elischer 	if (ifp->if_flags & IFF_BROADCAST)
1540167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_AB);
1541167aa833SJulian Elischer 	else
1542167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_AB);
1543167aa833SJulian Elischer 
1544167aa833SJulian Elischer 	/*
1545167aa833SJulian Elischer 	 * Program the multicast filter, if necessary.
1546167aa833SJulian Elischer 	 */
1547167aa833SJulian Elischer 	my_setmulti(sc);
1548167aa833SJulian Elischer 
1549167aa833SJulian Elischer 	/*
1550167aa833SJulian Elischer 	 * Load the address of the RX list.
1551167aa833SJulian Elischer 	 */
1552167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_RE);
1553167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0]));
1554167aa833SJulian Elischer 
1555167aa833SJulian Elischer 	/*
1556167aa833SJulian Elischer 	 * Enable interrupts.
1557167aa833SJulian Elischer 	 */
1558167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
1559167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF);
1560167aa833SJulian Elischer 
1561167aa833SJulian Elischer 	/* Enable receiver and transmitter. */
1562167aa833SJulian Elischer 	MY_SETBIT(sc, MY_TCRRCR, MY_RE);
1563167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_TE);
1564167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0]));
1565167aa833SJulian Elischer 	MY_SETBIT(sc, MY_TCRRCR, MY_TE);
1566167aa833SJulian Elischer 
1567167aa833SJulian Elischer 	/* Restore state of BMCR */
1568167aa833SJulian Elischer 	if (sc->my_pinfo != NULL)
1569167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, phy_bmcr);
157013f4c340SRobert Watson 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
157113f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1572d4e576c4SJohn Baldwin 
1573d4e576c4SJohn Baldwin 	callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1574167aa833SJulian Elischer 	return;
1575167aa833SJulian Elischer }
1576167aa833SJulian Elischer 
1577167aa833SJulian Elischer /*
1578167aa833SJulian Elischer  * Set media options.
1579167aa833SJulian Elischer  */
1580167aa833SJulian Elischer 
1581167aa833SJulian Elischer static int
1582167aa833SJulian Elischer my_ifmedia_upd(struct ifnet * ifp)
1583167aa833SJulian Elischer {
1584167aa833SJulian Elischer 	struct my_softc *sc;
1585167aa833SJulian Elischer 	struct ifmedia *ifm;
1586167aa833SJulian Elischer 
1587167aa833SJulian Elischer 	sc = ifp->if_softc;
1588167aa833SJulian Elischer 	MY_LOCK(sc);
1589167aa833SJulian Elischer 	ifm = &sc->ifmedia;
1590167aa833SJulian Elischer 	if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) {
1591167aa833SJulian Elischer 		MY_UNLOCK(sc);
1592167aa833SJulian Elischer 		return (EINVAL);
1593167aa833SJulian Elischer 	}
1594167aa833SJulian Elischer 	if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO)
1595167aa833SJulian Elischer 		my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1596167aa833SJulian Elischer 	else
1597167aa833SJulian Elischer 		my_setmode_mii(sc, ifm->ifm_media);
1598167aa833SJulian Elischer 	MY_UNLOCK(sc);
1599167aa833SJulian Elischer 	return (0);
1600167aa833SJulian Elischer }
1601167aa833SJulian Elischer 
1602167aa833SJulian Elischer /*
1603167aa833SJulian Elischer  * Report current media status.
1604167aa833SJulian Elischer  */
1605167aa833SJulian Elischer 
1606167aa833SJulian Elischer static void
1607167aa833SJulian Elischer my_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr)
1608167aa833SJulian Elischer {
1609167aa833SJulian Elischer 	struct my_softc *sc;
1610167aa833SJulian Elischer 	u_int16_t advert = 0, ability = 0;
1611167aa833SJulian Elischer 
1612167aa833SJulian Elischer 	sc = ifp->if_softc;
1613167aa833SJulian Elischer 	MY_LOCK(sc);
1614167aa833SJulian Elischer 	ifmr->ifm_active = IFM_ETHER;
1615167aa833SJulian Elischer 	if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) {
16160cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
16170cde2d13SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000)
16180cde2d13SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_1000TX;
16190cde2d13SJulian Elischer #endif
1620167aa833SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL)
1621167aa833SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_100_TX;
1622167aa833SJulian Elischer 		else
1623167aa833SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_10_T;
1624167aa833SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX)
1625167aa833SJulian Elischer 			ifmr->ifm_active |= IFM_FDX;
1626167aa833SJulian Elischer 		else
1627167aa833SJulian Elischer 			ifmr->ifm_active |= IFM_HDX;
1628167aa833SJulian Elischer 
1629167aa833SJulian Elischer 		MY_UNLOCK(sc);
1630167aa833SJulian Elischer 		return;
1631167aa833SJulian Elischer 	}
1632167aa833SJulian Elischer 	ability = my_phy_readreg(sc, PHY_LPAR);
1633167aa833SJulian Elischer 	advert = my_phy_readreg(sc, PHY_ANAR);
1634167aa833SJulian Elischer 
16350cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
1636167aa833SJulian Elischer 	if (sc->my_pinfo->my_vid = MarvellPHYID0) {
1637167aa833SJulian Elischer 		ability2 = my_phy_readreg(sc, PHY_1000SR);
1638167aa833SJulian Elischer 		if (ability2 & PHY_1000SR_1000BTXFULL) {
1639167aa833SJulian Elischer 			advert = 0;
1640167aa833SJulian Elischer 			ability = 0;
1641b418ad5cSPoul-Henning Kamp 	  		ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX;
1642167aa833SJulian Elischer 	  	} else if (ability & PHY_1000SR_1000BTXHALF) {
1643167aa833SJulian Elischer 			advert = 0;
1644167aa833SJulian Elischer 			ability = 0;
1645b418ad5cSPoul-Henning Kamp 			ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX;
1646167aa833SJulian Elischer 		}
1647167aa833SJulian Elischer 	}
1648167aa833SJulian Elischer #endif
1649167aa833SJulian Elischer 	if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4)
1650167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_T4;
1651167aa833SJulian Elischer 	else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL)
1652167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX;
1653167aa833SJulian Elischer 	else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF)
1654167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX;
1655167aa833SJulian Elischer 	else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL)
1656167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX;
1657167aa833SJulian Elischer 	else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF)
1658167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX;
1659167aa833SJulian Elischer 	MY_UNLOCK(sc);
1660167aa833SJulian Elischer 	return;
1661167aa833SJulian Elischer }
1662167aa833SJulian Elischer 
1663167aa833SJulian Elischer static int
1664167aa833SJulian Elischer my_ioctl(struct ifnet * ifp, u_long command, caddr_t data)
1665167aa833SJulian Elischer {
1666167aa833SJulian Elischer 	struct my_softc *sc = ifp->if_softc;
1667167aa833SJulian Elischer 	struct ifreq   *ifr = (struct ifreq *) data;
1668ca5fc32dSJohn Baldwin 	int             error;
1669167aa833SJulian Elischer 
1670167aa833SJulian Elischer 	switch (command) {
1671167aa833SJulian Elischer 	case SIOCSIFFLAGS:
1672ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
1673167aa833SJulian Elischer 		if (ifp->if_flags & IFF_UP)
1674ca5fc32dSJohn Baldwin 			my_init_locked(sc);
167513f4c340SRobert Watson 		else if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1676167aa833SJulian Elischer 			my_stop(sc);
1677ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
1678167aa833SJulian Elischer 		error = 0;
1679167aa833SJulian Elischer 		break;
1680167aa833SJulian Elischer 	case SIOCADDMULTI:
1681167aa833SJulian Elischer 	case SIOCDELMULTI:
1682ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
1683167aa833SJulian Elischer 		my_setmulti(sc);
1684ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
1685167aa833SJulian Elischer 		error = 0;
1686167aa833SJulian Elischer 		break;
1687167aa833SJulian Elischer 	case SIOCGIFMEDIA:
1688167aa833SJulian Elischer 	case SIOCSIFMEDIA:
1689167aa833SJulian Elischer 		error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command);
1690167aa833SJulian Elischer 		break;
1691167aa833SJulian Elischer 	default:
1692673d9191SSam Leffler 		error = ether_ioctl(ifp, command, data);
1693167aa833SJulian Elischer 		break;
1694167aa833SJulian Elischer 	}
1695167aa833SJulian Elischer 	return (error);
1696167aa833SJulian Elischer }
1697167aa833SJulian Elischer 
1698167aa833SJulian Elischer static void
1699d4e576c4SJohn Baldwin my_watchdog(void *arg)
1700167aa833SJulian Elischer {
1701167aa833SJulian Elischer 	struct my_softc *sc;
1702d4e576c4SJohn Baldwin 	struct ifnet *ifp;
1703167aa833SJulian Elischer 
1704d4e576c4SJohn Baldwin 	sc = arg;
1705d4e576c4SJohn Baldwin 	MY_LOCK_ASSERT(sc);
1706d4e576c4SJohn Baldwin 	callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1707d4e576c4SJohn Baldwin 	if (sc->my_timer == 0 || --sc->my_timer > 0)
1708167aa833SJulian Elischer 		return;
1709d4e576c4SJohn Baldwin 
1710d4e576c4SJohn Baldwin 	ifp = sc->my_ifp;
1711167aa833SJulian Elischer 	ifp->if_oerrors++;
171212611131SJohn Baldwin 	if_printf(ifp, "watchdog timeout\n");
1713167aa833SJulian Elischer 	if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT))
171412611131SJohn Baldwin 		if_printf(ifp, "no carrier - transceiver cable problem?\n");
1715167aa833SJulian Elischer 	my_stop(sc);
1716167aa833SJulian Elischer 	my_reset(sc);
1717ca5fc32dSJohn Baldwin 	my_init_locked(sc);
17189522f75aSChristian Brueffer 	if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1719ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
1720167aa833SJulian Elischer }
1721167aa833SJulian Elischer 
1722167aa833SJulian Elischer 
1723167aa833SJulian Elischer /*
1724167aa833SJulian Elischer  * Stop the adapter and free any mbufs allocated to the RX and TX lists.
1725167aa833SJulian Elischer  */
1726167aa833SJulian Elischer static void
1727167aa833SJulian Elischer my_stop(struct my_softc * sc)
1728167aa833SJulian Elischer {
1729167aa833SJulian Elischer 	register int    i;
1730167aa833SJulian Elischer 	struct ifnet   *ifp;
1731167aa833SJulian Elischer 
1732ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1733fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1734d4e576c4SJohn Baldwin 
1735d4e576c4SJohn Baldwin 	callout_stop(&sc->my_autoneg_timer);
1736d4e576c4SJohn Baldwin 	callout_stop(&sc->my_watchdog);
1737167aa833SJulian Elischer 
1738167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE));
1739167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1740167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXLBA, 0x00000000);
1741167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_RXLBA, 0x00000000);
1742167aa833SJulian Elischer 
1743167aa833SJulian Elischer 	/*
1744167aa833SJulian Elischer 	 * Free data in the RX lists.
1745167aa833SJulian Elischer 	 */
1746167aa833SJulian Elischer 	for (i = 0; i < MY_RX_LIST_CNT; i++) {
1747167aa833SJulian Elischer 		if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) {
1748167aa833SJulian Elischer 			m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf);
1749167aa833SJulian Elischer 			sc->my_cdata.my_rx_chain[i].my_mbuf = NULL;
1750167aa833SJulian Elischer 		}
1751167aa833SJulian Elischer 	}
1752167aa833SJulian Elischer 	bzero((char *)&sc->my_ldata->my_rx_list,
1753167aa833SJulian Elischer 	    sizeof(sc->my_ldata->my_rx_list));
1754167aa833SJulian Elischer 	/*
1755167aa833SJulian Elischer 	 * Free the TX list buffers.
1756167aa833SJulian Elischer 	 */
1757167aa833SJulian Elischer 	for (i = 0; i < MY_TX_LIST_CNT; i++) {
1758167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) {
1759167aa833SJulian Elischer 			m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf);
1760167aa833SJulian Elischer 			sc->my_cdata.my_tx_chain[i].my_mbuf = NULL;
1761167aa833SJulian Elischer 		}
1762167aa833SJulian Elischer 	}
1763167aa833SJulian Elischer 	bzero((char *)&sc->my_ldata->my_tx_list,
1764167aa833SJulian Elischer 	    sizeof(sc->my_ldata->my_tx_list));
176513f4c340SRobert Watson 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
1766167aa833SJulian Elischer 	return;
1767167aa833SJulian Elischer }
1768167aa833SJulian Elischer 
1769167aa833SJulian Elischer /*
1770167aa833SJulian Elischer  * Stop all chip I/O so that the kernel's probe routines don't get confused
1771167aa833SJulian Elischer  * by errant DMAs when rebooting.
1772167aa833SJulian Elischer  */
1773174ed15eSWarner Losh static int
1774167aa833SJulian Elischer my_shutdown(device_t dev)
1775167aa833SJulian Elischer {
1776167aa833SJulian Elischer 	struct my_softc *sc;
1777167aa833SJulian Elischer 
1778167aa833SJulian Elischer 	sc = device_get_softc(dev);
1779ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
1780167aa833SJulian Elischer 	my_stop(sc);
1781ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1782174ed15eSWarner Losh 	return 0;
1783167aa833SJulian Elischer }
1784