xref: /freebsd/sys/dev/my/if_my.c (revision dde47b55)
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 /*
85167aa833SJulian Elischer  * Various supported device vendors/types and their names.
86167aa833SJulian Elischer  */
87167aa833SJulian Elischer struct my_type *my_info_tmp;
88167aa833SJulian Elischer static struct my_type my_devs[] = {
89167aa833SJulian Elischer 	{MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"},
90167aa833SJulian Elischer 	{MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"},
91167aa833SJulian Elischer 	{MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"},
92167aa833SJulian Elischer 	{0, 0, NULL}
93167aa833SJulian Elischer };
94167aa833SJulian Elischer 
95167aa833SJulian Elischer /*
96167aa833SJulian Elischer  * Various supported PHY vendors/types and their names. Note that this driver
97167aa833SJulian Elischer  * will work with pretty much any MII-compliant PHY, so failure to positively
98167aa833SJulian Elischer  * identify the chip is not a fatal error.
99167aa833SJulian Elischer  */
100167aa833SJulian Elischer static struct my_type my_phys[] = {
101167aa833SJulian Elischer 	{MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"},
102167aa833SJulian Elischer 	{SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"},
103167aa833SJulian Elischer 	{AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"},
104167aa833SJulian Elischer 	{MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"},
105167aa833SJulian Elischer 	{LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"},
106167aa833SJulian Elischer 	{0, 0, "<MII-compliant physical interface>"}
107167aa833SJulian Elischer };
108167aa833SJulian Elischer 
109167aa833SJulian Elischer static int      my_probe(device_t);
110167aa833SJulian Elischer static int      my_attach(device_t);
111167aa833SJulian Elischer static int      my_detach(device_t);
112167aa833SJulian Elischer static int      my_newbuf(struct my_softc *, struct my_chain_onefrag *);
113167aa833SJulian Elischer static int      my_encap(struct my_softc *, struct my_chain *, struct mbuf *);
114167aa833SJulian Elischer static void     my_rxeof(struct my_softc *);
115167aa833SJulian Elischer static void     my_txeof(struct my_softc *);
116167aa833SJulian Elischer static void     my_txeoc(struct my_softc *);
117167aa833SJulian Elischer static void     my_intr(void *);
118167aa833SJulian Elischer static void     my_start(struct ifnet *);
119ca5fc32dSJohn Baldwin static void     my_start_locked(struct ifnet *);
120167aa833SJulian Elischer static int      my_ioctl(struct ifnet *, u_long, caddr_t);
121167aa833SJulian Elischer static void     my_init(void *);
122ca5fc32dSJohn Baldwin static void     my_init_locked(struct my_softc *);
123167aa833SJulian Elischer static void     my_stop(struct my_softc *);
124d4e576c4SJohn Baldwin static void     my_autoneg_timeout(void *);
125d4e576c4SJohn Baldwin static void     my_watchdog(void *);
126174ed15eSWarner Losh static int      my_shutdown(device_t);
127167aa833SJulian Elischer static int      my_ifmedia_upd(struct ifnet *);
128167aa833SJulian Elischer static void     my_ifmedia_sts(struct ifnet *, struct ifmediareq *);
129167aa833SJulian Elischer static u_int16_t my_phy_readreg(struct my_softc *, int);
130167aa833SJulian Elischer static void     my_phy_writereg(struct my_softc *, int, int);
131167aa833SJulian Elischer static void     my_autoneg_xmit(struct my_softc *);
132167aa833SJulian Elischer static void     my_autoneg_mii(struct my_softc *, int, int);
133167aa833SJulian Elischer static void     my_setmode_mii(struct my_softc *, int);
134167aa833SJulian Elischer static void     my_getmode_mii(struct my_softc *);
135167aa833SJulian Elischer static void     my_setcfg(struct my_softc *, int);
136167aa833SJulian Elischer static void     my_setmulti(struct my_softc *);
137167aa833SJulian Elischer static void     my_reset(struct my_softc *);
138167aa833SJulian Elischer static int      my_list_rx_init(struct my_softc *);
139167aa833SJulian Elischer static int      my_list_tx_init(struct my_softc *);
140167aa833SJulian Elischer static long     my_send_cmd_to_phy(struct my_softc *, int, int);
141167aa833SJulian Elischer 
14229f19445SAlfred Perlstein #define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x))
14329f19445SAlfred Perlstein #define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x))
144167aa833SJulian Elischer 
145167aa833SJulian Elischer static device_method_t my_methods[] = {
146167aa833SJulian Elischer 	/* Device interface */
147167aa833SJulian Elischer 	DEVMETHOD(device_probe, my_probe),
148167aa833SJulian Elischer 	DEVMETHOD(device_attach, my_attach),
149167aa833SJulian Elischer 	DEVMETHOD(device_detach, my_detach),
150167aa833SJulian Elischer 	DEVMETHOD(device_shutdown, my_shutdown),
151167aa833SJulian Elischer 
15261bfd867SSofian Brabez 	DEVMETHOD_END
153167aa833SJulian Elischer };
154167aa833SJulian Elischer 
155167aa833SJulian Elischer static driver_t my_driver = {
156167aa833SJulian Elischer 	"my",
157167aa833SJulian Elischer 	my_methods,
158167aa833SJulian Elischer 	sizeof(struct my_softc)
159167aa833SJulian Elischer };
160167aa833SJulian Elischer 
161167aa833SJulian Elischer static devclass_t my_devclass;
162167aa833SJulian Elischer 
163f246e4a1SMatthew N. Dodd DRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0);
164f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, pci, 1, 1, 1);
165f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, ether, 1, 1, 1);
166167aa833SJulian Elischer 
167167aa833SJulian Elischer static long
168167aa833SJulian Elischer my_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad)
169167aa833SJulian Elischer {
170167aa833SJulian Elischer 	long            miir;
171167aa833SJulian Elischer 	int             i;
172167aa833SJulian Elischer 	int             mask, data;
173167aa833SJulian Elischer 
174ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
175167aa833SJulian Elischer 
176167aa833SJulian Elischer 	/* enable MII output */
177167aa833SJulian Elischer 	miir = CSR_READ_4(sc, MY_MANAGEMENT);
178167aa833SJulian Elischer 	miir &= 0xfffffff0;
179167aa833SJulian Elischer 
180167aa833SJulian Elischer 	miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO;
181167aa833SJulian Elischer 
182167aa833SJulian Elischer 	/* send 32 1's preamble */
183167aa833SJulian Elischer 	for (i = 0; i < 32; i++) {
184167aa833SJulian Elischer 		/* low MDC; MDO is already high (miir) */
185167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
186167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
187167aa833SJulian Elischer 
188167aa833SJulian Elischer 		/* high MDC */
189167aa833SJulian Elischer 		miir |= MY_MASK_MIIR_MII_MDC;
190167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
191167aa833SJulian Elischer 	}
192167aa833SJulian Elischer 
193167aa833SJulian Elischer 	/* calculate ST+OP+PHYAD+REGAD+TA */
194167aa833SJulian Elischer 	data = opcode | (sc->my_phy_addr << 7) | (regad << 2);
195167aa833SJulian Elischer 
196167aa833SJulian Elischer 	/* sent out */
197167aa833SJulian Elischer 	mask = 0x8000;
198167aa833SJulian Elischer 	while (mask) {
199167aa833SJulian Elischer 		/* low MDC, prepare MDO */
200167aa833SJulian Elischer 		miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
201167aa833SJulian Elischer 		if (mask & data)
202167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDO;
203167aa833SJulian Elischer 
204167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
205167aa833SJulian Elischer 		/* high MDC */
206167aa833SJulian Elischer 		miir |= MY_MASK_MIIR_MII_MDC;
207167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
208167aa833SJulian Elischer 		DELAY(30);
209167aa833SJulian Elischer 
210167aa833SJulian Elischer 		/* next */
211167aa833SJulian Elischer 		mask >>= 1;
212167aa833SJulian Elischer 		if (mask == 0x2 && opcode == MY_OP_READ)
213167aa833SJulian Elischer 			miir &= ~MY_MASK_MIIR_MII_WRITE;
214167aa833SJulian Elischer 	}
215167aa833SJulian Elischer 
216167aa833SJulian Elischer 	return miir;
217167aa833SJulian Elischer }
218167aa833SJulian Elischer 
219167aa833SJulian Elischer 
220167aa833SJulian Elischer static u_int16_t
221167aa833SJulian Elischer my_phy_readreg(struct my_softc * sc, int reg)
222167aa833SJulian Elischer {
223167aa833SJulian Elischer 	long            miir;
224167aa833SJulian Elischer 	int             mask, data;
225167aa833SJulian Elischer 
226ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
227167aa833SJulian Elischer 
228167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
229167aa833SJulian Elischer 		data = CSR_READ_2(sc, MY_PHYBASE + reg * 2);
230167aa833SJulian Elischer 	else {
231167aa833SJulian Elischer 		miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg);
232167aa833SJulian Elischer 
233167aa833SJulian Elischer 		/* read data */
234167aa833SJulian Elischer 		mask = 0x8000;
235167aa833SJulian Elischer 		data = 0;
236167aa833SJulian Elischer 		while (mask) {
237167aa833SJulian Elischer 			/* low MDC */
238167aa833SJulian Elischer 			miir &= ~MY_MASK_MIIR_MII_MDC;
239167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
240167aa833SJulian Elischer 
241167aa833SJulian Elischer 			/* read MDI */
242167aa833SJulian Elischer 			miir = CSR_READ_4(sc, MY_MANAGEMENT);
243167aa833SJulian Elischer 			if (miir & MY_MASK_MIIR_MII_MDI)
244167aa833SJulian Elischer 				data |= mask;
245167aa833SJulian Elischer 
246167aa833SJulian Elischer 			/* high MDC, and wait */
247167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDC;
248167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
249167aa833SJulian Elischer 			DELAY(30);
250167aa833SJulian Elischer 
251167aa833SJulian Elischer 			/* next */
252167aa833SJulian Elischer 			mask >>= 1;
253167aa833SJulian Elischer 		}
254167aa833SJulian Elischer 
255167aa833SJulian Elischer 		/* low MDC */
256167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
257167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
258167aa833SJulian Elischer 	}
259167aa833SJulian Elischer 
260167aa833SJulian Elischer 	return (u_int16_t) data;
261167aa833SJulian Elischer }
262167aa833SJulian Elischer 
263167aa833SJulian Elischer 
264167aa833SJulian Elischer static void
265167aa833SJulian Elischer my_phy_writereg(struct my_softc * sc, int reg, int data)
266167aa833SJulian Elischer {
267167aa833SJulian Elischer 	long            miir;
268167aa833SJulian Elischer 	int             mask;
269167aa833SJulian Elischer 
270ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
271167aa833SJulian Elischer 
272167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
273167aa833SJulian Elischer 		CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data);
274167aa833SJulian Elischer 	else {
275167aa833SJulian Elischer 		miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg);
276167aa833SJulian Elischer 
277167aa833SJulian Elischer 		/* write data */
278167aa833SJulian Elischer 		mask = 0x8000;
279167aa833SJulian Elischer 		while (mask) {
280167aa833SJulian Elischer 			/* low MDC, prepare MDO */
281167aa833SJulian Elischer 			miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
282167aa833SJulian Elischer 			if (mask & data)
283167aa833SJulian Elischer 				miir |= MY_MASK_MIIR_MII_MDO;
284167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
285167aa833SJulian Elischer 			DELAY(1);
286167aa833SJulian Elischer 
287167aa833SJulian Elischer 			/* high MDC */
288167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDC;
289167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
290167aa833SJulian Elischer 			DELAY(1);
291167aa833SJulian Elischer 
292167aa833SJulian Elischer 			/* next */
293167aa833SJulian Elischer 			mask >>= 1;
294167aa833SJulian Elischer 		}
295167aa833SJulian Elischer 
296167aa833SJulian Elischer 		/* low MDC */
297167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
298167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
299167aa833SJulian Elischer 	}
300167aa833SJulian Elischer 	return;
301167aa833SJulian Elischer }
302167aa833SJulian Elischer 
303167aa833SJulian Elischer 
304167aa833SJulian Elischer /*
305167aa833SJulian Elischer  * Program the 64-bit multicast hash filter.
306167aa833SJulian Elischer  */
307167aa833SJulian Elischer static void
308167aa833SJulian Elischer my_setmulti(struct my_softc * sc)
309167aa833SJulian Elischer {
310167aa833SJulian Elischer 	struct ifnet   *ifp;
311167aa833SJulian Elischer 	int             h = 0;
312167aa833SJulian Elischer 	u_int32_t       hashes[2] = {0, 0};
313167aa833SJulian Elischer 	struct ifmultiaddr *ifma;
314167aa833SJulian Elischer 	u_int32_t       rxfilt;
315167aa833SJulian Elischer 	int             mcnt = 0;
316167aa833SJulian Elischer 
317ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
318167aa833SJulian Elischer 
319fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
320167aa833SJulian Elischer 
321167aa833SJulian Elischer 	rxfilt = CSR_READ_4(sc, MY_TCRRCR);
322167aa833SJulian Elischer 
323167aa833SJulian Elischer 	if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
324167aa833SJulian Elischer 		rxfilt |= MY_AM;
325167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
326167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF);
327167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF);
328167aa833SJulian Elischer 
329167aa833SJulian Elischer 		return;
330167aa833SJulian Elischer 	}
331167aa833SJulian Elischer 	/* first, zot all the existing hash bits */
332167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR0, 0);
333167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR1, 0);
334167aa833SJulian Elischer 
335167aa833SJulian Elischer 	/* now program new ones */
336eb956cd0SRobert Watson 	if_maddr_rlock(ifp);
337167aa833SJulian Elischer 	TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
338167aa833SJulian Elischer 		if (ifma->ifma_addr->sa_family != AF_LINK)
339167aa833SJulian Elischer 			continue;
3400e939c0cSChristian Weisgerber 		h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *)
3410e939c0cSChristian Weisgerber 		    ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
342167aa833SJulian Elischer 		if (h < 32)
343167aa833SJulian Elischer 			hashes[0] |= (1 << h);
344167aa833SJulian Elischer 		else
345167aa833SJulian Elischer 			hashes[1] |= (1 << (h - 32));
346167aa833SJulian Elischer 		mcnt++;
347167aa833SJulian Elischer 	}
348eb956cd0SRobert Watson 	if_maddr_runlock(ifp);
349167aa833SJulian Elischer 
350167aa833SJulian Elischer 	if (mcnt)
351167aa833SJulian Elischer 		rxfilt |= MY_AM;
352167aa833SJulian Elischer 	else
353167aa833SJulian Elischer 		rxfilt &= ~MY_AM;
354167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR0, hashes[0]);
355167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR1, hashes[1]);
356167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
357167aa833SJulian Elischer 	return;
358167aa833SJulian Elischer }
359167aa833SJulian Elischer 
360167aa833SJulian Elischer /*
361167aa833SJulian Elischer  * Initiate an autonegotiation session.
362167aa833SJulian Elischer  */
363167aa833SJulian Elischer static void
364167aa833SJulian Elischer my_autoneg_xmit(struct my_softc * sc)
365167aa833SJulian Elischer {
366167aa833SJulian Elischer 	u_int16_t       phy_sts = 0;
367167aa833SJulian Elischer 
368ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
369167aa833SJulian Elischer 
370167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET);
371167aa833SJulian Elischer 	DELAY(500);
372167aa833SJulian Elischer 	while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET);
373167aa833SJulian Elischer 
374167aa833SJulian Elischer 	phy_sts = my_phy_readreg(sc, PHY_BMCR);
375167aa833SJulian Elischer 	phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR;
376167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, phy_sts);
377167aa833SJulian Elischer 
378167aa833SJulian Elischer 	return;
379167aa833SJulian Elischer }
380167aa833SJulian Elischer 
381d4e576c4SJohn Baldwin static void
382d4e576c4SJohn Baldwin my_autoneg_timeout(void *arg)
383d4e576c4SJohn Baldwin {
384d4e576c4SJohn Baldwin 	struct my_softc *sc;
385d4e576c4SJohn Baldwin 
386d4e576c4SJohn Baldwin 	sc = arg;
387d4e576c4SJohn Baldwin 	MY_LOCK_ASSERT(sc);
388d4e576c4SJohn Baldwin 	my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1);
389d4e576c4SJohn Baldwin }
390167aa833SJulian Elischer 
391167aa833SJulian Elischer /*
392167aa833SJulian Elischer  * Invoke autonegotiation on a PHY.
393167aa833SJulian Elischer  */
394167aa833SJulian Elischer static void
395167aa833SJulian Elischer my_autoneg_mii(struct my_softc * sc, int flag, int verbose)
396167aa833SJulian Elischer {
397167aa833SJulian Elischer 	u_int16_t       phy_sts = 0, media, advert, ability;
398167aa833SJulian Elischer 	u_int16_t       ability2 = 0;
399167aa833SJulian Elischer 	struct ifnet   *ifp;
400167aa833SJulian Elischer 	struct ifmedia *ifm;
401167aa833SJulian Elischer 
402ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
403167aa833SJulian Elischer 
404167aa833SJulian Elischer 	ifm = &sc->ifmedia;
405fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
406167aa833SJulian Elischer 
407167aa833SJulian Elischer 	ifm->ifm_media = IFM_ETHER | IFM_AUTO;
408167aa833SJulian Elischer 
409167aa833SJulian Elischer #ifndef FORCE_AUTONEG_TFOUR
410167aa833SJulian Elischer 	/*
411167aa833SJulian Elischer 	 * First, see if autoneg is supported. If not, there's no point in
412167aa833SJulian Elischer 	 * continuing.
413167aa833SJulian Elischer 	 */
414167aa833SJulian Elischer 	phy_sts = my_phy_readreg(sc, PHY_BMSR);
415167aa833SJulian Elischer 	if (!(phy_sts & PHY_BMSR_CANAUTONEG)) {
416167aa833SJulian Elischer 		if (verbose)
4176b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
4186b9f5c94SGleb Smirnoff 			    "autonegotiation not supported\n");
419167aa833SJulian Elischer 		ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
420167aa833SJulian Elischer 		return;
421167aa833SJulian Elischer 	}
422167aa833SJulian Elischer #endif
423167aa833SJulian Elischer 	switch (flag) {
424167aa833SJulian Elischer 	case MY_FLAG_FORCEDELAY:
425167aa833SJulian Elischer 		/*
426167aa833SJulian Elischer 		 * XXX Never use this option anywhere but in the probe
427167aa833SJulian Elischer 		 * routine: making the kernel stop dead in its tracks for
428167aa833SJulian Elischer 		 * three whole seconds after we've gone multi-user is really
429167aa833SJulian Elischer 		 * bad manners.
430167aa833SJulian Elischer 		 */
431167aa833SJulian Elischer 		my_autoneg_xmit(sc);
432167aa833SJulian Elischer 		DELAY(5000000);
433167aa833SJulian Elischer 		break;
434167aa833SJulian Elischer 	case MY_FLAG_SCHEDDELAY:
435167aa833SJulian Elischer 		/*
436167aa833SJulian Elischer 		 * Wait for the transmitter to go idle before starting an
437167aa833SJulian Elischer 		 * autoneg session, otherwise my_start() may clobber our
438167aa833SJulian Elischer 		 * timeout, and we don't want to allow transmission during an
439167aa833SJulian Elischer 		 * autoneg session since that can screw it up.
440167aa833SJulian Elischer 		 */
441167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_head != NULL) {
442167aa833SJulian Elischer 			sc->my_want_auto = 1;
443167aa833SJulian Elischer 			MY_UNLOCK(sc);
444167aa833SJulian Elischer 			return;
445167aa833SJulian Elischer 		}
446167aa833SJulian Elischer 		my_autoneg_xmit(sc);
447d4e576c4SJohn Baldwin 		callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout,
448d4e576c4SJohn Baldwin 		    sc);
449167aa833SJulian Elischer 		sc->my_autoneg = 1;
450167aa833SJulian Elischer 		sc->my_want_auto = 0;
451167aa833SJulian Elischer 		return;
452167aa833SJulian Elischer 	case MY_FLAG_DELAYTIMEO:
453d4e576c4SJohn Baldwin 		callout_stop(&sc->my_autoneg_timer);
454167aa833SJulian Elischer 		sc->my_autoneg = 0;
455167aa833SJulian Elischer 		break;
456167aa833SJulian Elischer 	default:
4576b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag);
458167aa833SJulian Elischer 		return;
459167aa833SJulian Elischer 	}
460167aa833SJulian Elischer 
461167aa833SJulian Elischer 	if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) {
462167aa833SJulian Elischer 		if (verbose)
4636b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg complete, ");
464167aa833SJulian Elischer 		phy_sts = my_phy_readreg(sc, PHY_BMSR);
465167aa833SJulian Elischer 	} else {
466167aa833SJulian Elischer 		if (verbose)
4676b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg not complete, ");
468167aa833SJulian Elischer 	}
469167aa833SJulian Elischer 
470167aa833SJulian Elischer 	media = my_phy_readreg(sc, PHY_BMCR);
471167aa833SJulian Elischer 
472167aa833SJulian Elischer 	/* Link is good. Report modes and set duplex mode. */
473167aa833SJulian Elischer 	if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) {
474167aa833SJulian Elischer 		if (verbose)
4756b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "link status good. ");
476167aa833SJulian Elischer 		advert = my_phy_readreg(sc, PHY_ANAR);
477167aa833SJulian Elischer 		ability = my_phy_readreg(sc, PHY_LPAR);
478167aa833SJulian Elischer 		if ((sc->my_pinfo->my_vid == MarvellPHYID0) ||
479167aa833SJulian Elischer 		    (sc->my_pinfo->my_vid == LevelOnePHYID0)) {
480167aa833SJulian Elischer 			ability2 = my_phy_readreg(sc, PHY_1000SR);
481167aa833SJulian Elischer 			if (ability2 & PHY_1000SR_1000BTXFULL) {
482167aa833SJulian Elischer 				advert = 0;
483167aa833SJulian Elischer 				ability = 0;
484167aa833SJulian Elischer 				/*
485167aa833SJulian Elischer 				 * this version did not support 1000M,
486167aa833SJulian Elischer 				 * ifm->ifm_media =
487b418ad5cSPoul-Henning Kamp 				 * IFM_ETHER|IFM_1000_T|IFM_FDX;
488167aa833SJulian Elischer 				 */
489167aa833SJulian Elischer 				ifm->ifm_media =
490167aa833SJulian Elischer 				    IFM_ETHER | IFM_100_TX | IFM_FDX;
491167aa833SJulian Elischer 				media &= ~PHY_BMCR_SPEEDSEL;
492167aa833SJulian Elischer 				media |= PHY_BMCR_1000;
493167aa833SJulian Elischer 				media |= PHY_BMCR_DUPLEX;
494167aa833SJulian Elischer 				printf("(full-duplex, 1000Mbps)\n");
495167aa833SJulian Elischer 			} else if (ability2 & PHY_1000SR_1000BTXHALF) {
496167aa833SJulian Elischer 				advert = 0;
497167aa833SJulian Elischer 				ability = 0;
498167aa833SJulian Elischer 				/*
499167aa833SJulian Elischer 				 * this version did not support 1000M,
500b418ad5cSPoul-Henning Kamp 				 * ifm->ifm_media = IFM_ETHER|IFM_1000_T;
501167aa833SJulian Elischer 				 */
502167aa833SJulian Elischer 				ifm->ifm_media = IFM_ETHER | IFM_100_TX;
503167aa833SJulian Elischer 				media &= ~PHY_BMCR_SPEEDSEL;
504167aa833SJulian Elischer 				media &= ~PHY_BMCR_DUPLEX;
505167aa833SJulian Elischer 				media |= PHY_BMCR_1000;
506167aa833SJulian Elischer 				printf("(half-duplex, 1000Mbps)\n");
507167aa833SJulian Elischer 			}
508167aa833SJulian Elischer 		}
509167aa833SJulian Elischer 		if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) {
510167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_T4;
511167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
512167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
513167aa833SJulian Elischer 			printf("(100baseT4)\n");
514167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_100BTXFULL &&
515167aa833SJulian Elischer 			   ability & PHY_ANAR_100BTXFULL) {
516167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
517167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
518167aa833SJulian Elischer 			media |= PHY_BMCR_DUPLEX;
519167aa833SJulian Elischer 			printf("(full-duplex, 100Mbps)\n");
520167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_100BTXHALF &&
521167aa833SJulian Elischer 			   ability & PHY_ANAR_100BTXHALF) {
522167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
523167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
524167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
525167aa833SJulian Elischer 			printf("(half-duplex, 100Mbps)\n");
526167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_10BTFULL &&
527167aa833SJulian Elischer 			   ability & PHY_ANAR_10BTFULL) {
528167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
529167aa833SJulian Elischer 			media &= ~PHY_BMCR_SPEEDSEL;
530167aa833SJulian Elischer 			media |= PHY_BMCR_DUPLEX;
531167aa833SJulian Elischer 			printf("(full-duplex, 10Mbps)\n");
532167aa833SJulian Elischer 		} else if (advert) {
533167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
534167aa833SJulian Elischer 			media &= ~PHY_BMCR_SPEEDSEL;
535167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
536167aa833SJulian Elischer 			printf("(half-duplex, 10Mbps)\n");
537167aa833SJulian Elischer 		}
538167aa833SJulian Elischer 		media &= ~PHY_BMCR_AUTONEGENBL;
539167aa833SJulian Elischer 
540167aa833SJulian Elischer 		/* Set ASIC's duplex mode to match the PHY. */
541167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, media);
542167aa833SJulian Elischer 		my_setcfg(sc, media);
543167aa833SJulian Elischer 	} else {
544167aa833SJulian Elischer 		if (verbose)
5456b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "no carrier\n");
546167aa833SJulian Elischer 	}
547167aa833SJulian Elischer 
548ca5fc32dSJohn Baldwin 	my_init_locked(sc);
549167aa833SJulian Elischer 	if (sc->my_tx_pend) {
550167aa833SJulian Elischer 		sc->my_autoneg = 0;
551167aa833SJulian Elischer 		sc->my_tx_pend = 0;
552ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
553167aa833SJulian Elischer 	}
554167aa833SJulian Elischer 	return;
555167aa833SJulian Elischer }
556167aa833SJulian Elischer 
557167aa833SJulian Elischer /*
558167aa833SJulian Elischer  * To get PHY ability.
559167aa833SJulian Elischer  */
560167aa833SJulian Elischer static void
561167aa833SJulian Elischer my_getmode_mii(struct my_softc * sc)
562167aa833SJulian Elischer {
563167aa833SJulian Elischer 	u_int16_t       bmsr;
564167aa833SJulian Elischer 	struct ifnet   *ifp;
565167aa833SJulian Elischer 
566ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
567fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
568167aa833SJulian Elischer 	bmsr = my_phy_readreg(sc, PHY_BMSR);
569167aa833SJulian Elischer 	if (bootverbose)
5706b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "PHY status word: %x\n", bmsr);
571167aa833SJulian Elischer 
572167aa833SJulian Elischer 	/* fallback */
573167aa833SJulian Elischer 	sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
574167aa833SJulian Elischer 
575167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_10BTHALF) {
576167aa833SJulian Elischer 		if (bootverbose)
5776b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5786b9f5c94SGleb Smirnoff 			    "10Mbps half-duplex mode supported\n");
579167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX,
580167aa833SJulian Elischer 		    0, NULL);
581167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL);
582167aa833SJulian Elischer 	}
583167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_10BTFULL) {
584167aa833SJulian Elischer 		if (bootverbose)
5856b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5866b9f5c94SGleb Smirnoff 			    "10Mbps full-duplex mode supported\n");
587167aa833SJulian Elischer 
588167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX,
589167aa833SJulian Elischer 		    0, NULL);
590167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
591167aa833SJulian Elischer 	}
592167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BTXHALF) {
593167aa833SJulian Elischer 		if (bootverbose)
5946b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5956b9f5c94SGleb Smirnoff 			    "100Mbps half-duplex mode supported\n");
596167aa833SJulian Elischer 		ifp->if_baudrate = 100000000;
597167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL);
598167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX,
599167aa833SJulian Elischer 			    0, NULL);
600167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
601167aa833SJulian Elischer 	}
602167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BTXFULL) {
603167aa833SJulian Elischer 		if (bootverbose)
6046b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6056b9f5c94SGleb Smirnoff 			    "100Mbps full-duplex mode supported\n");
606167aa833SJulian Elischer 		ifp->if_baudrate = 100000000;
607167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX,
608167aa833SJulian Elischer 		    0, NULL);
609167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
610167aa833SJulian Elischer 	}
611167aa833SJulian Elischer 	/* Some also support 100BaseT4. */
612167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BT4) {
613167aa833SJulian Elischer 		if (bootverbose)
6146b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "100baseT4 mode supported\n");
615167aa833SJulian Elischer 		ifp->if_baudrate = 100000000;
616167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL);
617167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4;
618167aa833SJulian Elischer #ifdef FORCE_AUTONEG_TFOUR
619167aa833SJulian Elischer 		if (bootverbose)
6206b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6216b9f5c94SGleb Smirnoff 			    "forcing on autoneg support for BT4\n");
622167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL):
623167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
624167aa833SJulian Elischer #endif
625167aa833SJulian Elischer 	}
6260cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
627167aa833SJulian Elischer 	if (sc->my_pinfo->my_vid == MarvellPHYID0) {
628167aa833SJulian Elischer 		if (bootverbose)
6296b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6306b9f5c94SGleb Smirnoff 			    "1000Mbps half-duplex mode supported\n");
631167aa833SJulian Elischer 
632167aa833SJulian Elischer 		ifp->if_baudrate = 1000000000;
633b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL);
634b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX,
635167aa833SJulian Elischer 		    0, NULL);
636167aa833SJulian Elischer 		if (bootverbose)
6376b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6386b9f5c94SGleb Smirnoff 			    "1000Mbps full-duplex mode supported\n");
639167aa833SJulian Elischer 		ifp->if_baudrate = 1000000000;
640b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX,
641167aa833SJulian Elischer 		    0, NULL);
642b418ad5cSPoul-Henning Kamp 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX;
643167aa833SJulian Elischer 	}
644167aa833SJulian Elischer #endif
645167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_CANAUTONEG) {
646167aa833SJulian Elischer 		if (bootverbose)
6476b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg supported\n");
648167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL);
649167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
650167aa833SJulian Elischer 	}
651167aa833SJulian Elischer 	return;
652167aa833SJulian Elischer }
653167aa833SJulian Elischer 
654167aa833SJulian Elischer /*
655167aa833SJulian Elischer  * Set speed and duplex mode.
656167aa833SJulian Elischer  */
657167aa833SJulian Elischer static void
658167aa833SJulian Elischer my_setmode_mii(struct my_softc * sc, int media)
659167aa833SJulian Elischer {
660167aa833SJulian Elischer 	u_int16_t       bmcr;
661167aa833SJulian Elischer 
662ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
663167aa833SJulian Elischer 	/*
664167aa833SJulian Elischer 	 * If an autoneg session is in progress, stop it.
665167aa833SJulian Elischer 	 */
666167aa833SJulian Elischer 	if (sc->my_autoneg) {
6676b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "canceling autoneg session\n");
668d4e576c4SJohn Baldwin 		callout_stop(&sc->my_autoneg_timer);
669d4e576c4SJohn Baldwin 		sc->my_autoneg = sc->my_want_auto = 0;
670167aa833SJulian Elischer 		bmcr = my_phy_readreg(sc, PHY_BMCR);
671167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_AUTONEGENBL;
672167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, bmcr);
673167aa833SJulian Elischer 	}
6746b9f5c94SGleb Smirnoff 	device_printf(sc->my_dev, "selecting MII, ");
675167aa833SJulian Elischer 	bmcr = my_phy_readreg(sc, PHY_BMCR);
676167aa833SJulian Elischer 	bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 |
677167aa833SJulian Elischer 		  PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK);
6780cde2d13SJulian Elischer 
6790cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
680b418ad5cSPoul-Henning Kamp 	if (IFM_SUBTYPE(media) == IFM_1000_T) {
681167aa833SJulian Elischer 		printf("1000Mbps/T4, half-duplex\n");
682167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_SPEEDSEL;
683167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
684167aa833SJulian Elischer 		bmcr |= PHY_BMCR_1000;
685167aa833SJulian Elischer 	}
686167aa833SJulian Elischer #endif
687167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_100_T4) {
688167aa833SJulian Elischer 		printf("100Mbps/T4, half-duplex\n");
689167aa833SJulian Elischer 		bmcr |= PHY_BMCR_SPEEDSEL;
690167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
691167aa833SJulian Elischer 	}
692167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_100_TX) {
693167aa833SJulian Elischer 		printf("100Mbps, ");
694167aa833SJulian Elischer 		bmcr |= PHY_BMCR_SPEEDSEL;
695167aa833SJulian Elischer 	}
696167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_10_T) {
697167aa833SJulian Elischer 		printf("10Mbps, ");
698167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_SPEEDSEL;
699167aa833SJulian Elischer 	}
700167aa833SJulian Elischer 	if ((media & IFM_GMASK) == IFM_FDX) {
701167aa833SJulian Elischer 		printf("full duplex\n");
702167aa833SJulian Elischer 		bmcr |= PHY_BMCR_DUPLEX;
703167aa833SJulian Elischer 	} else {
704167aa833SJulian Elischer 		printf("half duplex\n");
705167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
706167aa833SJulian Elischer 	}
707167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, bmcr);
708167aa833SJulian Elischer 	my_setcfg(sc, bmcr);
709167aa833SJulian Elischer 	return;
710167aa833SJulian Elischer }
711167aa833SJulian Elischer 
712167aa833SJulian Elischer /*
713167aa833SJulian Elischer  * The Myson manual states that in order to fiddle with the 'full-duplex' and
714167aa833SJulian Elischer  * '100Mbps' bits in the netconfig register, we first have to put the
715167aa833SJulian Elischer  * transmit and/or receive logic in the idle state.
716167aa833SJulian Elischer  */
717167aa833SJulian Elischer static void
718167aa833SJulian Elischer my_setcfg(struct my_softc * sc, int bmcr)
719167aa833SJulian Elischer {
720167aa833SJulian Elischer 	int             i, restart = 0;
721167aa833SJulian Elischer 
722ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
723167aa833SJulian Elischer 	if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) {
724167aa833SJulian Elischer 		restart = 1;
725167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE));
726167aa833SJulian Elischer 		for (i = 0; i < MY_TIMEOUT; i++) {
727167aa833SJulian Elischer 			DELAY(10);
728167aa833SJulian Elischer 			if (!(CSR_READ_4(sc, MY_TCRRCR) &
729167aa833SJulian Elischer 			    (MY_TXRUN | MY_RXRUN)))
730167aa833SJulian Elischer 				break;
731167aa833SJulian Elischer 		}
732167aa833SJulian Elischer 		if (i == MY_TIMEOUT)
7336b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
73412611131SJohn Baldwin 			    "failed to force tx and rx to idle \n");
735167aa833SJulian Elischer 	}
736167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000);
737167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_PS10);
738167aa833SJulian Elischer 	if (bmcr & PHY_BMCR_1000)
739167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PS1000);
740167aa833SJulian Elischer 	else if (!(bmcr & PHY_BMCR_SPEEDSEL))
741167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PS10);
742167aa833SJulian Elischer 	if (bmcr & PHY_BMCR_DUPLEX)
743167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_FD);
744167aa833SJulian Elischer 	else
745167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_FD);
746167aa833SJulian Elischer 	if (restart)
747167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE);
748167aa833SJulian Elischer 	return;
749167aa833SJulian Elischer }
750167aa833SJulian Elischer 
751167aa833SJulian Elischer static void
752167aa833SJulian Elischer my_reset(struct my_softc * sc)
753167aa833SJulian Elischer {
754167aa833SJulian Elischer 	register int    i;
755167aa833SJulian Elischer 
756ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
757167aa833SJulian Elischer 	MY_SETBIT(sc, MY_BCR, MY_SWR);
758167aa833SJulian Elischer 	for (i = 0; i < MY_TIMEOUT; i++) {
759167aa833SJulian Elischer 		DELAY(10);
760167aa833SJulian Elischer 		if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR))
761167aa833SJulian Elischer 			break;
762167aa833SJulian Elischer 	}
763167aa833SJulian Elischer 	if (i == MY_TIMEOUT)
7646b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "reset never completed!\n");
765167aa833SJulian Elischer 
766167aa833SJulian Elischer 	/* Wait a little while for the chip to get its brains in order. */
767167aa833SJulian Elischer 	DELAY(1000);
768167aa833SJulian Elischer 	return;
769167aa833SJulian Elischer }
770167aa833SJulian Elischer 
771167aa833SJulian Elischer /*
772167aa833SJulian Elischer  * Probe for a Myson chip. Check the PCI vendor and device IDs against our
773167aa833SJulian Elischer  * list and return a device name if we find a match.
774167aa833SJulian Elischer  */
775167aa833SJulian Elischer static int
776167aa833SJulian Elischer my_probe(device_t dev)
777167aa833SJulian Elischer {
778167aa833SJulian Elischer 	struct my_type *t;
779167aa833SJulian Elischer 
780167aa833SJulian Elischer 	t = my_devs;
781167aa833SJulian Elischer 	while (t->my_name != NULL) {
782167aa833SJulian Elischer 		if ((pci_get_vendor(dev) == t->my_vid) &&
783167aa833SJulian Elischer 		    (pci_get_device(dev) == t->my_did)) {
784167aa833SJulian Elischer 			device_set_desc(dev, t->my_name);
785167aa833SJulian Elischer 			my_info_tmp = t;
7866b9907e7SWarner Losh 			return (BUS_PROBE_DEFAULT);
787167aa833SJulian Elischer 		}
788167aa833SJulian Elischer 		t++;
789167aa833SJulian Elischer 	}
790167aa833SJulian Elischer 	return (ENXIO);
791167aa833SJulian Elischer }
792167aa833SJulian Elischer 
793167aa833SJulian Elischer /*
794167aa833SJulian Elischer  * Attach the interface. Allocate softc structures, do ifmedia setup and
795167aa833SJulian Elischer  * ethernet/BPF attach.
796167aa833SJulian Elischer  */
797167aa833SJulian Elischer static int
798167aa833SJulian Elischer my_attach(device_t dev)
799167aa833SJulian Elischer {
800ca5fc32dSJohn Baldwin 	int             i;
801167aa833SJulian Elischer 	u_char          eaddr[ETHER_ADDR_LEN];
802bd295e68SJohn Baldwin 	u_int32_t       iobase;
803167aa833SJulian Elischer 	struct my_softc *sc;
804167aa833SJulian Elischer 	struct ifnet   *ifp;
805167aa833SJulian Elischer 	int             media = IFM_ETHER | IFM_100_TX | IFM_FDX;
806167aa833SJulian Elischer 	unsigned int    round;
807167aa833SJulian Elischer 	caddr_t         roundptr;
808167aa833SJulian Elischer 	struct my_type *p;
809167aa833SJulian Elischer 	u_int16_t       phy_vid, phy_did, phy_sts = 0;
81012611131SJohn Baldwin 	int             rid, error = 0;
811167aa833SJulian Elischer 
812167aa833SJulian Elischer 	sc = device_get_softc(dev);
8136b9f5c94SGleb Smirnoff 	sc->my_dev = dev;
814f269532cSJulian Elischer 	mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
815ca5fc32dSJohn Baldwin 	    MTX_DEF);
816d4e576c4SJohn Baldwin 	callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0);
817d4e576c4SJohn Baldwin 	callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0);
818167aa833SJulian Elischer 
819167aa833SJulian Elischer 	/*
820167aa833SJulian Elischer 	 * Map control/status registers.
821167aa833SJulian Elischer 	 */
822bd295e68SJohn Baldwin 	pci_enable_busmaster(dev);
823167aa833SJulian Elischer 
824167aa833SJulian Elischer 	if (my_info_tmp->my_did == MTD800ID) {
825167aa833SJulian Elischer 		iobase = pci_read_config(dev, MY_PCI_LOIO, 4);
826167aa833SJulian Elischer 		if (iobase & 0x300)
827167aa833SJulian Elischer 			MY_USEIOSPACE = 0;
828167aa833SJulian Elischer 	}
829167aa833SJulian Elischer 
830167aa833SJulian Elischer 	rid = MY_RID;
8315f96beb9SNate Lawson 	sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE);
832167aa833SJulian Elischer 
833167aa833SJulian Elischer 	if (sc->my_res == NULL) {
83412611131SJohn Baldwin 		device_printf(dev, "couldn't map ports/memory\n");
835167aa833SJulian Elischer 		error = ENXIO;
836ca5fc32dSJohn Baldwin 		goto destroy_mutex;
837167aa833SJulian Elischer 	}
838167aa833SJulian Elischer 	sc->my_btag = rman_get_bustag(sc->my_res);
839167aa833SJulian Elischer 	sc->my_bhandle = rman_get_bushandle(sc->my_res);
840167aa833SJulian Elischer 
841167aa833SJulian Elischer 	rid = 0;
8425f96beb9SNate Lawson 	sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
843167aa833SJulian Elischer 					    RF_SHAREABLE | RF_ACTIVE);
844167aa833SJulian Elischer 
845167aa833SJulian Elischer 	if (sc->my_irq == NULL) {
84612611131SJohn Baldwin 		device_printf(dev, "couldn't map interrupt\n");
847167aa833SJulian Elischer 		error = ENXIO;
848ca5fc32dSJohn Baldwin 		goto release_io;
849167aa833SJulian Elischer 	}
850167aa833SJulian Elischer 
851167aa833SJulian Elischer 	sc->my_info = my_info_tmp;
852167aa833SJulian Elischer 
853167aa833SJulian Elischer 	/* Reset the adapter. */
854ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
855167aa833SJulian Elischer 	my_reset(sc);
856ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
857167aa833SJulian Elischer 
858167aa833SJulian Elischer 	/*
859167aa833SJulian Elischer 	 * Get station address
860167aa833SJulian Elischer 	 */
861167aa833SJulian Elischer 	for (i = 0; i < ETHER_ADDR_LEN; ++i)
862167aa833SJulian Elischer 		eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i);
863167aa833SJulian Elischer 
864167aa833SJulian Elischer 	sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8,
865167aa833SJulian Elischer 				  M_DEVBUF, M_NOWAIT);
866167aa833SJulian Elischer 	if (sc->my_ldata_ptr == NULL) {
86712611131SJohn Baldwin 		device_printf(dev, "no memory for list buffers!\n");
868167aa833SJulian Elischer 		error = ENXIO;
869ca5fc32dSJohn Baldwin 		goto release_irq;
870167aa833SJulian Elischer 	}
871167aa833SJulian Elischer 	sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr;
8722fc606e2SJohn Baldwin 	round = (uintptr_t)sc->my_ldata_ptr & 0xF;
873167aa833SJulian Elischer 	roundptr = sc->my_ldata_ptr;
874167aa833SJulian Elischer 	for (i = 0; i < 8; i++) {
875167aa833SJulian Elischer 		if (round % 8) {
876167aa833SJulian Elischer 			round++;
877167aa833SJulian Elischer 			roundptr++;
878167aa833SJulian Elischer 		} else
879167aa833SJulian Elischer 			break;
880167aa833SJulian Elischer 	}
881167aa833SJulian Elischer 	sc->my_ldata = (struct my_list_data *) roundptr;
882167aa833SJulian Elischer 	bzero(sc->my_ldata, sizeof(struct my_list_data));
883167aa833SJulian Elischer 
884fc74a9f9SBrooks Davis 	ifp = sc->my_ifp = if_alloc(IFT_ETHER);
885fc74a9f9SBrooks Davis 	if (ifp == NULL) {
886fc74a9f9SBrooks Davis 		device_printf(dev, "can not if_alloc()\n");
887fc74a9f9SBrooks Davis 		error = ENOSPC;
888ca5fc32dSJohn Baldwin 		goto free_ldata;
889fc74a9f9SBrooks Davis 	}
890167aa833SJulian Elischer 	ifp->if_softc = sc;
8919bf40edeSBrooks Davis 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
892167aa833SJulian Elischer 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
893167aa833SJulian Elischer 	ifp->if_ioctl = my_ioctl;
894167aa833SJulian Elischer 	ifp->if_start = my_start;
895167aa833SJulian Elischer 	ifp->if_init = my_init;
896167aa833SJulian Elischer 	ifp->if_baudrate = 10000000;
897e50d35e6SMaxim Sobolev 	IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
898e50d35e6SMaxim Sobolev 	ifp->if_snd.ifq_drv_maxlen = ifqmaxlen;
8999522f75aSChristian Brueffer 	IFQ_SET_READY(&ifp->if_snd);
900167aa833SJulian Elischer 
901167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
902167aa833SJulian Elischer 		sc->my_pinfo = my_phys;
903167aa833SJulian Elischer 	else {
904167aa833SJulian Elischer 		if (bootverbose)
90512611131SJohn Baldwin 			device_printf(dev, "probing for a PHY\n");
906ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
907167aa833SJulian Elischer 		for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) {
908167aa833SJulian Elischer 			if (bootverbose)
90912611131SJohn Baldwin 				device_printf(dev, "checking address: %d\n", i);
910167aa833SJulian Elischer 			sc->my_phy_addr = i;
911167aa833SJulian Elischer 			phy_sts = my_phy_readreg(sc, PHY_BMSR);
912167aa833SJulian Elischer 			if ((phy_sts != 0) && (phy_sts != 0xffff))
913167aa833SJulian Elischer 				break;
914167aa833SJulian Elischer 			else
915167aa833SJulian Elischer 				phy_sts = 0;
916167aa833SJulian Elischer 		}
917167aa833SJulian Elischer 		if (phy_sts) {
918167aa833SJulian Elischer 			phy_vid = my_phy_readreg(sc, PHY_VENID);
919167aa833SJulian Elischer 			phy_did = my_phy_readreg(sc, PHY_DEVID);
920167aa833SJulian Elischer 			if (bootverbose) {
92112611131SJohn Baldwin 				device_printf(dev, "found PHY at address %d, ",
92212611131SJohn Baldwin 				    sc->my_phy_addr);
923167aa833SJulian Elischer 				printf("vendor id: %x device id: %x\n",
924167aa833SJulian Elischer 				    phy_vid, phy_did);
925167aa833SJulian Elischer 			}
926167aa833SJulian Elischer 			p = my_phys;
927167aa833SJulian Elischer 			while (p->my_vid) {
928167aa833SJulian Elischer 				if (phy_vid == p->my_vid) {
929167aa833SJulian Elischer 					sc->my_pinfo = p;
930167aa833SJulian Elischer 					break;
931167aa833SJulian Elischer 				}
932167aa833SJulian Elischer 				p++;
933167aa833SJulian Elischer 			}
934167aa833SJulian Elischer 			if (sc->my_pinfo == NULL)
935167aa833SJulian Elischer 				sc->my_pinfo = &my_phys[PHY_UNKNOWN];
936167aa833SJulian Elischer 			if (bootverbose)
93712611131SJohn Baldwin 				device_printf(dev, "PHY type: %s\n",
93812611131SJohn Baldwin 				       sc->my_pinfo->my_name);
939167aa833SJulian Elischer 		} else {
940ca5fc32dSJohn Baldwin 			MY_UNLOCK(sc);
94112611131SJohn Baldwin 			device_printf(dev, "MII without any phy!\n");
942167aa833SJulian Elischer 			error = ENXIO;
943ca5fc32dSJohn Baldwin 			goto free_if;
944167aa833SJulian Elischer 		}
945ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
946167aa833SJulian Elischer 	}
947167aa833SJulian Elischer 
948167aa833SJulian Elischer 	/* Do ifmedia setup. */
949167aa833SJulian Elischer 	ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts);
950ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
951167aa833SJulian Elischer 	my_getmode_mii(sc);
952167aa833SJulian Elischer 	my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1);
953167aa833SJulian Elischer 	media = sc->ifmedia.ifm_media;
954167aa833SJulian Elischer 	my_stop(sc);
955ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
956167aa833SJulian Elischer 	ifmedia_set(&sc->ifmedia, media);
957167aa833SJulian Elischer 
958673d9191SSam Leffler 	ether_ifattach(ifp, eaddr);
959167aa833SJulian Elischer 
960ca5fc32dSJohn Baldwin 	error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE,
961ef544f63SPaolo Pisati 			       NULL, my_intr, sc, &sc->my_intrhand);
962ca5fc32dSJohn Baldwin 
963ca5fc32dSJohn Baldwin 	if (error) {
964ca5fc32dSJohn Baldwin 		device_printf(dev, "couldn't set up irq\n");
965ca5fc32dSJohn Baldwin 		goto detach_if;
966ca5fc32dSJohn Baldwin 	}
967ca5fc32dSJohn Baldwin 
968167aa833SJulian Elischer 	return (0);
969167aa833SJulian Elischer 
970ca5fc32dSJohn Baldwin detach_if:
971ca5fc32dSJohn Baldwin 	ether_ifdetach(ifp);
972ca5fc32dSJohn Baldwin free_if:
973ca5fc32dSJohn Baldwin 	if_free(ifp);
974ca5fc32dSJohn Baldwin free_ldata:
975fc74a9f9SBrooks Davis 	free(sc->my_ldata_ptr, M_DEVBUF);
976ca5fc32dSJohn Baldwin release_irq:
977ca5fc32dSJohn Baldwin 	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
978ca5fc32dSJohn Baldwin release_io:
979ca5fc32dSJohn Baldwin 	bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
980ca5fc32dSJohn Baldwin destroy_mutex:
981ca5fc32dSJohn Baldwin 	mtx_destroy(&sc->my_mtx);
982167aa833SJulian Elischer 	return (error);
983167aa833SJulian Elischer }
984167aa833SJulian Elischer 
985167aa833SJulian Elischer static int
986167aa833SJulian Elischer my_detach(device_t dev)
987167aa833SJulian Elischer {
988167aa833SJulian Elischer 	struct my_softc *sc;
989167aa833SJulian Elischer 	struct ifnet   *ifp;
990167aa833SJulian Elischer 
991167aa833SJulian Elischer 	sc = device_get_softc(dev);
992d4e576c4SJohn Baldwin 	ifp = sc->my_ifp;
993d4e576c4SJohn Baldwin 	ether_ifdetach(ifp);
994167aa833SJulian Elischer 	MY_LOCK(sc);
995ca5fc32dSJohn Baldwin 	my_stop(sc);
996ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
997ca5fc32dSJohn Baldwin 	bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand);
998d4e576c4SJohn Baldwin 	callout_drain(&sc->my_watchdog);
999d4e576c4SJohn Baldwin 	callout_drain(&sc->my_autoneg_timer);
1000ca5fc32dSJohn Baldwin 
1001fc74a9f9SBrooks Davis 	if_free(ifp);
1002ca5fc32dSJohn Baldwin 	free(sc->my_ldata_ptr, M_DEVBUF);
1003167aa833SJulian Elischer 
1004167aa833SJulian Elischer 	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
1005167aa833SJulian Elischer 	bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
1006167aa833SJulian Elischer 	mtx_destroy(&sc->my_mtx);
1007167aa833SJulian Elischer 	return (0);
1008167aa833SJulian Elischer }
1009167aa833SJulian Elischer 
1010167aa833SJulian Elischer 
1011167aa833SJulian Elischer /*
1012167aa833SJulian Elischer  * Initialize the transmit descriptors.
1013167aa833SJulian Elischer  */
1014167aa833SJulian Elischer static int
1015167aa833SJulian Elischer my_list_tx_init(struct my_softc * sc)
1016167aa833SJulian Elischer {
1017167aa833SJulian Elischer 	struct my_chain_data *cd;
1018167aa833SJulian Elischer 	struct my_list_data *ld;
1019167aa833SJulian Elischer 	int             i;
1020167aa833SJulian Elischer 
1021ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1022167aa833SJulian Elischer 	cd = &sc->my_cdata;
1023167aa833SJulian Elischer 	ld = sc->my_ldata;
1024167aa833SJulian Elischer 	for (i = 0; i < MY_TX_LIST_CNT; i++) {
1025167aa833SJulian Elischer 		cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i];
1026167aa833SJulian Elischer 		if (i == (MY_TX_LIST_CNT - 1))
1027167aa833SJulian Elischer 			cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0];
1028167aa833SJulian Elischer 		else
1029167aa833SJulian Elischer 			cd->my_tx_chain[i].my_nextdesc =
1030167aa833SJulian Elischer 			    &cd->my_tx_chain[i + 1];
1031167aa833SJulian Elischer 	}
1032167aa833SJulian Elischer 	cd->my_tx_free = &cd->my_tx_chain[0];
1033167aa833SJulian Elischer 	cd->my_tx_tail = cd->my_tx_head = NULL;
1034167aa833SJulian Elischer 	return (0);
1035167aa833SJulian Elischer }
1036167aa833SJulian Elischer 
1037167aa833SJulian Elischer /*
1038167aa833SJulian Elischer  * Initialize the RX descriptors and allocate mbufs for them. Note that we
1039167aa833SJulian Elischer  * arrange the descriptors in a closed ring, so that the last descriptor
1040167aa833SJulian Elischer  * points back to the first.
1041167aa833SJulian Elischer  */
1042167aa833SJulian Elischer static int
1043167aa833SJulian Elischer my_list_rx_init(struct my_softc * sc)
1044167aa833SJulian Elischer {
1045167aa833SJulian Elischer 	struct my_chain_data *cd;
1046167aa833SJulian Elischer 	struct my_list_data *ld;
1047167aa833SJulian Elischer 	int             i;
1048167aa833SJulian Elischer 
1049ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1050167aa833SJulian Elischer 	cd = &sc->my_cdata;
1051167aa833SJulian Elischer 	ld = sc->my_ldata;
1052167aa833SJulian Elischer 	for (i = 0; i < MY_RX_LIST_CNT; i++) {
1053167aa833SJulian Elischer 		cd->my_rx_chain[i].my_ptr =
1054167aa833SJulian Elischer 		    (struct my_desc *) & ld->my_rx_list[i];
1055a86d27acSJulian Elischer 		if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) {
1056a86d27acSJulian Elischer 			MY_UNLOCK(sc);
1057167aa833SJulian Elischer 			return (ENOBUFS);
1058a86d27acSJulian Elischer 		}
1059167aa833SJulian Elischer 		if (i == (MY_RX_LIST_CNT - 1)) {
1060167aa833SJulian Elischer 			cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0];
1061167aa833SJulian Elischer 			ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]);
1062167aa833SJulian Elischer 		} else {
1063167aa833SJulian Elischer 			cd->my_rx_chain[i].my_nextdesc =
1064167aa833SJulian Elischer 			    &cd->my_rx_chain[i + 1];
1065167aa833SJulian Elischer 			ld->my_rx_list[i].my_next =
1066167aa833SJulian Elischer 			    vtophys(&ld->my_rx_list[i + 1]);
1067167aa833SJulian Elischer 		}
1068167aa833SJulian Elischer 	}
1069167aa833SJulian Elischer 	cd->my_rx_head = &cd->my_rx_chain[0];
1070167aa833SJulian Elischer 	return (0);
1071167aa833SJulian Elischer }
1072167aa833SJulian Elischer 
1073167aa833SJulian Elischer /*
1074167aa833SJulian Elischer  * Initialize an RX descriptor and attach an MBUF cluster.
1075167aa833SJulian Elischer  */
1076167aa833SJulian Elischer static int
1077167aa833SJulian Elischer my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c)
1078167aa833SJulian Elischer {
1079167aa833SJulian Elischer 	struct mbuf    *m_new = NULL;
1080167aa833SJulian Elischer 
1081ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1082c6499eccSGleb Smirnoff 	MGETHDR(m_new, M_NOWAIT, MT_DATA);
1083167aa833SJulian Elischer 	if (m_new == NULL) {
10846b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev,
108512611131SJohn Baldwin 		    "no memory for rx list -- packet dropped!\n");
1086167aa833SJulian Elischer 		return (ENOBUFS);
1087167aa833SJulian Elischer 	}
1088c6499eccSGleb Smirnoff 	MCLGET(m_new, M_NOWAIT);
1089167aa833SJulian Elischer 	if (!(m_new->m_flags & M_EXT)) {
10906b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev,
109112611131SJohn Baldwin 		    "no memory for rx list -- packet dropped!\n");
1092167aa833SJulian Elischer 		m_freem(m_new);
1093167aa833SJulian Elischer 		return (ENOBUFS);
1094167aa833SJulian Elischer 	}
1095167aa833SJulian Elischer 	c->my_mbuf = m_new;
1096167aa833SJulian Elischer 	c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t));
1097167aa833SJulian Elischer 	c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift;
1098167aa833SJulian Elischer 	c->my_ptr->my_status = MY_OWNByNIC;
1099167aa833SJulian Elischer 	return (0);
1100167aa833SJulian Elischer }
1101167aa833SJulian Elischer 
1102167aa833SJulian Elischer /*
1103167aa833SJulian Elischer  * A frame has been uploaded: pass the resulting mbuf chain up to the higher
1104167aa833SJulian Elischer  * level protocols.
1105167aa833SJulian Elischer  */
1106167aa833SJulian Elischer static void
1107167aa833SJulian Elischer my_rxeof(struct my_softc * sc)
1108167aa833SJulian Elischer {
1109167aa833SJulian Elischer 	struct ether_header *eh;
1110167aa833SJulian Elischer 	struct mbuf    *m;
1111167aa833SJulian Elischer 	struct ifnet   *ifp;
1112167aa833SJulian Elischer 	struct my_chain_onefrag *cur_rx;
1113167aa833SJulian Elischer 	int             total_len = 0;
1114167aa833SJulian Elischer 	u_int32_t       rxstat;
1115167aa833SJulian Elischer 
1116ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1117fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1118167aa833SJulian Elischer 	while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status)
1119167aa833SJulian Elischer 	    & MY_OWNByNIC)) {
1120167aa833SJulian Elischer 		cur_rx = sc->my_cdata.my_rx_head;
1121167aa833SJulian Elischer 		sc->my_cdata.my_rx_head = cur_rx->my_nextdesc;
1122167aa833SJulian Elischer 
1123167aa833SJulian Elischer 		if (rxstat & MY_ES) {	/* error summary: give up this rx pkt */
1124dde47b55SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1125167aa833SJulian Elischer 			cur_rx->my_ptr->my_status = MY_OWNByNIC;
1126167aa833SJulian Elischer 			continue;
1127167aa833SJulian Elischer 		}
1128167aa833SJulian Elischer 		/* No errors; receive the packet. */
1129167aa833SJulian Elischer 		total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift;
1130167aa833SJulian Elischer 		total_len -= ETHER_CRC_LEN;
1131167aa833SJulian Elischer 
1132167aa833SJulian Elischer 		if (total_len < MINCLSIZE) {
1133167aa833SJulian Elischer 			m = m_devget(mtod(cur_rx->my_mbuf, char *),
1134167aa833SJulian Elischer 			    total_len, 0, ifp, NULL);
1135167aa833SJulian Elischer 			cur_rx->my_ptr->my_status = MY_OWNByNIC;
1136167aa833SJulian Elischer 			if (m == NULL) {
1137dde47b55SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1138167aa833SJulian Elischer 				continue;
1139167aa833SJulian Elischer 			}
1140167aa833SJulian Elischer 		} else {
1141167aa833SJulian Elischer 			m = cur_rx->my_mbuf;
1142167aa833SJulian Elischer 			/*
1143167aa833SJulian Elischer 			 * Try to conjure up a new mbuf cluster. If that
1144167aa833SJulian Elischer 			 * fails, it means we have an out of memory condition
1145167aa833SJulian Elischer 			 * and should leave the buffer in place and continue.
1146167aa833SJulian Elischer 			 * This will result in a lost packet, but there's
1147167aa833SJulian Elischer 			 * little else we can do in this situation.
1148167aa833SJulian Elischer 			 */
1149167aa833SJulian Elischer 			if (my_newbuf(sc, cur_rx) == ENOBUFS) {
1150dde47b55SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1151167aa833SJulian Elischer 				cur_rx->my_ptr->my_status = MY_OWNByNIC;
1152167aa833SJulian Elischer 				continue;
1153167aa833SJulian Elischer 			}
1154167aa833SJulian Elischer 			m->m_pkthdr.rcvif = ifp;
1155167aa833SJulian Elischer 			m->m_pkthdr.len = m->m_len = total_len;
1156167aa833SJulian Elischer 		}
1157dde47b55SGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
1158167aa833SJulian Elischer 		eh = mtod(m, struct ether_header *);
1159167aa833SJulian Elischer #if NBPFILTER > 0
1160167aa833SJulian Elischer 		/*
1161167aa833SJulian Elischer 		 * Handle BPF listeners. Let the BPF user see the packet, but
1162167aa833SJulian Elischer 		 * don't pass it up to the ether_input() layer unless it's a
1163167aa833SJulian Elischer 		 * broadcast packet, multicast packet, matches our ethernet
1164167aa833SJulian Elischer 		 * address or the interface is in promiscuous mode.
1165167aa833SJulian Elischer 		 */
11660dea849aSJohn Baldwin 		if (bpf_peers_present(ifp->if_bpf)) {
116755834910SJohn Baldwin 			bpf_mtap(ifp->if_bpf, m);
1168167aa833SJulian Elischer 			if (ifp->if_flags & IFF_PROMISC &&
11694a0d6638SRuslan Ermilov 			    (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp),
1170167aa833SJulian Elischer 				ETHER_ADDR_LEN) &&
1171167aa833SJulian Elischer 			     (eh->ether_dhost[0] & 1) == 0)) {
1172167aa833SJulian Elischer 				m_freem(m);
1173167aa833SJulian Elischer 				continue;
1174167aa833SJulian Elischer 			}
1175167aa833SJulian Elischer 		}
1176167aa833SJulian Elischer #endif
11775120abbfSSam Leffler 		MY_UNLOCK(sc);
1178673d9191SSam Leffler 		(*ifp->if_input)(ifp, m);
11795120abbfSSam Leffler 		MY_LOCK(sc);
1180167aa833SJulian Elischer 	}
1181167aa833SJulian Elischer 	return;
1182167aa833SJulian Elischer }
1183167aa833SJulian Elischer 
1184167aa833SJulian Elischer 
1185167aa833SJulian Elischer /*
1186167aa833SJulian Elischer  * A frame was downloaded to the chip. It's safe for us to clean up the list
1187167aa833SJulian Elischer  * buffers.
1188167aa833SJulian Elischer  */
1189167aa833SJulian Elischer static void
1190167aa833SJulian Elischer my_txeof(struct my_softc * sc)
1191167aa833SJulian Elischer {
1192167aa833SJulian Elischer 	struct my_chain *cur_tx;
1193167aa833SJulian Elischer 	struct ifnet   *ifp;
1194167aa833SJulian Elischer 
1195ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1196fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1197167aa833SJulian Elischer 	/* Clear the timeout timer. */
1198d4e576c4SJohn Baldwin 	sc->my_timer = 0;
11998ac00c27SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL) {
1200167aa833SJulian Elischer 		return;
12018ac00c27SJulian Elischer 	}
1202167aa833SJulian Elischer 	/*
1203167aa833SJulian Elischer 	 * Go through our tx list and free mbufs for those frames that have
1204167aa833SJulian Elischer 	 * been transmitted.
1205167aa833SJulian Elischer 	 */
1206167aa833SJulian Elischer 	while (sc->my_cdata.my_tx_head->my_mbuf != NULL) {
1207167aa833SJulian Elischer 		u_int32_t       txstat;
1208167aa833SJulian Elischer 
1209167aa833SJulian Elischer 		cur_tx = sc->my_cdata.my_tx_head;
1210167aa833SJulian Elischer 		txstat = MY_TXSTATUS(cur_tx);
1211167aa833SJulian Elischer 		if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT)
1212167aa833SJulian Elischer 			break;
1213167aa833SJulian Elischer 		if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) {
1214167aa833SJulian Elischer 			if (txstat & MY_TXERR) {
1215dde47b55SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
1216167aa833SJulian Elischer 				if (txstat & MY_EC) /* excessive collision */
1217dde47b55SGleb Smirnoff 					if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1218167aa833SJulian Elischer 				if (txstat & MY_LC)	/* late collision */
1219dde47b55SGleb Smirnoff 					if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1220167aa833SJulian Elischer 			}
1221dde47b55SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_COLLISIONS,
1222dde47b55SGleb Smirnoff 			    (txstat & MY_NCRMASK) >> MY_NCRShift);
1223167aa833SJulian Elischer 		}
1224dde47b55SGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1225167aa833SJulian Elischer 		m_freem(cur_tx->my_mbuf);
1226167aa833SJulian Elischer 		cur_tx->my_mbuf = NULL;
1227167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) {
1228167aa833SJulian Elischer 			sc->my_cdata.my_tx_head = NULL;
1229167aa833SJulian Elischer 			sc->my_cdata.my_tx_tail = NULL;
1230167aa833SJulian Elischer 			break;
1231167aa833SJulian Elischer 		}
1232167aa833SJulian Elischer 		sc->my_cdata.my_tx_head = cur_tx->my_nextdesc;
1233167aa833SJulian Elischer 	}
1234167aa833SJulian Elischer 	if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) {
1235dde47b55SGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_COLLISIONS, (CSR_READ_4(sc, MY_TSR) & MY_NCRMask));
1236167aa833SJulian Elischer 	}
1237167aa833SJulian Elischer 	return;
1238167aa833SJulian Elischer }
1239167aa833SJulian Elischer 
1240167aa833SJulian Elischer /*
1241167aa833SJulian Elischer  * TX 'end of channel' interrupt handler.
1242167aa833SJulian Elischer  */
1243167aa833SJulian Elischer static void
1244167aa833SJulian Elischer my_txeoc(struct my_softc * sc)
1245167aa833SJulian Elischer {
1246167aa833SJulian Elischer 	struct ifnet   *ifp;
1247167aa833SJulian Elischer 
1248ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1249fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1250d4e576c4SJohn Baldwin 	sc->my_timer = 0;
1251167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL) {
125213f4c340SRobert Watson 		ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1253167aa833SJulian Elischer 		sc->my_cdata.my_tx_tail = NULL;
1254167aa833SJulian Elischer 		if (sc->my_want_auto)
1255167aa833SJulian Elischer 			my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1256167aa833SJulian Elischer 	} else {
1257167aa833SJulian Elischer 		if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) {
1258167aa833SJulian Elischer 			MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC;
1259d4e576c4SJohn Baldwin 			sc->my_timer = 5;
1260167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);
1261167aa833SJulian Elischer 		}
1262167aa833SJulian Elischer 	}
1263167aa833SJulian Elischer 	return;
1264167aa833SJulian Elischer }
1265167aa833SJulian Elischer 
1266167aa833SJulian Elischer static void
1267167aa833SJulian Elischer my_intr(void *arg)
1268167aa833SJulian Elischer {
1269167aa833SJulian Elischer 	struct my_softc *sc;
1270167aa833SJulian Elischer 	struct ifnet   *ifp;
1271167aa833SJulian Elischer 	u_int32_t       status;
1272167aa833SJulian Elischer 
1273167aa833SJulian Elischer 	sc = arg;
1274167aa833SJulian Elischer 	MY_LOCK(sc);
1275fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1276167aa833SJulian Elischer 	if (!(ifp->if_flags & IFF_UP)) {
1277167aa833SJulian Elischer 		MY_UNLOCK(sc);
1278167aa833SJulian Elischer 		return;
1279167aa833SJulian Elischer 	}
1280167aa833SJulian Elischer 	/* Disable interrupts. */
1281167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1282167aa833SJulian Elischer 
1283167aa833SJulian Elischer 	for (;;) {
1284167aa833SJulian Elischer 		status = CSR_READ_4(sc, MY_ISR);
1285167aa833SJulian Elischer 		status &= MY_INTRS;
1286167aa833SJulian Elischer 		if (status)
1287167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_ISR, status);
1288167aa833SJulian Elischer 		else
1289167aa833SJulian Elischer 			break;
1290167aa833SJulian Elischer 
1291167aa833SJulian Elischer 		if (status & MY_RI)	/* receive interrupt */
1292167aa833SJulian Elischer 			my_rxeof(sc);
1293167aa833SJulian Elischer 
1294167aa833SJulian Elischer 		if ((status & MY_RBU) || (status & MY_RxErr)) {
1295167aa833SJulian Elischer 			/* rx buffer unavailable or rx error */
1296dde47b55SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1297167aa833SJulian Elischer #ifdef foo
1298167aa833SJulian Elischer 			my_stop(sc);
1299167aa833SJulian Elischer 			my_reset(sc);
1300ca5fc32dSJohn Baldwin 			my_init_locked(sc);
1301167aa833SJulian Elischer #endif
1302167aa833SJulian Elischer 		}
1303167aa833SJulian Elischer 		if (status & MY_TI)	/* tx interrupt */
1304167aa833SJulian Elischer 			my_txeof(sc);
1305167aa833SJulian Elischer 		if (status & MY_ETI)	/* tx early interrupt */
1306167aa833SJulian Elischer 			my_txeof(sc);
1307167aa833SJulian Elischer 		if (status & MY_TBU)	/* tx buffer unavailable */
1308167aa833SJulian Elischer 			my_txeoc(sc);
13090cde2d13SJulian Elischer 
13100cde2d13SJulian Elischer #if 0				/* 90/1/18 delete */
13110cde2d13SJulian Elischer 		if (status & MY_FBE) {
13120cde2d13SJulian Elischer 			my_reset(sc);
1313ca5fc32dSJohn Baldwin 			my_init_locked(sc);
13140cde2d13SJulian Elischer 		}
13150cde2d13SJulian Elischer #endif
13160cde2d13SJulian Elischer 
1317167aa833SJulian Elischer 	}
1318167aa833SJulian Elischer 
1319167aa833SJulian Elischer 	/* Re-enable interrupts. */
1320167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
13219522f75aSChristian Brueffer 	if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1322ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
1323167aa833SJulian Elischer 	MY_UNLOCK(sc);
1324167aa833SJulian Elischer 	return;
1325167aa833SJulian Elischer }
1326167aa833SJulian Elischer 
1327167aa833SJulian Elischer /*
1328167aa833SJulian Elischer  * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1329167aa833SJulian Elischer  * pointers to the fragment pointers.
1330167aa833SJulian Elischer  */
1331167aa833SJulian Elischer static int
1332167aa833SJulian Elischer my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head)
1333167aa833SJulian Elischer {
1334167aa833SJulian Elischer 	struct my_desc *f = NULL;
1335167aa833SJulian Elischer 	int             total_len;
1336167aa833SJulian Elischer 	struct mbuf    *m, *m_new = NULL;
1337167aa833SJulian Elischer 
1338ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1339167aa833SJulian Elischer 	/* calculate the total tx pkt length */
1340167aa833SJulian Elischer 	total_len = 0;
1341167aa833SJulian Elischer 	for (m = m_head; m != NULL; m = m->m_next)
1342167aa833SJulian Elischer 		total_len += m->m_len;
1343167aa833SJulian Elischer 	/*
1344167aa833SJulian Elischer 	 * Start packing the mbufs in this chain into the fragment pointers.
1345167aa833SJulian Elischer 	 * Stop when we run out of fragments or hit the end of the mbuf
1346167aa833SJulian Elischer 	 * chain.
1347167aa833SJulian Elischer 	 */
1348167aa833SJulian Elischer 	m = m_head;
1349c6499eccSGleb Smirnoff 	MGETHDR(m_new, M_NOWAIT, MT_DATA);
1350167aa833SJulian Elischer 	if (m_new == NULL) {
13516b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "no memory for tx list");
1352167aa833SJulian Elischer 		return (1);
1353167aa833SJulian Elischer 	}
1354167aa833SJulian Elischer 	if (m_head->m_pkthdr.len > MHLEN) {
1355c6499eccSGleb Smirnoff 		MCLGET(m_new, M_NOWAIT);
1356167aa833SJulian Elischer 		if (!(m_new->m_flags & M_EXT)) {
1357167aa833SJulian Elischer 			m_freem(m_new);
13586b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "no memory for tx list");
1359167aa833SJulian Elischer 			return (1);
1360167aa833SJulian Elischer 		}
1361167aa833SJulian Elischer 	}
1362167aa833SJulian Elischer 	m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t));
1363167aa833SJulian Elischer 	m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len;
1364167aa833SJulian Elischer 	m_freem(m_head);
1365167aa833SJulian Elischer 	m_head = m_new;
1366167aa833SJulian Elischer 	f = &c->my_ptr->my_frag[0];
1367167aa833SJulian Elischer 	f->my_status = 0;
1368167aa833SJulian Elischer 	f->my_data = vtophys(mtod(m_new, caddr_t));
1369167aa833SJulian Elischer 	total_len = m_new->m_len;
1370167aa833SJulian Elischer 	f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable;
1371167aa833SJulian Elischer 	f->my_ctl |= total_len << MY_PKTShift;	/* pkt size */
1372167aa833SJulian Elischer 	f->my_ctl |= total_len;	/* buffer size */
13732cc8ce3cSJulian Elischer 	/* 89/12/29 add, for mtd891 *//* [ 89? ] */
1374167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD891ID)
1375167aa833SJulian Elischer 		f->my_ctl |= MY_ETIControl | MY_RetryTxLC;
1376167aa833SJulian Elischer 	c->my_mbuf = m_head;
1377167aa833SJulian Elischer 	c->my_lastdesc = 0;
1378167aa833SJulian Elischer 	MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]);
1379167aa833SJulian Elischer 	return (0);
1380167aa833SJulian Elischer }
1381167aa833SJulian Elischer 
1382167aa833SJulian Elischer /*
1383167aa833SJulian Elischer  * Main transmit routine. To avoid having to do mbuf copies, we put pointers
1384167aa833SJulian Elischer  * to the mbuf data regions directly in the transmit lists. We also save a
1385167aa833SJulian Elischer  * copy of the pointers since the transmit list fragment pointers are
1386167aa833SJulian Elischer  * physical addresses.
1387167aa833SJulian Elischer  */
1388167aa833SJulian Elischer static void
1389167aa833SJulian Elischer my_start(struct ifnet * ifp)
1390167aa833SJulian Elischer {
1391167aa833SJulian Elischer 	struct my_softc *sc;
1392ca5fc32dSJohn Baldwin 
1393ca5fc32dSJohn Baldwin 	sc = ifp->if_softc;
1394ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
1395ca5fc32dSJohn Baldwin 	my_start_locked(ifp);
1396ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1397ca5fc32dSJohn Baldwin }
1398ca5fc32dSJohn Baldwin 
1399ca5fc32dSJohn Baldwin static void
1400ca5fc32dSJohn Baldwin my_start_locked(struct ifnet * ifp)
1401ca5fc32dSJohn Baldwin {
1402ca5fc32dSJohn Baldwin 	struct my_softc *sc;
1403167aa833SJulian Elischer 	struct mbuf    *m_head = NULL;
1404167aa833SJulian Elischer 	struct my_chain *cur_tx = NULL, *start_tx;
1405167aa833SJulian Elischer 
1406167aa833SJulian Elischer 	sc = ifp->if_softc;
1407ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1408167aa833SJulian Elischer 	if (sc->my_autoneg) {
1409167aa833SJulian Elischer 		sc->my_tx_pend = 1;
1410167aa833SJulian Elischer 		return;
1411167aa833SJulian Elischer 	}
1412167aa833SJulian Elischer 	/*
1413167aa833SJulian Elischer 	 * Check for an available queue slot. If there are none, punt.
1414167aa833SJulian Elischer 	 */
1415167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_free->my_mbuf != NULL) {
141613f4c340SRobert Watson 		ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1417167aa833SJulian Elischer 		return;
1418167aa833SJulian Elischer 	}
1419167aa833SJulian Elischer 	start_tx = sc->my_cdata.my_tx_free;
1420167aa833SJulian Elischer 	while (sc->my_cdata.my_tx_free->my_mbuf == NULL) {
14219522f75aSChristian Brueffer 		IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head);
1422167aa833SJulian Elischer 		if (m_head == NULL)
1423167aa833SJulian Elischer 			break;
1424167aa833SJulian Elischer 
1425167aa833SJulian Elischer 		/* Pick a descriptor off the free list. */
1426167aa833SJulian Elischer 		cur_tx = sc->my_cdata.my_tx_free;
1427167aa833SJulian Elischer 		sc->my_cdata.my_tx_free = cur_tx->my_nextdesc;
1428167aa833SJulian Elischer 
1429167aa833SJulian Elischer 		/* Pack the data into the descriptor. */
1430167aa833SJulian Elischer 		my_encap(sc, cur_tx, m_head);
1431167aa833SJulian Elischer 
1432167aa833SJulian Elischer 		if (cur_tx != start_tx)
1433167aa833SJulian Elischer 			MY_TXOWN(cur_tx) = MY_OWNByNIC;
1434167aa833SJulian Elischer #if NBPFILTER > 0
1435167aa833SJulian Elischer 		/*
1436167aa833SJulian Elischer 		 * If there's a BPF listener, bounce a copy of this frame to
1437167aa833SJulian Elischer 		 * him.
1438167aa833SJulian Elischer 		 */
1439673d9191SSam Leffler 		BPF_MTAP(ifp, cur_tx->my_mbuf);
1440167aa833SJulian Elischer #endif
1441167aa833SJulian Elischer 	}
1442167aa833SJulian Elischer 	/*
1443167aa833SJulian Elischer 	 * If there are no packets queued, bail.
1444167aa833SJulian Elischer 	 */
1445167aa833SJulian Elischer 	if (cur_tx == NULL) {
1446167aa833SJulian Elischer 		return;
1447167aa833SJulian Elischer 	}
1448167aa833SJulian Elischer 	/*
1449167aa833SJulian Elischer 	 * Place the request for the upload interrupt in the last descriptor
1450167aa833SJulian Elischer 	 * in the chain. This way, if we're chaining several packets at once,
1451976b0106SKevin Lo 	 * we'll only get an interrupt once for the whole chain rather than
1452167aa833SJulian Elischer 	 * once for each packet.
1453167aa833SJulian Elischer 	 */
1454167aa833SJulian Elischer 	MY_TXCTL(cur_tx) |= MY_TXIC;
1455167aa833SJulian Elischer 	cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC;
1456167aa833SJulian Elischer 	sc->my_cdata.my_tx_tail = cur_tx;
1457167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL)
1458167aa833SJulian Elischer 		sc->my_cdata.my_tx_head = start_tx;
1459167aa833SJulian Elischer 	MY_TXOWN(start_tx) = MY_OWNByNIC;
1460167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);	/* tx polling demand */
1461167aa833SJulian Elischer 
1462167aa833SJulian Elischer 	/*
1463167aa833SJulian Elischer 	 * Set a timeout in case the chip goes out to lunch.
1464167aa833SJulian Elischer 	 */
1465d4e576c4SJohn Baldwin 	sc->my_timer = 5;
1466167aa833SJulian Elischer 	return;
1467167aa833SJulian Elischer }
1468167aa833SJulian Elischer 
1469167aa833SJulian Elischer static void
1470167aa833SJulian Elischer my_init(void *xsc)
1471167aa833SJulian Elischer {
1472167aa833SJulian Elischer 	struct my_softc *sc = xsc;
1473167aa833SJulian Elischer 
1474167aa833SJulian Elischer 	MY_LOCK(sc);
1475ca5fc32dSJohn Baldwin 	my_init_locked(sc);
1476167aa833SJulian Elischer 	MY_UNLOCK(sc);
1477ca5fc32dSJohn Baldwin }
1478ca5fc32dSJohn Baldwin 
1479ca5fc32dSJohn Baldwin static void
1480ca5fc32dSJohn Baldwin my_init_locked(struct my_softc *sc)
1481ca5fc32dSJohn Baldwin {
1482ca5fc32dSJohn Baldwin 	struct ifnet   *ifp = sc->my_ifp;
1483ca5fc32dSJohn Baldwin 	u_int16_t       phy_bmcr = 0;
1484ca5fc32dSJohn Baldwin 
1485ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1486ca5fc32dSJohn Baldwin 	if (sc->my_autoneg) {
1487167aa833SJulian Elischer 		return;
1488167aa833SJulian Elischer 	}
1489167aa833SJulian Elischer 	if (sc->my_pinfo != NULL)
1490167aa833SJulian Elischer 		phy_bmcr = my_phy_readreg(sc, PHY_BMCR);
1491167aa833SJulian Elischer 	/*
1492167aa833SJulian Elischer 	 * Cancel pending I/O and free all RX/TX buffers.
1493167aa833SJulian Elischer 	 */
1494167aa833SJulian Elischer 	my_stop(sc);
1495167aa833SJulian Elischer 	my_reset(sc);
1496167aa833SJulian Elischer 
1497167aa833SJulian Elischer 	/*
1498167aa833SJulian Elischer 	 * Set cache alignment and burst length.
1499167aa833SJulian Elischer 	 */
15000cde2d13SJulian Elischer #if 0				/* 89/9/1 modify,  */
15010cde2d13SJulian Elischer 	CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512);
15020cde2d13SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF);
15030cde2d13SJulian Elischer #endif
1504167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_BCR, MY_PBL8);
1505167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512);
1506167aa833SJulian Elischer 	/*
1507167aa833SJulian Elischer 	 * 89/12/29 add, for mtd891,
1508167aa833SJulian Elischer 	 */
1509167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD891ID) {
1510167aa833SJulian Elischer 		MY_SETBIT(sc, MY_BCR, MY_PROG);
1511167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced);
1512167aa833SJulian Elischer 	}
1513167aa833SJulian Elischer 	my_setcfg(sc, phy_bmcr);
1514167aa833SJulian Elischer 	/* Init circular RX list. */
1515167aa833SJulian Elischer 	if (my_list_rx_init(sc) == ENOBUFS) {
15166b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "init failed: no memory for rx buffers\n");
1517167aa833SJulian Elischer 		my_stop(sc);
1518167aa833SJulian Elischer 		return;
1519167aa833SJulian Elischer 	}
1520167aa833SJulian Elischer 	/* Init TX descriptors. */
1521167aa833SJulian Elischer 	my_list_tx_init(sc);
1522167aa833SJulian Elischer 
1523167aa833SJulian Elischer 	/* If we want promiscuous mode, set the allframes bit. */
1524167aa833SJulian Elischer 	if (ifp->if_flags & IFF_PROMISC)
1525167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PROM);
1526167aa833SJulian Elischer 	else
1527167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_PROM);
1528167aa833SJulian Elischer 
1529167aa833SJulian Elischer 	/*
1530167aa833SJulian Elischer 	 * Set capture broadcast bit to capture broadcast frames.
1531167aa833SJulian Elischer 	 */
1532167aa833SJulian Elischer 	if (ifp->if_flags & IFF_BROADCAST)
1533167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_AB);
1534167aa833SJulian Elischer 	else
1535167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_AB);
1536167aa833SJulian Elischer 
1537167aa833SJulian Elischer 	/*
1538167aa833SJulian Elischer 	 * Program the multicast filter, if necessary.
1539167aa833SJulian Elischer 	 */
1540167aa833SJulian Elischer 	my_setmulti(sc);
1541167aa833SJulian Elischer 
1542167aa833SJulian Elischer 	/*
1543167aa833SJulian Elischer 	 * Load the address of the RX list.
1544167aa833SJulian Elischer 	 */
1545167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_RE);
1546167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0]));
1547167aa833SJulian Elischer 
1548167aa833SJulian Elischer 	/*
1549167aa833SJulian Elischer 	 * Enable interrupts.
1550167aa833SJulian Elischer 	 */
1551167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
1552167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF);
1553167aa833SJulian Elischer 
1554167aa833SJulian Elischer 	/* Enable receiver and transmitter. */
1555167aa833SJulian Elischer 	MY_SETBIT(sc, MY_TCRRCR, MY_RE);
1556167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_TE);
1557167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0]));
1558167aa833SJulian Elischer 	MY_SETBIT(sc, MY_TCRRCR, MY_TE);
1559167aa833SJulian Elischer 
1560167aa833SJulian Elischer 	/* Restore state of BMCR */
1561167aa833SJulian Elischer 	if (sc->my_pinfo != NULL)
1562167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, phy_bmcr);
156313f4c340SRobert Watson 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
156413f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1565d4e576c4SJohn Baldwin 
1566d4e576c4SJohn Baldwin 	callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1567167aa833SJulian Elischer 	return;
1568167aa833SJulian Elischer }
1569167aa833SJulian Elischer 
1570167aa833SJulian Elischer /*
1571167aa833SJulian Elischer  * Set media options.
1572167aa833SJulian Elischer  */
1573167aa833SJulian Elischer 
1574167aa833SJulian Elischer static int
1575167aa833SJulian Elischer my_ifmedia_upd(struct ifnet * ifp)
1576167aa833SJulian Elischer {
1577167aa833SJulian Elischer 	struct my_softc *sc;
1578167aa833SJulian Elischer 	struct ifmedia *ifm;
1579167aa833SJulian Elischer 
1580167aa833SJulian Elischer 	sc = ifp->if_softc;
1581167aa833SJulian Elischer 	MY_LOCK(sc);
1582167aa833SJulian Elischer 	ifm = &sc->ifmedia;
1583167aa833SJulian Elischer 	if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) {
1584167aa833SJulian Elischer 		MY_UNLOCK(sc);
1585167aa833SJulian Elischer 		return (EINVAL);
1586167aa833SJulian Elischer 	}
1587167aa833SJulian Elischer 	if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO)
1588167aa833SJulian Elischer 		my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1589167aa833SJulian Elischer 	else
1590167aa833SJulian Elischer 		my_setmode_mii(sc, ifm->ifm_media);
1591167aa833SJulian Elischer 	MY_UNLOCK(sc);
1592167aa833SJulian Elischer 	return (0);
1593167aa833SJulian Elischer }
1594167aa833SJulian Elischer 
1595167aa833SJulian Elischer /*
1596167aa833SJulian Elischer  * Report current media status.
1597167aa833SJulian Elischer  */
1598167aa833SJulian Elischer 
1599167aa833SJulian Elischer static void
1600167aa833SJulian Elischer my_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr)
1601167aa833SJulian Elischer {
1602167aa833SJulian Elischer 	struct my_softc *sc;
1603167aa833SJulian Elischer 	u_int16_t advert = 0, ability = 0;
1604167aa833SJulian Elischer 
1605167aa833SJulian Elischer 	sc = ifp->if_softc;
1606167aa833SJulian Elischer 	MY_LOCK(sc);
1607167aa833SJulian Elischer 	ifmr->ifm_active = IFM_ETHER;
1608167aa833SJulian Elischer 	if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) {
16090cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
16100cde2d13SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000)
16110cde2d13SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_1000TX;
16120cde2d13SJulian Elischer #endif
1613167aa833SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL)
1614167aa833SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_100_TX;
1615167aa833SJulian Elischer 		else
1616167aa833SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_10_T;
1617167aa833SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX)
1618167aa833SJulian Elischer 			ifmr->ifm_active |= IFM_FDX;
1619167aa833SJulian Elischer 		else
1620167aa833SJulian Elischer 			ifmr->ifm_active |= IFM_HDX;
1621167aa833SJulian Elischer 
1622167aa833SJulian Elischer 		MY_UNLOCK(sc);
1623167aa833SJulian Elischer 		return;
1624167aa833SJulian Elischer 	}
1625167aa833SJulian Elischer 	ability = my_phy_readreg(sc, PHY_LPAR);
1626167aa833SJulian Elischer 	advert = my_phy_readreg(sc, PHY_ANAR);
1627167aa833SJulian Elischer 
16280cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
1629167aa833SJulian Elischer 	if (sc->my_pinfo->my_vid = MarvellPHYID0) {
1630167aa833SJulian Elischer 		ability2 = my_phy_readreg(sc, PHY_1000SR);
1631167aa833SJulian Elischer 		if (ability2 & PHY_1000SR_1000BTXFULL) {
1632167aa833SJulian Elischer 			advert = 0;
1633167aa833SJulian Elischer 			ability = 0;
1634b418ad5cSPoul-Henning Kamp 	  		ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX;
1635167aa833SJulian Elischer 	  	} else if (ability & PHY_1000SR_1000BTXHALF) {
1636167aa833SJulian Elischer 			advert = 0;
1637167aa833SJulian Elischer 			ability = 0;
1638b418ad5cSPoul-Henning Kamp 			ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX;
1639167aa833SJulian Elischer 		}
1640167aa833SJulian Elischer 	}
1641167aa833SJulian Elischer #endif
1642167aa833SJulian Elischer 	if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4)
1643167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_T4;
1644167aa833SJulian Elischer 	else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL)
1645167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX;
1646167aa833SJulian Elischer 	else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF)
1647167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX;
1648167aa833SJulian Elischer 	else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL)
1649167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX;
1650167aa833SJulian Elischer 	else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF)
1651167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX;
1652167aa833SJulian Elischer 	MY_UNLOCK(sc);
1653167aa833SJulian Elischer 	return;
1654167aa833SJulian Elischer }
1655167aa833SJulian Elischer 
1656167aa833SJulian Elischer static int
1657167aa833SJulian Elischer my_ioctl(struct ifnet * ifp, u_long command, caddr_t data)
1658167aa833SJulian Elischer {
1659167aa833SJulian Elischer 	struct my_softc *sc = ifp->if_softc;
1660167aa833SJulian Elischer 	struct ifreq   *ifr = (struct ifreq *) data;
1661ca5fc32dSJohn Baldwin 	int             error;
1662167aa833SJulian Elischer 
1663167aa833SJulian Elischer 	switch (command) {
1664167aa833SJulian Elischer 	case SIOCSIFFLAGS:
1665ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
1666167aa833SJulian Elischer 		if (ifp->if_flags & IFF_UP)
1667ca5fc32dSJohn Baldwin 			my_init_locked(sc);
166813f4c340SRobert Watson 		else if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1669167aa833SJulian Elischer 			my_stop(sc);
1670ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
1671167aa833SJulian Elischer 		error = 0;
1672167aa833SJulian Elischer 		break;
1673167aa833SJulian Elischer 	case SIOCADDMULTI:
1674167aa833SJulian Elischer 	case SIOCDELMULTI:
1675ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
1676167aa833SJulian Elischer 		my_setmulti(sc);
1677ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
1678167aa833SJulian Elischer 		error = 0;
1679167aa833SJulian Elischer 		break;
1680167aa833SJulian Elischer 	case SIOCGIFMEDIA:
1681167aa833SJulian Elischer 	case SIOCSIFMEDIA:
1682167aa833SJulian Elischer 		error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command);
1683167aa833SJulian Elischer 		break;
1684167aa833SJulian Elischer 	default:
1685673d9191SSam Leffler 		error = ether_ioctl(ifp, command, data);
1686167aa833SJulian Elischer 		break;
1687167aa833SJulian Elischer 	}
1688167aa833SJulian Elischer 	return (error);
1689167aa833SJulian Elischer }
1690167aa833SJulian Elischer 
1691167aa833SJulian Elischer static void
1692d4e576c4SJohn Baldwin my_watchdog(void *arg)
1693167aa833SJulian Elischer {
1694167aa833SJulian Elischer 	struct my_softc *sc;
1695d4e576c4SJohn Baldwin 	struct ifnet *ifp;
1696167aa833SJulian Elischer 
1697d4e576c4SJohn Baldwin 	sc = arg;
1698d4e576c4SJohn Baldwin 	MY_LOCK_ASSERT(sc);
1699d4e576c4SJohn Baldwin 	callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1700d4e576c4SJohn Baldwin 	if (sc->my_timer == 0 || --sc->my_timer > 0)
1701167aa833SJulian Elischer 		return;
1702d4e576c4SJohn Baldwin 
1703d4e576c4SJohn Baldwin 	ifp = sc->my_ifp;
1704dde47b55SGleb Smirnoff 	if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
170512611131SJohn Baldwin 	if_printf(ifp, "watchdog timeout\n");
1706167aa833SJulian Elischer 	if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT))
170712611131SJohn Baldwin 		if_printf(ifp, "no carrier - transceiver cable problem?\n");
1708167aa833SJulian Elischer 	my_stop(sc);
1709167aa833SJulian Elischer 	my_reset(sc);
1710ca5fc32dSJohn Baldwin 	my_init_locked(sc);
17119522f75aSChristian Brueffer 	if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1712ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
1713167aa833SJulian Elischer }
1714167aa833SJulian Elischer 
1715167aa833SJulian Elischer 
1716167aa833SJulian Elischer /*
1717167aa833SJulian Elischer  * Stop the adapter and free any mbufs allocated to the RX and TX lists.
1718167aa833SJulian Elischer  */
1719167aa833SJulian Elischer static void
1720167aa833SJulian Elischer my_stop(struct my_softc * sc)
1721167aa833SJulian Elischer {
1722167aa833SJulian Elischer 	register int    i;
1723167aa833SJulian Elischer 	struct ifnet   *ifp;
1724167aa833SJulian Elischer 
1725ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1726fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1727d4e576c4SJohn Baldwin 
1728d4e576c4SJohn Baldwin 	callout_stop(&sc->my_autoneg_timer);
1729d4e576c4SJohn Baldwin 	callout_stop(&sc->my_watchdog);
1730167aa833SJulian Elischer 
1731167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE));
1732167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1733167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXLBA, 0x00000000);
1734167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_RXLBA, 0x00000000);
1735167aa833SJulian Elischer 
1736167aa833SJulian Elischer 	/*
1737167aa833SJulian Elischer 	 * Free data in the RX lists.
1738167aa833SJulian Elischer 	 */
1739167aa833SJulian Elischer 	for (i = 0; i < MY_RX_LIST_CNT; i++) {
1740167aa833SJulian Elischer 		if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) {
1741167aa833SJulian Elischer 			m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf);
1742167aa833SJulian Elischer 			sc->my_cdata.my_rx_chain[i].my_mbuf = NULL;
1743167aa833SJulian Elischer 		}
1744167aa833SJulian Elischer 	}
1745167aa833SJulian Elischer 	bzero((char *)&sc->my_ldata->my_rx_list,
1746167aa833SJulian Elischer 	    sizeof(sc->my_ldata->my_rx_list));
1747167aa833SJulian Elischer 	/*
1748167aa833SJulian Elischer 	 * Free the TX list buffers.
1749167aa833SJulian Elischer 	 */
1750167aa833SJulian Elischer 	for (i = 0; i < MY_TX_LIST_CNT; i++) {
1751167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) {
1752167aa833SJulian Elischer 			m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf);
1753167aa833SJulian Elischer 			sc->my_cdata.my_tx_chain[i].my_mbuf = NULL;
1754167aa833SJulian Elischer 		}
1755167aa833SJulian Elischer 	}
1756167aa833SJulian Elischer 	bzero((char *)&sc->my_ldata->my_tx_list,
1757167aa833SJulian Elischer 	    sizeof(sc->my_ldata->my_tx_list));
175813f4c340SRobert Watson 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
1759167aa833SJulian Elischer 	return;
1760167aa833SJulian Elischer }
1761167aa833SJulian Elischer 
1762167aa833SJulian Elischer /*
1763167aa833SJulian Elischer  * Stop all chip I/O so that the kernel's probe routines don't get confused
1764167aa833SJulian Elischer  * by errant DMAs when rebooting.
1765167aa833SJulian Elischer  */
1766174ed15eSWarner Losh static int
1767167aa833SJulian Elischer my_shutdown(device_t dev)
1768167aa833SJulian Elischer {
1769167aa833SJulian Elischer 	struct my_softc *sc;
1770167aa833SJulian Elischer 
1771167aa833SJulian Elischer 	sc = device_get_softc(dev);
1772ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
1773167aa833SJulian Elischer 	my_stop(sc);
1774ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1775174ed15eSWarner Losh 	return 0;
1776167aa833SJulian Elischer }
1777