xref: /freebsd/sys/dev/my/if_my.c (revision fdafd315)
1aad970f1SDavid E. O'Brien /*-
24d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3718cf2ccSPedro F. Giffuni  *
4aad970f1SDavid E. O'Brien  * Written by: yen_cw@myson.com.tw
5167aa833SJulian Elischer  * Copyright (c) 2002 Myson Technology Inc.
6167aa833SJulian Elischer  * All rights reserved.
7167aa833SJulian Elischer  *
8167aa833SJulian Elischer  * Redistribution and use in source and binary forms, with or without
9167aa833SJulian Elischer  * modification, are permitted provided that the following conditions
10167aa833SJulian Elischer  * are met:
11167aa833SJulian Elischer  * 1. Redistributions of source code must retain the above copyright
12167aa833SJulian Elischer  *    notice, this list of conditions, and the following disclaimer,
13167aa833SJulian Elischer  *    without modification, immediately at the beginning of the file.
14167aa833SJulian Elischer  * 2. The name of the author may not be used to endorse or promote products
15167aa833SJulian Elischer  *    derived from this software without specific prior written permission.
16167aa833SJulian Elischer  *
17167aa833SJulian Elischer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18167aa833SJulian Elischer  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19167aa833SJulian Elischer  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20167aa833SJulian Elischer  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
21167aa833SJulian Elischer  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22167aa833SJulian Elischer  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23167aa833SJulian Elischer  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24167aa833SJulian Elischer  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25167aa833SJulian Elischer  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26167aa833SJulian Elischer  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27167aa833SJulian Elischer  * SUCH DAMAGE.
28167aa833SJulian Elischer  *
29aad970f1SDavid E. O'Brien  * Myson fast ethernet PCI NIC driver, available at: http://www.myson.com.tw/
30167aa833SJulian Elischer  */
318368cf8fSDavid E. O'Brien 
32167aa833SJulian Elischer #include <sys/param.h>
33167aa833SJulian Elischer #include <sys/systm.h>
34167aa833SJulian Elischer #include <sys/sockio.h>
35167aa833SJulian Elischer #include <sys/mbuf.h>
36167aa833SJulian Elischer #include <sys/malloc.h>
37167aa833SJulian Elischer #include <sys/kernel.h>
38167aa833SJulian Elischer #include <sys/socket.h>
39167aa833SJulian Elischer #include <sys/queue.h>
40167aa833SJulian Elischer #include <sys/types.h>
41167aa833SJulian Elischer #include <sys/module.h>
42d4f567eeSJulian Elischer #include <sys/lock.h>
43d4f567eeSJulian Elischer #include <sys/mutex.h>
44167aa833SJulian Elischer 
45167aa833SJulian Elischer #define NBPFILTER	1
46167aa833SJulian Elischer 
47167aa833SJulian Elischer #include <net/if.h>
4876039bc8SGleb Smirnoff #include <net/if_var.h>
49167aa833SJulian Elischer #include <net/if_arp.h>
50167aa833SJulian Elischer #include <net/ethernet.h>
51167aa833SJulian Elischer #include <net/if_media.h>
52fc74a9f9SBrooks Davis #include <net/if_types.h>
53167aa833SJulian Elischer #include <net/if_dl.h>
54167aa833SJulian Elischer #include <net/bpf.h>
55167aa833SJulian Elischer 
56167aa833SJulian Elischer #include <vm/vm.h>		/* for vtophys */
57167aa833SJulian Elischer #include <vm/pmap.h>		/* for vtophys */
58167aa833SJulian Elischer #include <machine/bus.h>
59167aa833SJulian Elischer #include <machine/resource.h>
60167aa833SJulian Elischer #include <sys/bus.h>
61167aa833SJulian Elischer #include <sys/rman.h>
62167aa833SJulian Elischer 
6338d8c994SWarner Losh #include <dev/pci/pcireg.h>
6438d8c994SWarner Losh #include <dev/pci/pcivar.h>
65167aa833SJulian Elischer 
66167aa833SJulian Elischer /*
67167aa833SJulian Elischer  * #define MY_USEIOSPACE
68167aa833SJulian Elischer  */
69167aa833SJulian Elischer 
70167aa833SJulian Elischer static int      MY_USEIOSPACE = 1;
71167aa833SJulian Elischer 
723238c6bdSRuslan Ermilov #ifdef MY_USEIOSPACE
73167aa833SJulian Elischer #define MY_RES                  SYS_RES_IOPORT
74167aa833SJulian Elischer #define MY_RID                  MY_PCI_LOIO
75167aa833SJulian Elischer #else
76167aa833SJulian Elischer #define MY_RES                  SYS_RES_MEMORY
77167aa833SJulian Elischer #define MY_RID                  MY_PCI_LOMEM
78167aa833SJulian Elischer #endif
79167aa833SJulian Elischer 
80167aa833SJulian Elischer #include <dev/my/if_myreg.h>
81167aa833SJulian Elischer 
82167aa833SJulian Elischer /*
83167aa833SJulian Elischer  * Various supported device vendors/types and their names.
84167aa833SJulian Elischer  */
85167aa833SJulian Elischer struct my_type *my_info_tmp;
86167aa833SJulian Elischer static struct my_type my_devs[] = {
87167aa833SJulian Elischer 	{MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"},
88167aa833SJulian Elischer 	{MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"},
89167aa833SJulian Elischer 	{MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"},
90167aa833SJulian Elischer 	{0, 0, NULL}
91167aa833SJulian Elischer };
92167aa833SJulian Elischer 
93167aa833SJulian Elischer /*
94167aa833SJulian Elischer  * Various supported PHY vendors/types and their names. Note that this driver
95167aa833SJulian Elischer  * will work with pretty much any MII-compliant PHY, so failure to positively
96167aa833SJulian Elischer  * identify the chip is not a fatal error.
97167aa833SJulian Elischer  */
98167aa833SJulian Elischer static struct my_type my_phys[] = {
99167aa833SJulian Elischer 	{MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"},
100167aa833SJulian Elischer 	{SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"},
101167aa833SJulian Elischer 	{AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"},
102167aa833SJulian Elischer 	{MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"},
103167aa833SJulian Elischer 	{LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"},
104167aa833SJulian Elischer 	{0, 0, "<MII-compliant physical interface>"}
105167aa833SJulian Elischer };
106167aa833SJulian Elischer 
107167aa833SJulian Elischer static int      my_probe(device_t);
108167aa833SJulian Elischer static int      my_attach(device_t);
109167aa833SJulian Elischer static int      my_detach(device_t);
110167aa833SJulian Elischer static int      my_newbuf(struct my_softc *, struct my_chain_onefrag *);
111167aa833SJulian Elischer static int      my_encap(struct my_softc *, struct my_chain *, struct mbuf *);
112167aa833SJulian Elischer static void     my_rxeof(struct my_softc *);
113167aa833SJulian Elischer static void     my_txeof(struct my_softc *);
114167aa833SJulian Elischer static void     my_txeoc(struct my_softc *);
115167aa833SJulian Elischer static void     my_intr(void *);
11612d29e15SJustin Hibbits static void     my_start(if_t);
11712d29e15SJustin Hibbits static void     my_start_locked(if_t);
11812d29e15SJustin Hibbits static int      my_ioctl(if_t, u_long, caddr_t);
119167aa833SJulian Elischer static void     my_init(void *);
120ca5fc32dSJohn Baldwin static void     my_init_locked(struct my_softc *);
121167aa833SJulian Elischer static void     my_stop(struct my_softc *);
122d4e576c4SJohn Baldwin static void     my_autoneg_timeout(void *);
123d4e576c4SJohn Baldwin static void     my_watchdog(void *);
124174ed15eSWarner Losh static int      my_shutdown(device_t);
12512d29e15SJustin Hibbits static int      my_ifmedia_upd(if_t);
12612d29e15SJustin Hibbits static void     my_ifmedia_sts(if_t, struct ifmediareq *);
127167aa833SJulian Elischer static u_int16_t my_phy_readreg(struct my_softc *, int);
128167aa833SJulian Elischer static void     my_phy_writereg(struct my_softc *, int, int);
129167aa833SJulian Elischer static void     my_autoneg_xmit(struct my_softc *);
130167aa833SJulian Elischer static void     my_autoneg_mii(struct my_softc *, int, int);
131167aa833SJulian Elischer static void     my_setmode_mii(struct my_softc *, int);
132167aa833SJulian Elischer static void     my_getmode_mii(struct my_softc *);
133167aa833SJulian Elischer static void     my_setcfg(struct my_softc *, int);
134167aa833SJulian Elischer static void     my_setmulti(struct my_softc *);
135167aa833SJulian Elischer static void     my_reset(struct my_softc *);
136167aa833SJulian Elischer static int      my_list_rx_init(struct my_softc *);
137167aa833SJulian Elischer static int      my_list_tx_init(struct my_softc *);
138167aa833SJulian Elischer static long     my_send_cmd_to_phy(struct my_softc *, int, int);
139167aa833SJulian Elischer 
14029f19445SAlfred Perlstein #define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x))
14129f19445SAlfred Perlstein #define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x))
142167aa833SJulian Elischer 
143167aa833SJulian Elischer static device_method_t my_methods[] = {
144167aa833SJulian Elischer 	/* Device interface */
145167aa833SJulian Elischer 	DEVMETHOD(device_probe, my_probe),
146167aa833SJulian Elischer 	DEVMETHOD(device_attach, my_attach),
147167aa833SJulian Elischer 	DEVMETHOD(device_detach, my_detach),
148167aa833SJulian Elischer 	DEVMETHOD(device_shutdown, my_shutdown),
149167aa833SJulian Elischer 
15061bfd867SSofian Brabez 	DEVMETHOD_END
151167aa833SJulian Elischer };
152167aa833SJulian Elischer 
153167aa833SJulian Elischer static driver_t my_driver = {
154167aa833SJulian Elischer 	"my",
155167aa833SJulian Elischer 	my_methods,
156167aa833SJulian Elischer 	sizeof(struct my_softc)
157167aa833SJulian Elischer };
158167aa833SJulian Elischer 
1592d79bae5SJohn Baldwin DRIVER_MODULE(my, pci, my_driver, 0, 0);
1600dc34160SWarner Losh MODULE_PNP_INFO("U16:vendor;U16:device;D:#", pci, my, my_devs,
1610dc34160SWarner Losh     nitems(my_devs) - 1);
162f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, pci, 1, 1, 1);
163f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, ether, 1, 1, 1);
164167aa833SJulian Elischer 
165167aa833SJulian Elischer static long
my_send_cmd_to_phy(struct my_softc * sc,int opcode,int regad)166167aa833SJulian Elischer my_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad)
167167aa833SJulian Elischer {
168167aa833SJulian Elischer 	long            miir;
169167aa833SJulian Elischer 	int             i;
170167aa833SJulian Elischer 	int             mask, data;
171167aa833SJulian Elischer 
172ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
173167aa833SJulian Elischer 
174167aa833SJulian Elischer 	/* enable MII output */
175167aa833SJulian Elischer 	miir = CSR_READ_4(sc, MY_MANAGEMENT);
176167aa833SJulian Elischer 	miir &= 0xfffffff0;
177167aa833SJulian Elischer 
178167aa833SJulian Elischer 	miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO;
179167aa833SJulian Elischer 
180167aa833SJulian Elischer 	/* send 32 1's preamble */
181167aa833SJulian Elischer 	for (i = 0; i < 32; i++) {
182167aa833SJulian Elischer 		/* low MDC; MDO is already high (miir) */
183167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
184167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
185167aa833SJulian Elischer 
186167aa833SJulian Elischer 		/* high MDC */
187167aa833SJulian Elischer 		miir |= MY_MASK_MIIR_MII_MDC;
188167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
189167aa833SJulian Elischer 	}
190167aa833SJulian Elischer 
191167aa833SJulian Elischer 	/* calculate ST+OP+PHYAD+REGAD+TA */
192167aa833SJulian Elischer 	data = opcode | (sc->my_phy_addr << 7) | (regad << 2);
193167aa833SJulian Elischer 
194167aa833SJulian Elischer 	/* sent out */
195167aa833SJulian Elischer 	mask = 0x8000;
196167aa833SJulian Elischer 	while (mask) {
197167aa833SJulian Elischer 		/* low MDC, prepare MDO */
198167aa833SJulian Elischer 		miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
199167aa833SJulian Elischer 		if (mask & data)
200167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDO;
201167aa833SJulian Elischer 
202167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
203167aa833SJulian Elischer 		/* high MDC */
204167aa833SJulian Elischer 		miir |= MY_MASK_MIIR_MII_MDC;
205167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
206167aa833SJulian Elischer 		DELAY(30);
207167aa833SJulian Elischer 
208167aa833SJulian Elischer 		/* next */
209167aa833SJulian Elischer 		mask >>= 1;
210167aa833SJulian Elischer 		if (mask == 0x2 && opcode == MY_OP_READ)
211167aa833SJulian Elischer 			miir &= ~MY_MASK_MIIR_MII_WRITE;
212167aa833SJulian Elischer 	}
213167aa833SJulian Elischer 
214167aa833SJulian Elischer 	return miir;
215167aa833SJulian Elischer }
216167aa833SJulian Elischer 
217167aa833SJulian Elischer static u_int16_t
my_phy_readreg(struct my_softc * sc,int reg)218167aa833SJulian Elischer my_phy_readreg(struct my_softc * sc, int reg)
219167aa833SJulian Elischer {
220167aa833SJulian Elischer 	long            miir;
221167aa833SJulian Elischer 	int             mask, data;
222167aa833SJulian Elischer 
223ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
224167aa833SJulian Elischer 
225167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
226167aa833SJulian Elischer 		data = CSR_READ_2(sc, MY_PHYBASE + reg * 2);
227167aa833SJulian Elischer 	else {
228167aa833SJulian Elischer 		miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg);
229167aa833SJulian Elischer 
230167aa833SJulian Elischer 		/* read data */
231167aa833SJulian Elischer 		mask = 0x8000;
232167aa833SJulian Elischer 		data = 0;
233167aa833SJulian Elischer 		while (mask) {
234167aa833SJulian Elischer 			/* low MDC */
235167aa833SJulian Elischer 			miir &= ~MY_MASK_MIIR_MII_MDC;
236167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
237167aa833SJulian Elischer 
238167aa833SJulian Elischer 			/* read MDI */
239167aa833SJulian Elischer 			miir = CSR_READ_4(sc, MY_MANAGEMENT);
240167aa833SJulian Elischer 			if (miir & MY_MASK_MIIR_MII_MDI)
241167aa833SJulian Elischer 				data |= mask;
242167aa833SJulian Elischer 
243167aa833SJulian Elischer 			/* high MDC, and wait */
244167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDC;
245167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
246167aa833SJulian Elischer 			DELAY(30);
247167aa833SJulian Elischer 
248167aa833SJulian Elischer 			/* next */
249167aa833SJulian Elischer 			mask >>= 1;
250167aa833SJulian Elischer 		}
251167aa833SJulian Elischer 
252167aa833SJulian Elischer 		/* low MDC */
253167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
254167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
255167aa833SJulian Elischer 	}
256167aa833SJulian Elischer 
257167aa833SJulian Elischer 	return (u_int16_t) data;
258167aa833SJulian Elischer }
259167aa833SJulian Elischer 
260167aa833SJulian Elischer static void
my_phy_writereg(struct my_softc * sc,int reg,int data)261167aa833SJulian Elischer my_phy_writereg(struct my_softc * sc, int reg, int data)
262167aa833SJulian Elischer {
263167aa833SJulian Elischer 	long            miir;
264167aa833SJulian Elischer 	int             mask;
265167aa833SJulian Elischer 
266ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
267167aa833SJulian Elischer 
268167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
269167aa833SJulian Elischer 		CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data);
270167aa833SJulian Elischer 	else {
271167aa833SJulian Elischer 		miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg);
272167aa833SJulian Elischer 
273167aa833SJulian Elischer 		/* write data */
274167aa833SJulian Elischer 		mask = 0x8000;
275167aa833SJulian Elischer 		while (mask) {
276167aa833SJulian Elischer 			/* low MDC, prepare MDO */
277167aa833SJulian Elischer 			miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
278167aa833SJulian Elischer 			if (mask & data)
279167aa833SJulian Elischer 				miir |= MY_MASK_MIIR_MII_MDO;
280167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
281167aa833SJulian Elischer 			DELAY(1);
282167aa833SJulian Elischer 
283167aa833SJulian Elischer 			/* high MDC */
284167aa833SJulian Elischer 			miir |= MY_MASK_MIIR_MII_MDC;
285167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
286167aa833SJulian Elischer 			DELAY(1);
287167aa833SJulian Elischer 
288167aa833SJulian Elischer 			/* next */
289167aa833SJulian Elischer 			mask >>= 1;
290167aa833SJulian Elischer 		}
291167aa833SJulian Elischer 
292167aa833SJulian Elischer 		/* low MDC */
293167aa833SJulian Elischer 		miir &= ~MY_MASK_MIIR_MII_MDC;
294167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
295167aa833SJulian Elischer 	}
296167aa833SJulian Elischer 	return;
297167aa833SJulian Elischer }
298167aa833SJulian Elischer 
29955b4d627SGleb Smirnoff static u_int
my_hash_maddr(void * arg,struct sockaddr_dl * sdl,u_int cnt)30055b4d627SGleb Smirnoff my_hash_maddr(void *arg, struct sockaddr_dl *sdl, u_int cnt)
30155b4d627SGleb Smirnoff {
30255b4d627SGleb Smirnoff 	uint32_t *hashes = arg;
30355b4d627SGleb Smirnoff 	int h;
304167aa833SJulian Elischer 
30555b4d627SGleb Smirnoff 	h = ~ether_crc32_be(LLADDR(sdl), ETHER_ADDR_LEN) >> 26;
30655b4d627SGleb Smirnoff 	if (h < 32)
30755b4d627SGleb Smirnoff 		hashes[0] |= (1 << h);
30855b4d627SGleb Smirnoff 	else
30955b4d627SGleb Smirnoff 		hashes[1] |= (1 << (h - 32));
31055b4d627SGleb Smirnoff 
31155b4d627SGleb Smirnoff 	return (1);
31255b4d627SGleb Smirnoff }
313167aa833SJulian Elischer /*
314167aa833SJulian Elischer  * Program the 64-bit multicast hash filter.
315167aa833SJulian Elischer  */
316167aa833SJulian Elischer static void
my_setmulti(struct my_softc * sc)317167aa833SJulian Elischer my_setmulti(struct my_softc * sc)
318167aa833SJulian Elischer {
31912d29e15SJustin Hibbits 	if_t		ifp;
320167aa833SJulian Elischer 	u_int32_t       hashes[2] = {0, 0};
321167aa833SJulian Elischer 	u_int32_t       rxfilt;
322167aa833SJulian Elischer 
323ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
324167aa833SJulian Elischer 
325fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
326167aa833SJulian Elischer 
327167aa833SJulian Elischer 	rxfilt = CSR_READ_4(sc, MY_TCRRCR);
328167aa833SJulian Elischer 
32912d29e15SJustin Hibbits 	if (if_getflags(ifp) & IFF_ALLMULTI || if_getflags(ifp) & IFF_PROMISC) {
330167aa833SJulian Elischer 		rxfilt |= MY_AM;
331167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
332167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF);
333167aa833SJulian Elischer 		CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF);
334167aa833SJulian Elischer 
335167aa833SJulian Elischer 		return;
336167aa833SJulian Elischer 	}
337167aa833SJulian Elischer 	/* first, zot all the existing hash bits */
338167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR0, 0);
339167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR1, 0);
340167aa833SJulian Elischer 
341167aa833SJulian Elischer 	/* now program new ones */
34255b4d627SGleb Smirnoff 	if (if_foreach_llmaddr(ifp, my_hash_maddr, hashes) > 0)
343167aa833SJulian Elischer 		rxfilt |= MY_AM;
344167aa833SJulian Elischer 	else
345167aa833SJulian Elischer 		rxfilt &= ~MY_AM;
346167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR0, hashes[0]);
347167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_MAR1, hashes[1]);
348167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
349167aa833SJulian Elischer }
350167aa833SJulian Elischer 
351167aa833SJulian Elischer /*
352167aa833SJulian Elischer  * Initiate an autonegotiation session.
353167aa833SJulian Elischer  */
354167aa833SJulian Elischer static void
my_autoneg_xmit(struct my_softc * sc)355167aa833SJulian Elischer my_autoneg_xmit(struct my_softc * sc)
356167aa833SJulian Elischer {
357167aa833SJulian Elischer 	u_int16_t       phy_sts = 0;
358167aa833SJulian Elischer 
359ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
360167aa833SJulian Elischer 
361167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET);
362167aa833SJulian Elischer 	DELAY(500);
363167aa833SJulian Elischer 	while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET);
364167aa833SJulian Elischer 
365167aa833SJulian Elischer 	phy_sts = my_phy_readreg(sc, PHY_BMCR);
366167aa833SJulian Elischer 	phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR;
367167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, phy_sts);
368167aa833SJulian Elischer 
369167aa833SJulian Elischer 	return;
370167aa833SJulian Elischer }
371167aa833SJulian Elischer 
372d4e576c4SJohn Baldwin static void
my_autoneg_timeout(void * arg)373d4e576c4SJohn Baldwin my_autoneg_timeout(void *arg)
374d4e576c4SJohn Baldwin {
375d4e576c4SJohn Baldwin 	struct my_softc *sc;
376d4e576c4SJohn Baldwin 
377d4e576c4SJohn Baldwin 	sc = arg;
378d4e576c4SJohn Baldwin 	MY_LOCK_ASSERT(sc);
379d4e576c4SJohn Baldwin 	my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1);
380d4e576c4SJohn Baldwin }
381167aa833SJulian Elischer 
382167aa833SJulian Elischer /*
383167aa833SJulian Elischer  * Invoke autonegotiation on a PHY.
384167aa833SJulian Elischer  */
385167aa833SJulian Elischer static void
my_autoneg_mii(struct my_softc * sc,int flag,int verbose)386167aa833SJulian Elischer my_autoneg_mii(struct my_softc * sc, int flag, int verbose)
387167aa833SJulian Elischer {
388167aa833SJulian Elischer 	u_int16_t       phy_sts = 0, media, advert, ability;
389167aa833SJulian Elischer 	u_int16_t       ability2 = 0;
39012d29e15SJustin Hibbits 	if_t		ifp;
391167aa833SJulian Elischer 	struct ifmedia *ifm;
392167aa833SJulian Elischer 
393ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
394167aa833SJulian Elischer 
395167aa833SJulian Elischer 	ifm = &sc->ifmedia;
396fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
397167aa833SJulian Elischer 
398167aa833SJulian Elischer 	ifm->ifm_media = IFM_ETHER | IFM_AUTO;
399167aa833SJulian Elischer 
400167aa833SJulian Elischer #ifndef FORCE_AUTONEG_TFOUR
401167aa833SJulian Elischer 	/*
402167aa833SJulian Elischer 	 * First, see if autoneg is supported. If not, there's no point in
403167aa833SJulian Elischer 	 * continuing.
404167aa833SJulian Elischer 	 */
405167aa833SJulian Elischer 	phy_sts = my_phy_readreg(sc, PHY_BMSR);
406167aa833SJulian Elischer 	if (!(phy_sts & PHY_BMSR_CANAUTONEG)) {
407167aa833SJulian Elischer 		if (verbose)
4086b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
4096b9f5c94SGleb Smirnoff 			    "autonegotiation not supported\n");
410167aa833SJulian Elischer 		ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
411167aa833SJulian Elischer 		return;
412167aa833SJulian Elischer 	}
413167aa833SJulian Elischer #endif
414167aa833SJulian Elischer 	switch (flag) {
415167aa833SJulian Elischer 	case MY_FLAG_FORCEDELAY:
416167aa833SJulian Elischer 		/*
417167aa833SJulian Elischer 		 * XXX Never use this option anywhere but in the probe
418167aa833SJulian Elischer 		 * routine: making the kernel stop dead in its tracks for
419167aa833SJulian Elischer 		 * three whole seconds after we've gone multi-user is really
420167aa833SJulian Elischer 		 * bad manners.
421167aa833SJulian Elischer 		 */
422167aa833SJulian Elischer 		my_autoneg_xmit(sc);
423167aa833SJulian Elischer 		DELAY(5000000);
424167aa833SJulian Elischer 		break;
425167aa833SJulian Elischer 	case MY_FLAG_SCHEDDELAY:
426167aa833SJulian Elischer 		/*
427167aa833SJulian Elischer 		 * Wait for the transmitter to go idle before starting an
428167aa833SJulian Elischer 		 * autoneg session, otherwise my_start() may clobber our
429167aa833SJulian Elischer 		 * timeout, and we don't want to allow transmission during an
430167aa833SJulian Elischer 		 * autoneg session since that can screw it up.
431167aa833SJulian Elischer 		 */
432167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_head != NULL) {
433167aa833SJulian Elischer 			sc->my_want_auto = 1;
434167aa833SJulian Elischer 			MY_UNLOCK(sc);
435167aa833SJulian Elischer 			return;
436167aa833SJulian Elischer 		}
437167aa833SJulian Elischer 		my_autoneg_xmit(sc);
438d4e576c4SJohn Baldwin 		callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout,
439d4e576c4SJohn Baldwin 		    sc);
440167aa833SJulian Elischer 		sc->my_autoneg = 1;
441167aa833SJulian Elischer 		sc->my_want_auto = 0;
442167aa833SJulian Elischer 		return;
443167aa833SJulian Elischer 	case MY_FLAG_DELAYTIMEO:
444d4e576c4SJohn Baldwin 		callout_stop(&sc->my_autoneg_timer);
445167aa833SJulian Elischer 		sc->my_autoneg = 0;
446167aa833SJulian Elischer 		break;
447167aa833SJulian Elischer 	default:
4486b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag);
449167aa833SJulian Elischer 		return;
450167aa833SJulian Elischer 	}
451167aa833SJulian Elischer 
452167aa833SJulian Elischer 	if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) {
453167aa833SJulian Elischer 		if (verbose)
4546b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg complete, ");
455167aa833SJulian Elischer 		phy_sts = my_phy_readreg(sc, PHY_BMSR);
456167aa833SJulian Elischer 	} else {
457167aa833SJulian Elischer 		if (verbose)
4586b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg not complete, ");
459167aa833SJulian Elischer 	}
460167aa833SJulian Elischer 
461167aa833SJulian Elischer 	media = my_phy_readreg(sc, PHY_BMCR);
462167aa833SJulian Elischer 
463167aa833SJulian Elischer 	/* Link is good. Report modes and set duplex mode. */
464167aa833SJulian Elischer 	if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) {
465167aa833SJulian Elischer 		if (verbose)
4666b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "link status good. ");
467167aa833SJulian Elischer 		advert = my_phy_readreg(sc, PHY_ANAR);
468167aa833SJulian Elischer 		ability = my_phy_readreg(sc, PHY_LPAR);
469167aa833SJulian Elischer 		if ((sc->my_pinfo->my_vid == MarvellPHYID0) ||
470167aa833SJulian Elischer 		    (sc->my_pinfo->my_vid == LevelOnePHYID0)) {
471167aa833SJulian Elischer 			ability2 = my_phy_readreg(sc, PHY_1000SR);
472167aa833SJulian Elischer 			if (ability2 & PHY_1000SR_1000BTXFULL) {
473167aa833SJulian Elischer 				advert = 0;
474167aa833SJulian Elischer 				ability = 0;
475167aa833SJulian Elischer 				/*
476167aa833SJulian Elischer 				 * this version did not support 1000M,
477167aa833SJulian Elischer 				 * ifm->ifm_media =
478b418ad5cSPoul-Henning Kamp 				 * IFM_ETHER|IFM_1000_T|IFM_FDX;
479167aa833SJulian Elischer 				 */
480167aa833SJulian Elischer 				ifm->ifm_media =
481167aa833SJulian Elischer 				    IFM_ETHER | IFM_100_TX | IFM_FDX;
482167aa833SJulian Elischer 				media &= ~PHY_BMCR_SPEEDSEL;
483167aa833SJulian Elischer 				media |= PHY_BMCR_1000;
484167aa833SJulian Elischer 				media |= PHY_BMCR_DUPLEX;
485167aa833SJulian Elischer 				printf("(full-duplex, 1000Mbps)\n");
486167aa833SJulian Elischer 			} else if (ability2 & PHY_1000SR_1000BTXHALF) {
487167aa833SJulian Elischer 				advert = 0;
488167aa833SJulian Elischer 				ability = 0;
489167aa833SJulian Elischer 				/*
490167aa833SJulian Elischer 				 * this version did not support 1000M,
491b418ad5cSPoul-Henning Kamp 				 * ifm->ifm_media = IFM_ETHER|IFM_1000_T;
492167aa833SJulian Elischer 				 */
493167aa833SJulian Elischer 				ifm->ifm_media = IFM_ETHER | IFM_100_TX;
494167aa833SJulian Elischer 				media &= ~PHY_BMCR_SPEEDSEL;
495167aa833SJulian Elischer 				media &= ~PHY_BMCR_DUPLEX;
496167aa833SJulian Elischer 				media |= PHY_BMCR_1000;
497167aa833SJulian Elischer 				printf("(half-duplex, 1000Mbps)\n");
498167aa833SJulian Elischer 			}
499167aa833SJulian Elischer 		}
500167aa833SJulian Elischer 		if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) {
501167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_T4;
502167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
503167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
504167aa833SJulian Elischer 			printf("(100baseT4)\n");
505167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_100BTXFULL &&
506167aa833SJulian Elischer 			   ability & PHY_ANAR_100BTXFULL) {
507167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
508167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
509167aa833SJulian Elischer 			media |= PHY_BMCR_DUPLEX;
510167aa833SJulian Elischer 			printf("(full-duplex, 100Mbps)\n");
511167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_100BTXHALF &&
512167aa833SJulian Elischer 			   ability & PHY_ANAR_100BTXHALF) {
513167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
514167aa833SJulian Elischer 			media |= PHY_BMCR_SPEEDSEL;
515167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
516167aa833SJulian Elischer 			printf("(half-duplex, 100Mbps)\n");
517167aa833SJulian Elischer 		} else if (advert & PHY_ANAR_10BTFULL &&
518167aa833SJulian Elischer 			   ability & PHY_ANAR_10BTFULL) {
519167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
520167aa833SJulian Elischer 			media &= ~PHY_BMCR_SPEEDSEL;
521167aa833SJulian Elischer 			media |= PHY_BMCR_DUPLEX;
522167aa833SJulian Elischer 			printf("(full-duplex, 10Mbps)\n");
523167aa833SJulian Elischer 		} else if (advert) {
524167aa833SJulian Elischer 			ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
525167aa833SJulian Elischer 			media &= ~PHY_BMCR_SPEEDSEL;
526167aa833SJulian Elischer 			media &= ~PHY_BMCR_DUPLEX;
527167aa833SJulian Elischer 			printf("(half-duplex, 10Mbps)\n");
528167aa833SJulian Elischer 		}
529167aa833SJulian Elischer 		media &= ~PHY_BMCR_AUTONEGENBL;
530167aa833SJulian Elischer 
531167aa833SJulian Elischer 		/* Set ASIC's duplex mode to match the PHY. */
532167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, media);
533167aa833SJulian Elischer 		my_setcfg(sc, media);
534167aa833SJulian Elischer 	} else {
535167aa833SJulian Elischer 		if (verbose)
5366b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "no carrier\n");
537167aa833SJulian Elischer 	}
538167aa833SJulian Elischer 
539ca5fc32dSJohn Baldwin 	my_init_locked(sc);
540167aa833SJulian Elischer 	if (sc->my_tx_pend) {
541167aa833SJulian Elischer 		sc->my_autoneg = 0;
542167aa833SJulian Elischer 		sc->my_tx_pend = 0;
543ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
544167aa833SJulian Elischer 	}
545167aa833SJulian Elischer 	return;
546167aa833SJulian Elischer }
547167aa833SJulian Elischer 
548167aa833SJulian Elischer /*
549167aa833SJulian Elischer  * To get PHY ability.
550167aa833SJulian Elischer  */
551167aa833SJulian Elischer static void
my_getmode_mii(struct my_softc * sc)552167aa833SJulian Elischer my_getmode_mii(struct my_softc * sc)
553167aa833SJulian Elischer {
554167aa833SJulian Elischer 	u_int16_t       bmsr;
55512d29e15SJustin Hibbits 	if_t		ifp;
556167aa833SJulian Elischer 
557ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
558fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
559167aa833SJulian Elischer 	bmsr = my_phy_readreg(sc, PHY_BMSR);
560167aa833SJulian Elischer 	if (bootverbose)
5616b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "PHY status word: %x\n", bmsr);
562167aa833SJulian Elischer 
563167aa833SJulian Elischer 	/* fallback */
564167aa833SJulian Elischer 	sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
565167aa833SJulian Elischer 
566167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_10BTHALF) {
567167aa833SJulian Elischer 		if (bootverbose)
5686b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5696b9f5c94SGleb Smirnoff 			    "10Mbps half-duplex mode supported\n");
570167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX,
571167aa833SJulian Elischer 		    0, NULL);
572167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL);
573167aa833SJulian Elischer 	}
574167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_10BTFULL) {
575167aa833SJulian Elischer 		if (bootverbose)
5766b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5776b9f5c94SGleb Smirnoff 			    "10Mbps full-duplex mode supported\n");
578167aa833SJulian Elischer 
579167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX,
580167aa833SJulian Elischer 		    0, NULL);
581167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
582167aa833SJulian Elischer 	}
583167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BTXHALF) {
584167aa833SJulian Elischer 		if (bootverbose)
5856b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5866b9f5c94SGleb Smirnoff 			    "100Mbps half-duplex mode supported\n");
58712d29e15SJustin Hibbits 		if_setbaudrate(ifp, 100000000);
588167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL);
589167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX,
590167aa833SJulian Elischer 			    0, NULL);
591167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
592167aa833SJulian Elischer 	}
593167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BTXFULL) {
594167aa833SJulian Elischer 		if (bootverbose)
5956b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
5966b9f5c94SGleb Smirnoff 			    "100Mbps full-duplex mode supported\n");
59712d29e15SJustin Hibbits 		if_setbaudrate(ifp, 100000000);
598167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX,
599167aa833SJulian Elischer 		    0, NULL);
600167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
601167aa833SJulian Elischer 	}
602167aa833SJulian Elischer 	/* Some also support 100BaseT4. */
603167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_100BT4) {
604167aa833SJulian Elischer 		if (bootverbose)
6056b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "100baseT4 mode supported\n");
60612d29e15SJustin Hibbits 		if_setbaudrate(ifp, 100000000);
607167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL);
608167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4;
609167aa833SJulian Elischer #ifdef FORCE_AUTONEG_TFOUR
610167aa833SJulian Elischer 		if (bootverbose)
6116b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6126b9f5c94SGleb Smirnoff 			    "forcing on autoneg support for BT4\n");
613167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL):
614167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
615167aa833SJulian Elischer #endif
616167aa833SJulian Elischer 	}
6170cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
618167aa833SJulian Elischer 	if (sc->my_pinfo->my_vid == MarvellPHYID0) {
619167aa833SJulian Elischer 		if (bootverbose)
6206b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6216b9f5c94SGleb Smirnoff 			    "1000Mbps half-duplex mode supported\n");
622167aa833SJulian Elischer 
62312d29e15SJustin Hibbits 		if_setbaudrate(ifp, 1000000000);
624b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL);
625b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX,
626167aa833SJulian Elischer 		    0, NULL);
627167aa833SJulian Elischer 		if (bootverbose)
6286b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
6296b9f5c94SGleb Smirnoff 			    "1000Mbps full-duplex mode supported\n");
63012d29e15SJustin Hibbits 		if_setbaudrate(ifp, 1000000000);
631b418ad5cSPoul-Henning Kamp 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX,
632167aa833SJulian Elischer 		    0, NULL);
633b418ad5cSPoul-Henning Kamp 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX;
634167aa833SJulian Elischer 	}
635167aa833SJulian Elischer #endif
636167aa833SJulian Elischer 	if (bmsr & PHY_BMSR_CANAUTONEG) {
637167aa833SJulian Elischer 		if (bootverbose)
6386b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "autoneg supported\n");
639167aa833SJulian Elischer 		ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL);
640167aa833SJulian Elischer 		sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
641167aa833SJulian Elischer 	}
642167aa833SJulian Elischer 	return;
643167aa833SJulian Elischer }
644167aa833SJulian Elischer 
645167aa833SJulian Elischer /*
646167aa833SJulian Elischer  * Set speed and duplex mode.
647167aa833SJulian Elischer  */
648167aa833SJulian Elischer static void
my_setmode_mii(struct my_softc * sc,int media)649167aa833SJulian Elischer my_setmode_mii(struct my_softc * sc, int media)
650167aa833SJulian Elischer {
651167aa833SJulian Elischer 	u_int16_t       bmcr;
652167aa833SJulian Elischer 
653ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
654167aa833SJulian Elischer 	/*
655167aa833SJulian Elischer 	 * If an autoneg session is in progress, stop it.
656167aa833SJulian Elischer 	 */
657167aa833SJulian Elischer 	if (sc->my_autoneg) {
6586b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "canceling autoneg session\n");
659d4e576c4SJohn Baldwin 		callout_stop(&sc->my_autoneg_timer);
660d4e576c4SJohn Baldwin 		sc->my_autoneg = sc->my_want_auto = 0;
661167aa833SJulian Elischer 		bmcr = my_phy_readreg(sc, PHY_BMCR);
662167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_AUTONEGENBL;
663167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, bmcr);
664167aa833SJulian Elischer 	}
6656b9f5c94SGleb Smirnoff 	device_printf(sc->my_dev, "selecting MII, ");
666167aa833SJulian Elischer 	bmcr = my_phy_readreg(sc, PHY_BMCR);
667167aa833SJulian Elischer 	bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 |
668167aa833SJulian Elischer 		  PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK);
6690cde2d13SJulian Elischer 
6700cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
671b418ad5cSPoul-Henning Kamp 	if (IFM_SUBTYPE(media) == IFM_1000_T) {
672167aa833SJulian Elischer 		printf("1000Mbps/T4, half-duplex\n");
673167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_SPEEDSEL;
674167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
675167aa833SJulian Elischer 		bmcr |= PHY_BMCR_1000;
676167aa833SJulian Elischer 	}
677167aa833SJulian Elischer #endif
678167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_100_T4) {
679167aa833SJulian Elischer 		printf("100Mbps/T4, half-duplex\n");
680167aa833SJulian Elischer 		bmcr |= PHY_BMCR_SPEEDSEL;
681167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
682167aa833SJulian Elischer 	}
683167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_100_TX) {
684167aa833SJulian Elischer 		printf("100Mbps, ");
685167aa833SJulian Elischer 		bmcr |= PHY_BMCR_SPEEDSEL;
686167aa833SJulian Elischer 	}
687167aa833SJulian Elischer 	if (IFM_SUBTYPE(media) == IFM_10_T) {
688167aa833SJulian Elischer 		printf("10Mbps, ");
689167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_SPEEDSEL;
690167aa833SJulian Elischer 	}
691167aa833SJulian Elischer 	if ((media & IFM_GMASK) == IFM_FDX) {
692167aa833SJulian Elischer 		printf("full duplex\n");
693167aa833SJulian Elischer 		bmcr |= PHY_BMCR_DUPLEX;
694167aa833SJulian Elischer 	} else {
695167aa833SJulian Elischer 		printf("half duplex\n");
696167aa833SJulian Elischer 		bmcr &= ~PHY_BMCR_DUPLEX;
697167aa833SJulian Elischer 	}
698167aa833SJulian Elischer 	my_phy_writereg(sc, PHY_BMCR, bmcr);
699167aa833SJulian Elischer 	my_setcfg(sc, bmcr);
700167aa833SJulian Elischer 	return;
701167aa833SJulian Elischer }
702167aa833SJulian Elischer 
703167aa833SJulian Elischer /*
704167aa833SJulian Elischer  * The Myson manual states that in order to fiddle with the 'full-duplex' and
705167aa833SJulian Elischer  * '100Mbps' bits in the netconfig register, we first have to put the
706167aa833SJulian Elischer  * transmit and/or receive logic in the idle state.
707167aa833SJulian Elischer  */
708167aa833SJulian Elischer static void
my_setcfg(struct my_softc * sc,int bmcr)709167aa833SJulian Elischer my_setcfg(struct my_softc * sc, int bmcr)
710167aa833SJulian Elischer {
711167aa833SJulian Elischer 	int             i, restart = 0;
712167aa833SJulian Elischer 
713ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
714167aa833SJulian Elischer 	if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) {
715167aa833SJulian Elischer 		restart = 1;
716167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE));
717167aa833SJulian Elischer 		for (i = 0; i < MY_TIMEOUT; i++) {
718167aa833SJulian Elischer 			DELAY(10);
719167aa833SJulian Elischer 			if (!(CSR_READ_4(sc, MY_TCRRCR) &
720167aa833SJulian Elischer 			    (MY_TXRUN | MY_RXRUN)))
721167aa833SJulian Elischer 				break;
722167aa833SJulian Elischer 		}
723167aa833SJulian Elischer 		if (i == MY_TIMEOUT)
7246b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev,
72512611131SJohn Baldwin 			    "failed to force tx and rx to idle \n");
726167aa833SJulian Elischer 	}
727167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000);
728167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_PS10);
729167aa833SJulian Elischer 	if (bmcr & PHY_BMCR_1000)
730167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PS1000);
731167aa833SJulian Elischer 	else if (!(bmcr & PHY_BMCR_SPEEDSEL))
732167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PS10);
733167aa833SJulian Elischer 	if (bmcr & PHY_BMCR_DUPLEX)
734167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_FD);
735167aa833SJulian Elischer 	else
736167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_FD);
737167aa833SJulian Elischer 	if (restart)
738167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE);
739167aa833SJulian Elischer 	return;
740167aa833SJulian Elischer }
741167aa833SJulian Elischer 
742167aa833SJulian Elischer static void
my_reset(struct my_softc * sc)743167aa833SJulian Elischer my_reset(struct my_softc * sc)
744167aa833SJulian Elischer {
7453e85b721SEd Maste 	int    i;
746167aa833SJulian Elischer 
747ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
748167aa833SJulian Elischer 	MY_SETBIT(sc, MY_BCR, MY_SWR);
749167aa833SJulian Elischer 	for (i = 0; i < MY_TIMEOUT; i++) {
750167aa833SJulian Elischer 		DELAY(10);
751167aa833SJulian Elischer 		if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR))
752167aa833SJulian Elischer 			break;
753167aa833SJulian Elischer 	}
754167aa833SJulian Elischer 	if (i == MY_TIMEOUT)
7556b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "reset never completed!\n");
756167aa833SJulian Elischer 
757167aa833SJulian Elischer 	/* Wait a little while for the chip to get its brains in order. */
758167aa833SJulian Elischer 	DELAY(1000);
759167aa833SJulian Elischer 	return;
760167aa833SJulian Elischer }
761167aa833SJulian Elischer 
762167aa833SJulian Elischer /*
763167aa833SJulian Elischer  * Probe for a Myson chip. Check the PCI vendor and device IDs against our
764167aa833SJulian Elischer  * list and return a device name if we find a match.
765167aa833SJulian Elischer  */
766167aa833SJulian Elischer static int
my_probe(device_t dev)767167aa833SJulian Elischer my_probe(device_t dev)
768167aa833SJulian Elischer {
769167aa833SJulian Elischer 	struct my_type *t;
770167aa833SJulian Elischer 
771167aa833SJulian Elischer 	t = my_devs;
772167aa833SJulian Elischer 	while (t->my_name != NULL) {
773167aa833SJulian Elischer 		if ((pci_get_vendor(dev) == t->my_vid) &&
774167aa833SJulian Elischer 		    (pci_get_device(dev) == t->my_did)) {
775167aa833SJulian Elischer 			device_set_desc(dev, t->my_name);
776167aa833SJulian Elischer 			my_info_tmp = t;
7776b9907e7SWarner Losh 			return (BUS_PROBE_DEFAULT);
778167aa833SJulian Elischer 		}
779167aa833SJulian Elischer 		t++;
780167aa833SJulian Elischer 	}
781167aa833SJulian Elischer 	return (ENXIO);
782167aa833SJulian Elischer }
783167aa833SJulian Elischer 
784167aa833SJulian Elischer /*
785167aa833SJulian Elischer  * Attach the interface. Allocate softc structures, do ifmedia setup and
786167aa833SJulian Elischer  * ethernet/BPF attach.
787167aa833SJulian Elischer  */
788167aa833SJulian Elischer static int
my_attach(device_t dev)789167aa833SJulian Elischer my_attach(device_t dev)
790167aa833SJulian Elischer {
791ca5fc32dSJohn Baldwin 	int             i;
792167aa833SJulian Elischer 	u_char          eaddr[ETHER_ADDR_LEN];
793bd295e68SJohn Baldwin 	u_int32_t       iobase;
794167aa833SJulian Elischer 	struct my_softc *sc;
79512d29e15SJustin Hibbits 	if_t		ifp;
796167aa833SJulian Elischer 	int             media = IFM_ETHER | IFM_100_TX | IFM_FDX;
797167aa833SJulian Elischer 	unsigned int    round;
798167aa833SJulian Elischer 	caddr_t         roundptr;
799167aa833SJulian Elischer 	struct my_type *p;
800167aa833SJulian Elischer 	u_int16_t       phy_vid, phy_did, phy_sts = 0;
80112611131SJohn Baldwin 	int             rid, error = 0;
802167aa833SJulian Elischer 
803167aa833SJulian Elischer 	sc = device_get_softc(dev);
8046b9f5c94SGleb Smirnoff 	sc->my_dev = dev;
805f269532cSJulian Elischer 	mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
806ca5fc32dSJohn Baldwin 	    MTX_DEF);
807d4e576c4SJohn Baldwin 	callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0);
808d4e576c4SJohn Baldwin 	callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0);
809167aa833SJulian Elischer 
810167aa833SJulian Elischer 	/*
811167aa833SJulian Elischer 	 * Map control/status registers.
812167aa833SJulian Elischer 	 */
813bd295e68SJohn Baldwin 	pci_enable_busmaster(dev);
814167aa833SJulian Elischer 
815167aa833SJulian Elischer 	if (my_info_tmp->my_did == MTD800ID) {
816167aa833SJulian Elischer 		iobase = pci_read_config(dev, MY_PCI_LOIO, 4);
817167aa833SJulian Elischer 		if (iobase & 0x300)
818167aa833SJulian Elischer 			MY_USEIOSPACE = 0;
819167aa833SJulian Elischer 	}
820167aa833SJulian Elischer 
821167aa833SJulian Elischer 	rid = MY_RID;
8225f96beb9SNate Lawson 	sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE);
823167aa833SJulian Elischer 
824167aa833SJulian Elischer 	if (sc->my_res == NULL) {
82512611131SJohn Baldwin 		device_printf(dev, "couldn't map ports/memory\n");
826167aa833SJulian Elischer 		error = ENXIO;
827ca5fc32dSJohn Baldwin 		goto destroy_mutex;
828167aa833SJulian Elischer 	}
829167aa833SJulian Elischer 	sc->my_btag = rman_get_bustag(sc->my_res);
830167aa833SJulian Elischer 	sc->my_bhandle = rman_get_bushandle(sc->my_res);
831167aa833SJulian Elischer 
832167aa833SJulian Elischer 	rid = 0;
8335f96beb9SNate Lawson 	sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
834167aa833SJulian Elischer 					    RF_SHAREABLE | RF_ACTIVE);
835167aa833SJulian Elischer 
836167aa833SJulian Elischer 	if (sc->my_irq == NULL) {
83712611131SJohn Baldwin 		device_printf(dev, "couldn't map interrupt\n");
838167aa833SJulian Elischer 		error = ENXIO;
839ca5fc32dSJohn Baldwin 		goto release_io;
840167aa833SJulian Elischer 	}
841167aa833SJulian Elischer 
842167aa833SJulian Elischer 	sc->my_info = my_info_tmp;
843167aa833SJulian Elischer 
844167aa833SJulian Elischer 	/* Reset the adapter. */
845ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
846167aa833SJulian Elischer 	my_reset(sc);
847ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
848167aa833SJulian Elischer 
849167aa833SJulian Elischer 	/*
850167aa833SJulian Elischer 	 * Get station address
851167aa833SJulian Elischer 	 */
852167aa833SJulian Elischer 	for (i = 0; i < ETHER_ADDR_LEN; ++i)
853167aa833SJulian Elischer 		eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i);
854167aa833SJulian Elischer 
855167aa833SJulian Elischer 	sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8,
856167aa833SJulian Elischer 				  M_DEVBUF, M_NOWAIT);
857167aa833SJulian Elischer 	if (sc->my_ldata_ptr == NULL) {
85812611131SJohn Baldwin 		device_printf(dev, "no memory for list buffers!\n");
859167aa833SJulian Elischer 		error = ENXIO;
860ca5fc32dSJohn Baldwin 		goto release_irq;
861167aa833SJulian Elischer 	}
862167aa833SJulian Elischer 	sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr;
8632fc606e2SJohn Baldwin 	round = (uintptr_t)sc->my_ldata_ptr & 0xF;
864167aa833SJulian Elischer 	roundptr = sc->my_ldata_ptr;
865167aa833SJulian Elischer 	for (i = 0; i < 8; i++) {
866167aa833SJulian Elischer 		if (round % 8) {
867167aa833SJulian Elischer 			round++;
868167aa833SJulian Elischer 			roundptr++;
869167aa833SJulian Elischer 		} else
870167aa833SJulian Elischer 			break;
871167aa833SJulian Elischer 	}
872167aa833SJulian Elischer 	sc->my_ldata = (struct my_list_data *) roundptr;
873167aa833SJulian Elischer 	bzero(sc->my_ldata, sizeof(struct my_list_data));
874167aa833SJulian Elischer 
875fc74a9f9SBrooks Davis 	ifp = sc->my_ifp = if_alloc(IFT_ETHER);
876fc74a9f9SBrooks Davis 	if (ifp == NULL) {
877fc74a9f9SBrooks Davis 		device_printf(dev, "can not if_alloc()\n");
878fc74a9f9SBrooks Davis 		error = ENOSPC;
879ca5fc32dSJohn Baldwin 		goto free_ldata;
880fc74a9f9SBrooks Davis 	}
88112d29e15SJustin Hibbits 	if_setsoftc(ifp, sc);
8829bf40edeSBrooks Davis 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
88312d29e15SJustin Hibbits 	if_setflags(ifp, IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST);
88412d29e15SJustin Hibbits 	if_setioctlfn(ifp, my_ioctl);
88512d29e15SJustin Hibbits 	if_setstartfn(ifp, my_start);
88612d29e15SJustin Hibbits 	if_setinitfn(ifp, my_init);
88712d29e15SJustin Hibbits 	if_setbaudrate(ifp, 10000000);
88812d29e15SJustin Hibbits 	if_setsendqlen(ifp, ifqmaxlen);
88912d29e15SJustin Hibbits 	if_setsendqready(ifp);
890167aa833SJulian Elischer 
891167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD803ID)
892167aa833SJulian Elischer 		sc->my_pinfo = my_phys;
893167aa833SJulian Elischer 	else {
894167aa833SJulian Elischer 		if (bootverbose)
89512611131SJohn Baldwin 			device_printf(dev, "probing for a PHY\n");
896ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
897167aa833SJulian Elischer 		for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) {
898167aa833SJulian Elischer 			if (bootverbose)
89912611131SJohn Baldwin 				device_printf(dev, "checking address: %d\n", i);
900167aa833SJulian Elischer 			sc->my_phy_addr = i;
901167aa833SJulian Elischer 			phy_sts = my_phy_readreg(sc, PHY_BMSR);
902167aa833SJulian Elischer 			if ((phy_sts != 0) && (phy_sts != 0xffff))
903167aa833SJulian Elischer 				break;
904167aa833SJulian Elischer 			else
905167aa833SJulian Elischer 				phy_sts = 0;
906167aa833SJulian Elischer 		}
907167aa833SJulian Elischer 		if (phy_sts) {
908167aa833SJulian Elischer 			phy_vid = my_phy_readreg(sc, PHY_VENID);
909167aa833SJulian Elischer 			phy_did = my_phy_readreg(sc, PHY_DEVID);
910167aa833SJulian Elischer 			if (bootverbose) {
91112611131SJohn Baldwin 				device_printf(dev, "found PHY at address %d, ",
91212611131SJohn Baldwin 				    sc->my_phy_addr);
913167aa833SJulian Elischer 				printf("vendor id: %x device id: %x\n",
914167aa833SJulian Elischer 				    phy_vid, phy_did);
915167aa833SJulian Elischer 			}
916167aa833SJulian Elischer 			p = my_phys;
917167aa833SJulian Elischer 			while (p->my_vid) {
918167aa833SJulian Elischer 				if (phy_vid == p->my_vid) {
919167aa833SJulian Elischer 					sc->my_pinfo = p;
920167aa833SJulian Elischer 					break;
921167aa833SJulian Elischer 				}
922167aa833SJulian Elischer 				p++;
923167aa833SJulian Elischer 			}
924167aa833SJulian Elischer 			if (sc->my_pinfo == NULL)
925167aa833SJulian Elischer 				sc->my_pinfo = &my_phys[PHY_UNKNOWN];
926167aa833SJulian Elischer 			if (bootverbose)
92712611131SJohn Baldwin 				device_printf(dev, "PHY type: %s\n",
92812611131SJohn Baldwin 				       sc->my_pinfo->my_name);
929167aa833SJulian Elischer 		} else {
930ca5fc32dSJohn Baldwin 			MY_UNLOCK(sc);
93112611131SJohn Baldwin 			device_printf(dev, "MII without any phy!\n");
932167aa833SJulian Elischer 			error = ENXIO;
933ca5fc32dSJohn Baldwin 			goto free_if;
934167aa833SJulian Elischer 		}
935ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
936167aa833SJulian Elischer 	}
937167aa833SJulian Elischer 
938167aa833SJulian Elischer 	/* Do ifmedia setup. */
939167aa833SJulian Elischer 	ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts);
940ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
941167aa833SJulian Elischer 	my_getmode_mii(sc);
942167aa833SJulian Elischer 	my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1);
943167aa833SJulian Elischer 	media = sc->ifmedia.ifm_media;
944167aa833SJulian Elischer 	my_stop(sc);
945ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
946167aa833SJulian Elischer 	ifmedia_set(&sc->ifmedia, media);
947167aa833SJulian Elischer 
948673d9191SSam Leffler 	ether_ifattach(ifp, eaddr);
949167aa833SJulian Elischer 
950ca5fc32dSJohn Baldwin 	error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE,
951ef544f63SPaolo Pisati 			       NULL, my_intr, sc, &sc->my_intrhand);
952ca5fc32dSJohn Baldwin 
953ca5fc32dSJohn Baldwin 	if (error) {
954ca5fc32dSJohn Baldwin 		device_printf(dev, "couldn't set up irq\n");
955ca5fc32dSJohn Baldwin 		goto detach_if;
956ca5fc32dSJohn Baldwin 	}
957ca5fc32dSJohn Baldwin 
958167aa833SJulian Elischer 	return (0);
959167aa833SJulian Elischer 
960ca5fc32dSJohn Baldwin detach_if:
961ca5fc32dSJohn Baldwin 	ether_ifdetach(ifp);
962ca5fc32dSJohn Baldwin free_if:
963ca5fc32dSJohn Baldwin 	if_free(ifp);
964ca5fc32dSJohn Baldwin free_ldata:
965fc74a9f9SBrooks Davis 	free(sc->my_ldata_ptr, M_DEVBUF);
966ca5fc32dSJohn Baldwin release_irq:
967ca5fc32dSJohn Baldwin 	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
968ca5fc32dSJohn Baldwin release_io:
969ca5fc32dSJohn Baldwin 	bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
970ca5fc32dSJohn Baldwin destroy_mutex:
971ca5fc32dSJohn Baldwin 	mtx_destroy(&sc->my_mtx);
972167aa833SJulian Elischer 	return (error);
973167aa833SJulian Elischer }
974167aa833SJulian Elischer 
975167aa833SJulian Elischer static int
my_detach(device_t dev)976167aa833SJulian Elischer my_detach(device_t dev)
977167aa833SJulian Elischer {
978167aa833SJulian Elischer 	struct my_softc *sc;
97912d29e15SJustin Hibbits 	if_t		ifp;
980167aa833SJulian Elischer 
981167aa833SJulian Elischer 	sc = device_get_softc(dev);
982d4e576c4SJohn Baldwin 	ifp = sc->my_ifp;
983d4e576c4SJohn Baldwin 	ether_ifdetach(ifp);
984167aa833SJulian Elischer 	MY_LOCK(sc);
985ca5fc32dSJohn Baldwin 	my_stop(sc);
986ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
987ca5fc32dSJohn Baldwin 	bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand);
988d4e576c4SJohn Baldwin 	callout_drain(&sc->my_watchdog);
989d4e576c4SJohn Baldwin 	callout_drain(&sc->my_autoneg_timer);
990ca5fc32dSJohn Baldwin 
991fc74a9f9SBrooks Davis 	if_free(ifp);
992ca5fc32dSJohn Baldwin 	free(sc->my_ldata_ptr, M_DEVBUF);
993167aa833SJulian Elischer 
994167aa833SJulian Elischer 	bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
995167aa833SJulian Elischer 	bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
996167aa833SJulian Elischer 	mtx_destroy(&sc->my_mtx);
997167aa833SJulian Elischer 	return (0);
998167aa833SJulian Elischer }
999167aa833SJulian Elischer 
1000167aa833SJulian Elischer /*
1001167aa833SJulian Elischer  * Initialize the transmit descriptors.
1002167aa833SJulian Elischer  */
1003167aa833SJulian Elischer static int
my_list_tx_init(struct my_softc * sc)1004167aa833SJulian Elischer my_list_tx_init(struct my_softc * sc)
1005167aa833SJulian Elischer {
1006167aa833SJulian Elischer 	struct my_chain_data *cd;
1007167aa833SJulian Elischer 	struct my_list_data *ld;
1008167aa833SJulian Elischer 	int             i;
1009167aa833SJulian Elischer 
1010ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1011167aa833SJulian Elischer 	cd = &sc->my_cdata;
1012167aa833SJulian Elischer 	ld = sc->my_ldata;
1013167aa833SJulian Elischer 	for (i = 0; i < MY_TX_LIST_CNT; i++) {
1014167aa833SJulian Elischer 		cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i];
1015167aa833SJulian Elischer 		if (i == (MY_TX_LIST_CNT - 1))
1016167aa833SJulian Elischer 			cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0];
1017167aa833SJulian Elischer 		else
1018167aa833SJulian Elischer 			cd->my_tx_chain[i].my_nextdesc =
1019167aa833SJulian Elischer 			    &cd->my_tx_chain[i + 1];
1020167aa833SJulian Elischer 	}
1021167aa833SJulian Elischer 	cd->my_tx_free = &cd->my_tx_chain[0];
1022167aa833SJulian Elischer 	cd->my_tx_tail = cd->my_tx_head = NULL;
1023167aa833SJulian Elischer 	return (0);
1024167aa833SJulian Elischer }
1025167aa833SJulian Elischer 
1026167aa833SJulian Elischer /*
1027167aa833SJulian Elischer  * Initialize the RX descriptors and allocate mbufs for them. Note that we
1028167aa833SJulian Elischer  * arrange the descriptors in a closed ring, so that the last descriptor
1029167aa833SJulian Elischer  * points back to the first.
1030167aa833SJulian Elischer  */
1031167aa833SJulian Elischer static int
my_list_rx_init(struct my_softc * sc)1032167aa833SJulian Elischer my_list_rx_init(struct my_softc * sc)
1033167aa833SJulian Elischer {
1034167aa833SJulian Elischer 	struct my_chain_data *cd;
1035167aa833SJulian Elischer 	struct my_list_data *ld;
1036167aa833SJulian Elischer 	int             i;
1037167aa833SJulian Elischer 
1038ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1039167aa833SJulian Elischer 	cd = &sc->my_cdata;
1040167aa833SJulian Elischer 	ld = sc->my_ldata;
1041167aa833SJulian Elischer 	for (i = 0; i < MY_RX_LIST_CNT; i++) {
1042167aa833SJulian Elischer 		cd->my_rx_chain[i].my_ptr =
1043167aa833SJulian Elischer 		    (struct my_desc *) & ld->my_rx_list[i];
1044a86d27acSJulian Elischer 		if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) {
1045a86d27acSJulian Elischer 			MY_UNLOCK(sc);
1046167aa833SJulian Elischer 			return (ENOBUFS);
1047a86d27acSJulian Elischer 		}
1048167aa833SJulian Elischer 		if (i == (MY_RX_LIST_CNT - 1)) {
1049167aa833SJulian Elischer 			cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0];
1050167aa833SJulian Elischer 			ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]);
1051167aa833SJulian Elischer 		} else {
1052167aa833SJulian Elischer 			cd->my_rx_chain[i].my_nextdesc =
1053167aa833SJulian Elischer 			    &cd->my_rx_chain[i + 1];
1054167aa833SJulian Elischer 			ld->my_rx_list[i].my_next =
1055167aa833SJulian Elischer 			    vtophys(&ld->my_rx_list[i + 1]);
1056167aa833SJulian Elischer 		}
1057167aa833SJulian Elischer 	}
1058167aa833SJulian Elischer 	cd->my_rx_head = &cd->my_rx_chain[0];
1059167aa833SJulian Elischer 	return (0);
1060167aa833SJulian Elischer }
1061167aa833SJulian Elischer 
1062167aa833SJulian Elischer /*
1063167aa833SJulian Elischer  * Initialize an RX descriptor and attach an MBUF cluster.
1064167aa833SJulian Elischer  */
1065167aa833SJulian Elischer static int
my_newbuf(struct my_softc * sc,struct my_chain_onefrag * c)1066167aa833SJulian Elischer my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c)
1067167aa833SJulian Elischer {
1068167aa833SJulian Elischer 	struct mbuf    *m_new = NULL;
1069167aa833SJulian Elischer 
1070ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1071c6499eccSGleb Smirnoff 	MGETHDR(m_new, M_NOWAIT, MT_DATA);
1072167aa833SJulian Elischer 	if (m_new == NULL) {
10736b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev,
107412611131SJohn Baldwin 		    "no memory for rx list -- packet dropped!\n");
1075167aa833SJulian Elischer 		return (ENOBUFS);
1076167aa833SJulian Elischer 	}
10772a8c860fSRobert Watson 	if (!(MCLGET(m_new, M_NOWAIT))) {
10786b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev,
107912611131SJohn Baldwin 		    "no memory for rx list -- packet dropped!\n");
1080167aa833SJulian Elischer 		m_freem(m_new);
1081167aa833SJulian Elischer 		return (ENOBUFS);
1082167aa833SJulian Elischer 	}
1083167aa833SJulian Elischer 	c->my_mbuf = m_new;
1084167aa833SJulian Elischer 	c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t));
1085167aa833SJulian Elischer 	c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift;
1086167aa833SJulian Elischer 	c->my_ptr->my_status = MY_OWNByNIC;
1087167aa833SJulian Elischer 	return (0);
1088167aa833SJulian Elischer }
1089167aa833SJulian Elischer 
1090167aa833SJulian Elischer /*
1091167aa833SJulian Elischer  * A frame has been uploaded: pass the resulting mbuf chain up to the higher
1092167aa833SJulian Elischer  * level protocols.
1093167aa833SJulian Elischer  */
1094167aa833SJulian Elischer static void
my_rxeof(struct my_softc * sc)1095167aa833SJulian Elischer my_rxeof(struct my_softc * sc)
1096167aa833SJulian Elischer {
1097167aa833SJulian Elischer 	struct ether_header *eh;
1098167aa833SJulian Elischer 	struct mbuf    *m;
109912d29e15SJustin Hibbits 	if_t		ifp;
1100167aa833SJulian Elischer 	struct my_chain_onefrag *cur_rx;
1101167aa833SJulian Elischer 	int             total_len = 0;
1102167aa833SJulian Elischer 	u_int32_t       rxstat;
1103167aa833SJulian Elischer 
1104ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1105fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1106167aa833SJulian Elischer 	while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status)
1107167aa833SJulian Elischer 	    & MY_OWNByNIC)) {
1108167aa833SJulian Elischer 		cur_rx = sc->my_cdata.my_rx_head;
1109167aa833SJulian Elischer 		sc->my_cdata.my_rx_head = cur_rx->my_nextdesc;
1110167aa833SJulian Elischer 
1111167aa833SJulian Elischer 		if (rxstat & MY_ES) {	/* error summary: give up this rx pkt */
1112dde47b55SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1113167aa833SJulian Elischer 			cur_rx->my_ptr->my_status = MY_OWNByNIC;
1114167aa833SJulian Elischer 			continue;
1115167aa833SJulian Elischer 		}
1116167aa833SJulian Elischer 		/* No errors; receive the packet. */
1117167aa833SJulian Elischer 		total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift;
1118167aa833SJulian Elischer 		total_len -= ETHER_CRC_LEN;
1119167aa833SJulian Elischer 
1120167aa833SJulian Elischer 		if (total_len < MINCLSIZE) {
1121167aa833SJulian Elischer 			m = m_devget(mtod(cur_rx->my_mbuf, char *),
1122167aa833SJulian Elischer 			    total_len, 0, ifp, NULL);
1123167aa833SJulian Elischer 			cur_rx->my_ptr->my_status = MY_OWNByNIC;
1124167aa833SJulian Elischer 			if (m == NULL) {
1125dde47b55SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1126167aa833SJulian Elischer 				continue;
1127167aa833SJulian Elischer 			}
1128167aa833SJulian Elischer 		} else {
1129167aa833SJulian Elischer 			m = cur_rx->my_mbuf;
1130167aa833SJulian Elischer 			/*
1131167aa833SJulian Elischer 			 * Try to conjure up a new mbuf cluster. If that
1132167aa833SJulian Elischer 			 * fails, it means we have an out of memory condition
1133167aa833SJulian Elischer 			 * and should leave the buffer in place and continue.
1134167aa833SJulian Elischer 			 * This will result in a lost packet, but there's
1135167aa833SJulian Elischer 			 * little else we can do in this situation.
1136167aa833SJulian Elischer 			 */
1137167aa833SJulian Elischer 			if (my_newbuf(sc, cur_rx) == ENOBUFS) {
1138dde47b55SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1139167aa833SJulian Elischer 				cur_rx->my_ptr->my_status = MY_OWNByNIC;
1140167aa833SJulian Elischer 				continue;
1141167aa833SJulian Elischer 			}
1142167aa833SJulian Elischer 			m->m_pkthdr.rcvif = ifp;
1143167aa833SJulian Elischer 			m->m_pkthdr.len = m->m_len = total_len;
1144167aa833SJulian Elischer 		}
1145dde47b55SGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
1146167aa833SJulian Elischer 		eh = mtod(m, struct ether_header *);
1147167aa833SJulian Elischer #if NBPFILTER > 0
1148167aa833SJulian Elischer 		/*
1149167aa833SJulian Elischer 		 * Handle BPF listeners. Let the BPF user see the packet, but
1150167aa833SJulian Elischer 		 * don't pass it up to the ether_input() layer unless it's a
1151167aa833SJulian Elischer 		 * broadcast packet, multicast packet, matches our ethernet
1152167aa833SJulian Elischer 		 * address or the interface is in promiscuous mode.
1153167aa833SJulian Elischer 		 */
11548f31b879SJustin Hibbits 		if (bpf_peers_present_if(ifp)) {
115512d29e15SJustin Hibbits 			bpf_mtap_if(ifp, m);
115612d29e15SJustin Hibbits 			if (if_getflags(ifp) & IFF_PROMISC &&
115712d29e15SJustin Hibbits 			    (bcmp(eh->ether_dhost, if_getlladdr(sc->my_ifp),
1158167aa833SJulian Elischer 				ETHER_ADDR_LEN) &&
1159167aa833SJulian Elischer 			     (eh->ether_dhost[0] & 1) == 0)) {
1160167aa833SJulian Elischer 				m_freem(m);
1161167aa833SJulian Elischer 				continue;
1162167aa833SJulian Elischer 			}
1163167aa833SJulian Elischer 		}
1164167aa833SJulian Elischer #endif
11655120abbfSSam Leffler 		MY_UNLOCK(sc);
116612d29e15SJustin Hibbits 		if_input(ifp, m);
11675120abbfSSam Leffler 		MY_LOCK(sc);
1168167aa833SJulian Elischer 	}
1169167aa833SJulian Elischer 	return;
1170167aa833SJulian Elischer }
1171167aa833SJulian Elischer 
1172167aa833SJulian Elischer /*
1173167aa833SJulian Elischer  * A frame was downloaded to the chip. It's safe for us to clean up the list
1174167aa833SJulian Elischer  * buffers.
1175167aa833SJulian Elischer  */
1176167aa833SJulian Elischer static void
my_txeof(struct my_softc * sc)1177167aa833SJulian Elischer my_txeof(struct my_softc * sc)
1178167aa833SJulian Elischer {
1179167aa833SJulian Elischer 	struct my_chain *cur_tx;
118012d29e15SJustin Hibbits 	if_t		ifp;
1181167aa833SJulian Elischer 
1182ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1183fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1184167aa833SJulian Elischer 	/* Clear the timeout timer. */
1185d4e576c4SJohn Baldwin 	sc->my_timer = 0;
11868ac00c27SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL) {
1187167aa833SJulian Elischer 		return;
11888ac00c27SJulian Elischer 	}
1189167aa833SJulian Elischer 	/*
1190167aa833SJulian Elischer 	 * Go through our tx list and free mbufs for those frames that have
1191167aa833SJulian Elischer 	 * been transmitted.
1192167aa833SJulian Elischer 	 */
1193167aa833SJulian Elischer 	while (sc->my_cdata.my_tx_head->my_mbuf != NULL) {
1194167aa833SJulian Elischer 		u_int32_t       txstat;
1195167aa833SJulian Elischer 
1196167aa833SJulian Elischer 		cur_tx = sc->my_cdata.my_tx_head;
1197167aa833SJulian Elischer 		txstat = MY_TXSTATUS(cur_tx);
1198167aa833SJulian Elischer 		if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT)
1199167aa833SJulian Elischer 			break;
1200167aa833SJulian Elischer 		if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) {
1201167aa833SJulian Elischer 			if (txstat & MY_TXERR) {
1202dde47b55SGleb Smirnoff 				if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
1203167aa833SJulian Elischer 				if (txstat & MY_EC) /* excessive collision */
1204dde47b55SGleb Smirnoff 					if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1205167aa833SJulian Elischer 				if (txstat & MY_LC)	/* late collision */
1206dde47b55SGleb Smirnoff 					if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1207167aa833SJulian Elischer 			}
1208dde47b55SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_COLLISIONS,
1209dde47b55SGleb Smirnoff 			    (txstat & MY_NCRMASK) >> MY_NCRShift);
1210167aa833SJulian Elischer 		}
1211dde47b55SGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1212167aa833SJulian Elischer 		m_freem(cur_tx->my_mbuf);
1213167aa833SJulian Elischer 		cur_tx->my_mbuf = NULL;
1214167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) {
1215167aa833SJulian Elischer 			sc->my_cdata.my_tx_head = NULL;
1216167aa833SJulian Elischer 			sc->my_cdata.my_tx_tail = NULL;
1217167aa833SJulian Elischer 			break;
1218167aa833SJulian Elischer 		}
1219167aa833SJulian Elischer 		sc->my_cdata.my_tx_head = cur_tx->my_nextdesc;
1220167aa833SJulian Elischer 	}
1221167aa833SJulian Elischer 	if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) {
1222dde47b55SGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_COLLISIONS, (CSR_READ_4(sc, MY_TSR) & MY_NCRMask));
1223167aa833SJulian Elischer 	}
1224167aa833SJulian Elischer 	return;
1225167aa833SJulian Elischer }
1226167aa833SJulian Elischer 
1227167aa833SJulian Elischer /*
1228167aa833SJulian Elischer  * TX 'end of channel' interrupt handler.
1229167aa833SJulian Elischer  */
1230167aa833SJulian Elischer static void
my_txeoc(struct my_softc * sc)1231167aa833SJulian Elischer my_txeoc(struct my_softc * sc)
1232167aa833SJulian Elischer {
123312d29e15SJustin Hibbits 	if_t		ifp;
1234167aa833SJulian Elischer 
1235ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1236fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1237d4e576c4SJohn Baldwin 	sc->my_timer = 0;
1238167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL) {
123912d29e15SJustin Hibbits 		if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
1240167aa833SJulian Elischer 		sc->my_cdata.my_tx_tail = NULL;
1241167aa833SJulian Elischer 		if (sc->my_want_auto)
1242167aa833SJulian Elischer 			my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1243167aa833SJulian Elischer 	} else {
1244167aa833SJulian Elischer 		if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) {
1245167aa833SJulian Elischer 			MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC;
1246d4e576c4SJohn Baldwin 			sc->my_timer = 5;
1247167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);
1248167aa833SJulian Elischer 		}
1249167aa833SJulian Elischer 	}
1250167aa833SJulian Elischer 	return;
1251167aa833SJulian Elischer }
1252167aa833SJulian Elischer 
1253167aa833SJulian Elischer static void
my_intr(void * arg)1254167aa833SJulian Elischer my_intr(void *arg)
1255167aa833SJulian Elischer {
1256167aa833SJulian Elischer 	struct my_softc *sc;
125712d29e15SJustin Hibbits 	if_t		ifp;
1258167aa833SJulian Elischer 	u_int32_t       status;
1259167aa833SJulian Elischer 
1260167aa833SJulian Elischer 	sc = arg;
1261167aa833SJulian Elischer 	MY_LOCK(sc);
1262fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
126312d29e15SJustin Hibbits 	if (!(if_getflags(ifp) & IFF_UP)) {
1264167aa833SJulian Elischer 		MY_UNLOCK(sc);
1265167aa833SJulian Elischer 		return;
1266167aa833SJulian Elischer 	}
1267167aa833SJulian Elischer 	/* Disable interrupts. */
1268167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1269167aa833SJulian Elischer 
1270167aa833SJulian Elischer 	for (;;) {
1271167aa833SJulian Elischer 		status = CSR_READ_4(sc, MY_ISR);
1272167aa833SJulian Elischer 		status &= MY_INTRS;
1273167aa833SJulian Elischer 		if (status)
1274167aa833SJulian Elischer 			CSR_WRITE_4(sc, MY_ISR, status);
1275167aa833SJulian Elischer 		else
1276167aa833SJulian Elischer 			break;
1277167aa833SJulian Elischer 
1278167aa833SJulian Elischer 		if (status & MY_RI)	/* receive interrupt */
1279167aa833SJulian Elischer 			my_rxeof(sc);
1280167aa833SJulian Elischer 
1281167aa833SJulian Elischer 		if ((status & MY_RBU) || (status & MY_RxErr)) {
1282167aa833SJulian Elischer 			/* rx buffer unavailable or rx error */
1283dde47b55SGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1284167aa833SJulian Elischer #ifdef foo
1285167aa833SJulian Elischer 			my_stop(sc);
1286167aa833SJulian Elischer 			my_reset(sc);
1287ca5fc32dSJohn Baldwin 			my_init_locked(sc);
1288167aa833SJulian Elischer #endif
1289167aa833SJulian Elischer 		}
1290167aa833SJulian Elischer 		if (status & MY_TI)	/* tx interrupt */
1291167aa833SJulian Elischer 			my_txeof(sc);
1292167aa833SJulian Elischer 		if (status & MY_ETI)	/* tx early interrupt */
1293167aa833SJulian Elischer 			my_txeof(sc);
1294167aa833SJulian Elischer 		if (status & MY_TBU)	/* tx buffer unavailable */
1295167aa833SJulian Elischer 			my_txeoc(sc);
12960cde2d13SJulian Elischer 
12970cde2d13SJulian Elischer #if 0				/* 90/1/18 delete */
12980cde2d13SJulian Elischer 		if (status & MY_FBE) {
12990cde2d13SJulian Elischer 			my_reset(sc);
1300ca5fc32dSJohn Baldwin 			my_init_locked(sc);
13010cde2d13SJulian Elischer 		}
13020cde2d13SJulian Elischer #endif
1303167aa833SJulian Elischer 	}
1304167aa833SJulian Elischer 
1305167aa833SJulian Elischer 	/* Re-enable interrupts. */
1306167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
130712d29e15SJustin Hibbits 	if (!if_sendq_empty(ifp))
1308ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
1309167aa833SJulian Elischer 	MY_UNLOCK(sc);
1310167aa833SJulian Elischer 	return;
1311167aa833SJulian Elischer }
1312167aa833SJulian Elischer 
1313167aa833SJulian Elischer /*
1314167aa833SJulian Elischer  * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1315167aa833SJulian Elischer  * pointers to the fragment pointers.
1316167aa833SJulian Elischer  */
1317167aa833SJulian Elischer static int
my_encap(struct my_softc * sc,struct my_chain * c,struct mbuf * m_head)1318167aa833SJulian Elischer my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head)
1319167aa833SJulian Elischer {
1320167aa833SJulian Elischer 	struct my_desc *f = NULL;
1321167aa833SJulian Elischer 	int             total_len;
1322167aa833SJulian Elischer 	struct mbuf    *m, *m_new = NULL;
1323167aa833SJulian Elischer 
1324ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1325167aa833SJulian Elischer 	/* calculate the total tx pkt length */
1326167aa833SJulian Elischer 	total_len = 0;
1327167aa833SJulian Elischer 	for (m = m_head; m != NULL; m = m->m_next)
1328167aa833SJulian Elischer 		total_len += m->m_len;
1329167aa833SJulian Elischer 	/*
1330167aa833SJulian Elischer 	 * Start packing the mbufs in this chain into the fragment pointers.
1331167aa833SJulian Elischer 	 * Stop when we run out of fragments or hit the end of the mbuf
1332167aa833SJulian Elischer 	 * chain.
1333167aa833SJulian Elischer 	 */
1334167aa833SJulian Elischer 	m = m_head;
1335c6499eccSGleb Smirnoff 	MGETHDR(m_new, M_NOWAIT, MT_DATA);
1336167aa833SJulian Elischer 	if (m_new == NULL) {
13376b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "no memory for tx list");
1338167aa833SJulian Elischer 		return (1);
1339167aa833SJulian Elischer 	}
1340167aa833SJulian Elischer 	if (m_head->m_pkthdr.len > MHLEN) {
13412a8c860fSRobert Watson 		if (!(MCLGET(m_new, M_NOWAIT))) {
1342167aa833SJulian Elischer 			m_freem(m_new);
13436b9f5c94SGleb Smirnoff 			device_printf(sc->my_dev, "no memory for tx list");
1344167aa833SJulian Elischer 			return (1);
1345167aa833SJulian Elischer 		}
1346167aa833SJulian Elischer 	}
1347167aa833SJulian Elischer 	m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t));
1348167aa833SJulian Elischer 	m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len;
1349167aa833SJulian Elischer 	m_freem(m_head);
1350167aa833SJulian Elischer 	m_head = m_new;
1351167aa833SJulian Elischer 	f = &c->my_ptr->my_frag[0];
1352167aa833SJulian Elischer 	f->my_status = 0;
1353167aa833SJulian Elischer 	f->my_data = vtophys(mtod(m_new, caddr_t));
1354167aa833SJulian Elischer 	total_len = m_new->m_len;
1355167aa833SJulian Elischer 	f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable;
1356167aa833SJulian Elischer 	f->my_ctl |= total_len << MY_PKTShift;	/* pkt size */
1357167aa833SJulian Elischer 	f->my_ctl |= total_len;	/* buffer size */
13582cc8ce3cSJulian Elischer 	/* 89/12/29 add, for mtd891 *//* [ 89? ] */
1359167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD891ID)
1360167aa833SJulian Elischer 		f->my_ctl |= MY_ETIControl | MY_RetryTxLC;
1361167aa833SJulian Elischer 	c->my_mbuf = m_head;
1362167aa833SJulian Elischer 	c->my_lastdesc = 0;
1363167aa833SJulian Elischer 	MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]);
1364167aa833SJulian Elischer 	return (0);
1365167aa833SJulian Elischer }
1366167aa833SJulian Elischer 
1367167aa833SJulian Elischer /*
1368167aa833SJulian Elischer  * Main transmit routine. To avoid having to do mbuf copies, we put pointers
1369167aa833SJulian Elischer  * to the mbuf data regions directly in the transmit lists. We also save a
1370167aa833SJulian Elischer  * copy of the pointers since the transmit list fragment pointers are
1371167aa833SJulian Elischer  * physical addresses.
1372167aa833SJulian Elischer  */
1373167aa833SJulian Elischer static void
my_start(if_t ifp)137412d29e15SJustin Hibbits my_start(if_t ifp)
1375167aa833SJulian Elischer {
1376167aa833SJulian Elischer 	struct my_softc *sc;
1377ca5fc32dSJohn Baldwin 
137812d29e15SJustin Hibbits 	sc = if_getsoftc(ifp);
1379ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
1380ca5fc32dSJohn Baldwin 	my_start_locked(ifp);
1381ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1382ca5fc32dSJohn Baldwin }
1383ca5fc32dSJohn Baldwin 
1384ca5fc32dSJohn Baldwin static void
my_start_locked(if_t ifp)138512d29e15SJustin Hibbits my_start_locked(if_t ifp)
1386ca5fc32dSJohn Baldwin {
1387ca5fc32dSJohn Baldwin 	struct my_softc *sc;
1388167aa833SJulian Elischer 	struct mbuf    *m_head = NULL;
1389167aa833SJulian Elischer 	struct my_chain *cur_tx = NULL, *start_tx;
1390167aa833SJulian Elischer 
139112d29e15SJustin Hibbits 	sc = if_getsoftc(ifp);
1392ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1393167aa833SJulian Elischer 	if (sc->my_autoneg) {
1394167aa833SJulian Elischer 		sc->my_tx_pend = 1;
1395167aa833SJulian Elischer 		return;
1396167aa833SJulian Elischer 	}
1397167aa833SJulian Elischer 	/*
1398167aa833SJulian Elischer 	 * Check for an available queue slot. If there are none, punt.
1399167aa833SJulian Elischer 	 */
1400167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_free->my_mbuf != NULL) {
140112d29e15SJustin Hibbits 		if_setdrvflagbits(ifp, IFF_DRV_OACTIVE, 0);
1402167aa833SJulian Elischer 		return;
1403167aa833SJulian Elischer 	}
1404167aa833SJulian Elischer 	start_tx = sc->my_cdata.my_tx_free;
1405167aa833SJulian Elischer 	while (sc->my_cdata.my_tx_free->my_mbuf == NULL) {
140612d29e15SJustin Hibbits 		m_head = if_dequeue(ifp);
1407167aa833SJulian Elischer 		if (m_head == NULL)
1408167aa833SJulian Elischer 			break;
1409167aa833SJulian Elischer 
1410167aa833SJulian Elischer 		/* Pick a descriptor off the free list. */
1411167aa833SJulian Elischer 		cur_tx = sc->my_cdata.my_tx_free;
1412167aa833SJulian Elischer 		sc->my_cdata.my_tx_free = cur_tx->my_nextdesc;
1413167aa833SJulian Elischer 
1414167aa833SJulian Elischer 		/* Pack the data into the descriptor. */
1415167aa833SJulian Elischer 		my_encap(sc, cur_tx, m_head);
1416167aa833SJulian Elischer 
1417167aa833SJulian Elischer 		if (cur_tx != start_tx)
1418167aa833SJulian Elischer 			MY_TXOWN(cur_tx) = MY_OWNByNIC;
1419167aa833SJulian Elischer #if NBPFILTER > 0
1420167aa833SJulian Elischer 		/*
1421167aa833SJulian Elischer 		 * If there's a BPF listener, bounce a copy of this frame to
1422167aa833SJulian Elischer 		 * him.
1423167aa833SJulian Elischer 		 */
1424673d9191SSam Leffler 		BPF_MTAP(ifp, cur_tx->my_mbuf);
1425167aa833SJulian Elischer #endif
1426167aa833SJulian Elischer 	}
1427167aa833SJulian Elischer 	/*
1428167aa833SJulian Elischer 	 * If there are no packets queued, bail.
1429167aa833SJulian Elischer 	 */
1430167aa833SJulian Elischer 	if (cur_tx == NULL) {
1431167aa833SJulian Elischer 		return;
1432167aa833SJulian Elischer 	}
1433167aa833SJulian Elischer 	/*
1434167aa833SJulian Elischer 	 * Place the request for the upload interrupt in the last descriptor
1435167aa833SJulian Elischer 	 * in the chain. This way, if we're chaining several packets at once,
1436976b0106SKevin Lo 	 * we'll only get an interrupt once for the whole chain rather than
1437167aa833SJulian Elischer 	 * once for each packet.
1438167aa833SJulian Elischer 	 */
1439167aa833SJulian Elischer 	MY_TXCTL(cur_tx) |= MY_TXIC;
1440167aa833SJulian Elischer 	cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC;
1441167aa833SJulian Elischer 	sc->my_cdata.my_tx_tail = cur_tx;
1442167aa833SJulian Elischer 	if (sc->my_cdata.my_tx_head == NULL)
1443167aa833SJulian Elischer 		sc->my_cdata.my_tx_head = start_tx;
1444167aa833SJulian Elischer 	MY_TXOWN(start_tx) = MY_OWNByNIC;
1445167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);	/* tx polling demand */
1446167aa833SJulian Elischer 
1447167aa833SJulian Elischer 	/*
1448167aa833SJulian Elischer 	 * Set a timeout in case the chip goes out to lunch.
1449167aa833SJulian Elischer 	 */
1450d4e576c4SJohn Baldwin 	sc->my_timer = 5;
1451167aa833SJulian Elischer 	return;
1452167aa833SJulian Elischer }
1453167aa833SJulian Elischer 
1454167aa833SJulian Elischer static void
my_init(void * xsc)1455167aa833SJulian Elischer my_init(void *xsc)
1456167aa833SJulian Elischer {
1457167aa833SJulian Elischer 	struct my_softc *sc = xsc;
1458167aa833SJulian Elischer 
1459167aa833SJulian Elischer 	MY_LOCK(sc);
1460ca5fc32dSJohn Baldwin 	my_init_locked(sc);
1461167aa833SJulian Elischer 	MY_UNLOCK(sc);
1462ca5fc32dSJohn Baldwin }
1463ca5fc32dSJohn Baldwin 
1464ca5fc32dSJohn Baldwin static void
my_init_locked(struct my_softc * sc)1465ca5fc32dSJohn Baldwin my_init_locked(struct my_softc *sc)
1466ca5fc32dSJohn Baldwin {
146712d29e15SJustin Hibbits 	if_t		ifp = sc->my_ifp;
1468ca5fc32dSJohn Baldwin 	u_int16_t       phy_bmcr = 0;
1469ca5fc32dSJohn Baldwin 
1470ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1471ca5fc32dSJohn Baldwin 	if (sc->my_autoneg) {
1472167aa833SJulian Elischer 		return;
1473167aa833SJulian Elischer 	}
1474167aa833SJulian Elischer 	if (sc->my_pinfo != NULL)
1475167aa833SJulian Elischer 		phy_bmcr = my_phy_readreg(sc, PHY_BMCR);
1476167aa833SJulian Elischer 	/*
1477167aa833SJulian Elischer 	 * Cancel pending I/O and free all RX/TX buffers.
1478167aa833SJulian Elischer 	 */
1479167aa833SJulian Elischer 	my_stop(sc);
1480167aa833SJulian Elischer 	my_reset(sc);
1481167aa833SJulian Elischer 
1482167aa833SJulian Elischer 	/*
1483167aa833SJulian Elischer 	 * Set cache alignment and burst length.
1484167aa833SJulian Elischer 	 */
14850cde2d13SJulian Elischer #if 0				/* 89/9/1 modify,  */
14860cde2d13SJulian Elischer 	CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512);
14870cde2d13SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF);
14880cde2d13SJulian Elischer #endif
1489167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_BCR, MY_PBL8);
1490167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512);
1491167aa833SJulian Elischer 	/*
1492167aa833SJulian Elischer 	 * 89/12/29 add, for mtd891,
1493167aa833SJulian Elischer 	 */
1494167aa833SJulian Elischer 	if (sc->my_info->my_did == MTD891ID) {
1495167aa833SJulian Elischer 		MY_SETBIT(sc, MY_BCR, MY_PROG);
1496167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced);
1497167aa833SJulian Elischer 	}
1498167aa833SJulian Elischer 	my_setcfg(sc, phy_bmcr);
1499167aa833SJulian Elischer 	/* Init circular RX list. */
1500167aa833SJulian Elischer 	if (my_list_rx_init(sc) == ENOBUFS) {
15016b9f5c94SGleb Smirnoff 		device_printf(sc->my_dev, "init failed: no memory for rx buffers\n");
1502167aa833SJulian Elischer 		my_stop(sc);
1503167aa833SJulian Elischer 		return;
1504167aa833SJulian Elischer 	}
1505167aa833SJulian Elischer 	/* Init TX descriptors. */
1506167aa833SJulian Elischer 	my_list_tx_init(sc);
1507167aa833SJulian Elischer 
1508167aa833SJulian Elischer 	/* If we want promiscuous mode, set the allframes bit. */
150912d29e15SJustin Hibbits 	if (if_getflags(ifp) & IFF_PROMISC)
1510167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_PROM);
1511167aa833SJulian Elischer 	else
1512167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_PROM);
1513167aa833SJulian Elischer 
1514167aa833SJulian Elischer 	/*
1515167aa833SJulian Elischer 	 * Set capture broadcast bit to capture broadcast frames.
1516167aa833SJulian Elischer 	 */
151712d29e15SJustin Hibbits 	if (if_getflags(ifp) & IFF_BROADCAST)
1518167aa833SJulian Elischer 		MY_SETBIT(sc, MY_TCRRCR, MY_AB);
1519167aa833SJulian Elischer 	else
1520167aa833SJulian Elischer 		MY_CLRBIT(sc, MY_TCRRCR, MY_AB);
1521167aa833SJulian Elischer 
1522167aa833SJulian Elischer 	/*
1523167aa833SJulian Elischer 	 * Program the multicast filter, if necessary.
1524167aa833SJulian Elischer 	 */
1525167aa833SJulian Elischer 	my_setmulti(sc);
1526167aa833SJulian Elischer 
1527167aa833SJulian Elischer 	/*
1528167aa833SJulian Elischer 	 * Load the address of the RX list.
1529167aa833SJulian Elischer 	 */
1530167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_RE);
1531167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0]));
1532167aa833SJulian Elischer 
1533167aa833SJulian Elischer 	/*
1534167aa833SJulian Elischer 	 * Enable interrupts.
1535167aa833SJulian Elischer 	 */
1536167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
1537167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF);
1538167aa833SJulian Elischer 
1539167aa833SJulian Elischer 	/* Enable receiver and transmitter. */
1540167aa833SJulian Elischer 	MY_SETBIT(sc, MY_TCRRCR, MY_RE);
1541167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, MY_TE);
1542167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0]));
1543167aa833SJulian Elischer 	MY_SETBIT(sc, MY_TCRRCR, MY_TE);
1544167aa833SJulian Elischer 
1545167aa833SJulian Elischer 	/* Restore state of BMCR */
1546167aa833SJulian Elischer 	if (sc->my_pinfo != NULL)
1547167aa833SJulian Elischer 		my_phy_writereg(sc, PHY_BMCR, phy_bmcr);
154812d29e15SJustin Hibbits 	if_setdrvflagbits(ifp, IFF_DRV_RUNNING, 0);
154912d29e15SJustin Hibbits 	if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
1550d4e576c4SJohn Baldwin 
1551d4e576c4SJohn Baldwin 	callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1552167aa833SJulian Elischer 	return;
1553167aa833SJulian Elischer }
1554167aa833SJulian Elischer 
1555167aa833SJulian Elischer /*
1556167aa833SJulian Elischer  * Set media options.
1557167aa833SJulian Elischer  */
1558167aa833SJulian Elischer 
1559167aa833SJulian Elischer static int
my_ifmedia_upd(if_t ifp)156012d29e15SJustin Hibbits my_ifmedia_upd(if_t ifp)
1561167aa833SJulian Elischer {
1562167aa833SJulian Elischer 	struct my_softc *sc;
1563167aa833SJulian Elischer 	struct ifmedia *ifm;
1564167aa833SJulian Elischer 
156512d29e15SJustin Hibbits 	sc = if_getsoftc(ifp);
1566167aa833SJulian Elischer 	MY_LOCK(sc);
1567167aa833SJulian Elischer 	ifm = &sc->ifmedia;
1568167aa833SJulian Elischer 	if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) {
1569167aa833SJulian Elischer 		MY_UNLOCK(sc);
1570167aa833SJulian Elischer 		return (EINVAL);
1571167aa833SJulian Elischer 	}
1572167aa833SJulian Elischer 	if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO)
1573167aa833SJulian Elischer 		my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1574167aa833SJulian Elischer 	else
1575167aa833SJulian Elischer 		my_setmode_mii(sc, ifm->ifm_media);
1576167aa833SJulian Elischer 	MY_UNLOCK(sc);
1577167aa833SJulian Elischer 	return (0);
1578167aa833SJulian Elischer }
1579167aa833SJulian Elischer 
1580167aa833SJulian Elischer /*
1581167aa833SJulian Elischer  * Report current media status.
1582167aa833SJulian Elischer  */
1583167aa833SJulian Elischer 
1584167aa833SJulian Elischer static void
my_ifmedia_sts(if_t ifp,struct ifmediareq * ifmr)158512d29e15SJustin Hibbits my_ifmedia_sts(if_t ifp, struct ifmediareq * ifmr)
1586167aa833SJulian Elischer {
1587167aa833SJulian Elischer 	struct my_softc *sc;
1588167aa833SJulian Elischer 	u_int16_t advert = 0, ability = 0;
1589167aa833SJulian Elischer 
159012d29e15SJustin Hibbits 	sc = if_getsoftc(ifp);
1591167aa833SJulian Elischer 	MY_LOCK(sc);
1592167aa833SJulian Elischer 	ifmr->ifm_active = IFM_ETHER;
1593167aa833SJulian Elischer 	if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) {
15940cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
15950cde2d13SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000)
15960cde2d13SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_1000TX;
15970cde2d13SJulian Elischer #endif
1598167aa833SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL)
1599167aa833SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_100_TX;
1600167aa833SJulian Elischer 		else
1601167aa833SJulian Elischer 			ifmr->ifm_active = IFM_ETHER | IFM_10_T;
1602167aa833SJulian Elischer 		if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX)
1603167aa833SJulian Elischer 			ifmr->ifm_active |= IFM_FDX;
1604167aa833SJulian Elischer 		else
1605167aa833SJulian Elischer 			ifmr->ifm_active |= IFM_HDX;
1606167aa833SJulian Elischer 
1607167aa833SJulian Elischer 		MY_UNLOCK(sc);
1608167aa833SJulian Elischer 		return;
1609167aa833SJulian Elischer 	}
1610167aa833SJulian Elischer 	ability = my_phy_readreg(sc, PHY_LPAR);
1611167aa833SJulian Elischer 	advert = my_phy_readreg(sc, PHY_ANAR);
1612167aa833SJulian Elischer 
16130cde2d13SJulian Elischer #if 0				/* this version did not support 1000M, */
1614167aa833SJulian Elischer 	if (sc->my_pinfo->my_vid = MarvellPHYID0) {
1615167aa833SJulian Elischer 		ability2 = my_phy_readreg(sc, PHY_1000SR);
1616167aa833SJulian Elischer 		if (ability2 & PHY_1000SR_1000BTXFULL) {
1617167aa833SJulian Elischer 			advert = 0;
1618167aa833SJulian Elischer 			ability = 0;
1619b418ad5cSPoul-Henning Kamp 	  		ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX;
1620167aa833SJulian Elischer 	  	} else if (ability & PHY_1000SR_1000BTXHALF) {
1621167aa833SJulian Elischer 			advert = 0;
1622167aa833SJulian Elischer 			ability = 0;
1623b418ad5cSPoul-Henning Kamp 			ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX;
1624167aa833SJulian Elischer 		}
1625167aa833SJulian Elischer 	}
1626167aa833SJulian Elischer #endif
1627167aa833SJulian Elischer 	if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4)
1628167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_T4;
1629167aa833SJulian Elischer 	else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL)
1630167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX;
1631167aa833SJulian Elischer 	else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF)
1632167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX;
1633167aa833SJulian Elischer 	else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL)
1634167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX;
1635167aa833SJulian Elischer 	else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF)
1636167aa833SJulian Elischer 		ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX;
1637167aa833SJulian Elischer 	MY_UNLOCK(sc);
1638167aa833SJulian Elischer 	return;
1639167aa833SJulian Elischer }
1640167aa833SJulian Elischer 
1641167aa833SJulian Elischer static int
my_ioctl(if_t ifp,u_long command,caddr_t data)164212d29e15SJustin Hibbits my_ioctl(if_t ifp, u_long command, caddr_t data)
1643167aa833SJulian Elischer {
164412d29e15SJustin Hibbits 	struct my_softc *sc = if_getsoftc(ifp);
1645167aa833SJulian Elischer 	struct ifreq   *ifr = (struct ifreq *) data;
1646ca5fc32dSJohn Baldwin 	int             error;
1647167aa833SJulian Elischer 
1648167aa833SJulian Elischer 	switch (command) {
1649167aa833SJulian Elischer 	case SIOCSIFFLAGS:
1650ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
165112d29e15SJustin Hibbits 		if (if_getflags(ifp) & IFF_UP)
1652ca5fc32dSJohn Baldwin 			my_init_locked(sc);
165312d29e15SJustin Hibbits 		else if (if_getdrvflags(ifp) & IFF_DRV_RUNNING)
1654167aa833SJulian Elischer 			my_stop(sc);
1655ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
1656167aa833SJulian Elischer 		error = 0;
1657167aa833SJulian Elischer 		break;
1658167aa833SJulian Elischer 	case SIOCADDMULTI:
1659167aa833SJulian Elischer 	case SIOCDELMULTI:
1660ca5fc32dSJohn Baldwin 		MY_LOCK(sc);
1661167aa833SJulian Elischer 		my_setmulti(sc);
1662ca5fc32dSJohn Baldwin 		MY_UNLOCK(sc);
1663167aa833SJulian Elischer 		error = 0;
1664167aa833SJulian Elischer 		break;
1665167aa833SJulian Elischer 	case SIOCGIFMEDIA:
1666167aa833SJulian Elischer 	case SIOCSIFMEDIA:
1667167aa833SJulian Elischer 		error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command);
1668167aa833SJulian Elischer 		break;
1669167aa833SJulian Elischer 	default:
1670673d9191SSam Leffler 		error = ether_ioctl(ifp, command, data);
1671167aa833SJulian Elischer 		break;
1672167aa833SJulian Elischer 	}
1673167aa833SJulian Elischer 	return (error);
1674167aa833SJulian Elischer }
1675167aa833SJulian Elischer 
1676167aa833SJulian Elischer static void
my_watchdog(void * arg)1677d4e576c4SJohn Baldwin my_watchdog(void *arg)
1678167aa833SJulian Elischer {
1679167aa833SJulian Elischer 	struct my_softc *sc;
168012d29e15SJustin Hibbits 	if_t		ifp;
1681167aa833SJulian Elischer 
1682d4e576c4SJohn Baldwin 	sc = arg;
1683d4e576c4SJohn Baldwin 	MY_LOCK_ASSERT(sc);
1684d4e576c4SJohn Baldwin 	callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1685d4e576c4SJohn Baldwin 	if (sc->my_timer == 0 || --sc->my_timer > 0)
1686167aa833SJulian Elischer 		return;
1687d4e576c4SJohn Baldwin 
1688d4e576c4SJohn Baldwin 	ifp = sc->my_ifp;
1689dde47b55SGleb Smirnoff 	if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
169012611131SJohn Baldwin 	if_printf(ifp, "watchdog timeout\n");
1691167aa833SJulian Elischer 	if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT))
169212611131SJohn Baldwin 		if_printf(ifp, "no carrier - transceiver cable problem?\n");
1693167aa833SJulian Elischer 	my_stop(sc);
1694167aa833SJulian Elischer 	my_reset(sc);
1695ca5fc32dSJohn Baldwin 	my_init_locked(sc);
169612d29e15SJustin Hibbits 	if (!if_sendq_empty(ifp))
1697ca5fc32dSJohn Baldwin 		my_start_locked(ifp);
1698167aa833SJulian Elischer }
1699167aa833SJulian Elischer 
1700167aa833SJulian Elischer /*
1701167aa833SJulian Elischer  * Stop the adapter and free any mbufs allocated to the RX and TX lists.
1702167aa833SJulian Elischer  */
1703167aa833SJulian Elischer static void
my_stop(struct my_softc * sc)1704167aa833SJulian Elischer my_stop(struct my_softc * sc)
1705167aa833SJulian Elischer {
17063e85b721SEd Maste 	int    i;
170712d29e15SJustin Hibbits 	if_t   ifp;
1708167aa833SJulian Elischer 
1709ca5fc32dSJohn Baldwin 	MY_LOCK_ASSERT(sc);
1710fc74a9f9SBrooks Davis 	ifp = sc->my_ifp;
1711d4e576c4SJohn Baldwin 
1712d4e576c4SJohn Baldwin 	callout_stop(&sc->my_autoneg_timer);
1713d4e576c4SJohn Baldwin 	callout_stop(&sc->my_watchdog);
1714167aa833SJulian Elischer 
1715167aa833SJulian Elischer 	MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE));
1716167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1717167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_TXLBA, 0x00000000);
1718167aa833SJulian Elischer 	CSR_WRITE_4(sc, MY_RXLBA, 0x00000000);
1719167aa833SJulian Elischer 
1720167aa833SJulian Elischer 	/*
1721167aa833SJulian Elischer 	 * Free data in the RX lists.
1722167aa833SJulian Elischer 	 */
1723167aa833SJulian Elischer 	for (i = 0; i < MY_RX_LIST_CNT; i++) {
1724167aa833SJulian Elischer 		if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) {
1725167aa833SJulian Elischer 			m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf);
1726167aa833SJulian Elischer 			sc->my_cdata.my_rx_chain[i].my_mbuf = NULL;
1727167aa833SJulian Elischer 		}
1728167aa833SJulian Elischer 	}
1729167aa833SJulian Elischer 	bzero((char *)&sc->my_ldata->my_rx_list,
1730167aa833SJulian Elischer 	    sizeof(sc->my_ldata->my_rx_list));
1731167aa833SJulian Elischer 	/*
1732167aa833SJulian Elischer 	 * Free the TX list buffers.
1733167aa833SJulian Elischer 	 */
1734167aa833SJulian Elischer 	for (i = 0; i < MY_TX_LIST_CNT; i++) {
1735167aa833SJulian Elischer 		if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) {
1736167aa833SJulian Elischer 			m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf);
1737167aa833SJulian Elischer 			sc->my_cdata.my_tx_chain[i].my_mbuf = NULL;
1738167aa833SJulian Elischer 		}
1739167aa833SJulian Elischer 	}
1740167aa833SJulian Elischer 	bzero((char *)&sc->my_ldata->my_tx_list,
1741167aa833SJulian Elischer 	    sizeof(sc->my_ldata->my_tx_list));
174212d29e15SJustin Hibbits 	if_setdrvflagbits(ifp, 0, (IFF_DRV_RUNNING | IFF_DRV_OACTIVE));
1743167aa833SJulian Elischer 	return;
1744167aa833SJulian Elischer }
1745167aa833SJulian Elischer 
1746167aa833SJulian Elischer /*
1747167aa833SJulian Elischer  * Stop all chip I/O so that the kernel's probe routines don't get confused
1748167aa833SJulian Elischer  * by errant DMAs when rebooting.
1749167aa833SJulian Elischer  */
1750174ed15eSWarner Losh static int
my_shutdown(device_t dev)1751167aa833SJulian Elischer my_shutdown(device_t dev)
1752167aa833SJulian Elischer {
1753167aa833SJulian Elischer 	struct my_softc *sc;
1754167aa833SJulian Elischer 
1755167aa833SJulian Elischer 	sc = device_get_softc(dev);
1756ca5fc32dSJohn Baldwin 	MY_LOCK(sc);
1757167aa833SJulian Elischer 	my_stop(sc);
1758ca5fc32dSJohn Baldwin 	MY_UNLOCK(sc);
1759174ed15eSWarner Losh 	return 0;
1760167aa833SJulian Elischer }
1761