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);
87612d29e15SJustin Hibbits if_setsoftc(ifp, sc);
8779bf40edeSBrooks Davis if_initname(ifp, device_get_name(dev), device_get_unit(dev));
87812d29e15SJustin Hibbits if_setflags(ifp, IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST);
87912d29e15SJustin Hibbits if_setioctlfn(ifp, my_ioctl);
88012d29e15SJustin Hibbits if_setstartfn(ifp, my_start);
88112d29e15SJustin Hibbits if_setinitfn(ifp, my_init);
88212d29e15SJustin Hibbits if_setbaudrate(ifp, 10000000);
88312d29e15SJustin Hibbits if_setsendqlen(ifp, ifqmaxlen);
88412d29e15SJustin Hibbits if_setsendqready(ifp);
885167aa833SJulian Elischer
886167aa833SJulian Elischer if (sc->my_info->my_did == MTD803ID)
887167aa833SJulian Elischer sc->my_pinfo = my_phys;
888167aa833SJulian Elischer else {
889167aa833SJulian Elischer if (bootverbose)
89012611131SJohn Baldwin device_printf(dev, "probing for a PHY\n");
891ca5fc32dSJohn Baldwin MY_LOCK(sc);
892167aa833SJulian Elischer for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) {
893167aa833SJulian Elischer if (bootverbose)
89412611131SJohn Baldwin device_printf(dev, "checking address: %d\n", i);
895167aa833SJulian Elischer sc->my_phy_addr = i;
896167aa833SJulian Elischer phy_sts = my_phy_readreg(sc, PHY_BMSR);
897167aa833SJulian Elischer if ((phy_sts != 0) && (phy_sts != 0xffff))
898167aa833SJulian Elischer break;
899167aa833SJulian Elischer else
900167aa833SJulian Elischer phy_sts = 0;
901167aa833SJulian Elischer }
902167aa833SJulian Elischer if (phy_sts) {
903167aa833SJulian Elischer phy_vid = my_phy_readreg(sc, PHY_VENID);
904167aa833SJulian Elischer phy_did = my_phy_readreg(sc, PHY_DEVID);
905167aa833SJulian Elischer if (bootverbose) {
90612611131SJohn Baldwin device_printf(dev, "found PHY at address %d, ",
90712611131SJohn Baldwin sc->my_phy_addr);
908167aa833SJulian Elischer printf("vendor id: %x device id: %x\n",
909167aa833SJulian Elischer phy_vid, phy_did);
910167aa833SJulian Elischer }
911167aa833SJulian Elischer p = my_phys;
912167aa833SJulian Elischer while (p->my_vid) {
913167aa833SJulian Elischer if (phy_vid == p->my_vid) {
914167aa833SJulian Elischer sc->my_pinfo = p;
915167aa833SJulian Elischer break;
916167aa833SJulian Elischer }
917167aa833SJulian Elischer p++;
918167aa833SJulian Elischer }
919167aa833SJulian Elischer if (sc->my_pinfo == NULL)
920167aa833SJulian Elischer sc->my_pinfo = &my_phys[PHY_UNKNOWN];
921167aa833SJulian Elischer if (bootverbose)
92212611131SJohn Baldwin device_printf(dev, "PHY type: %s\n",
92312611131SJohn Baldwin sc->my_pinfo->my_name);
924167aa833SJulian Elischer } else {
925ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
92612611131SJohn Baldwin device_printf(dev, "MII without any phy!\n");
927167aa833SJulian Elischer error = ENXIO;
928ca5fc32dSJohn Baldwin goto free_if;
929167aa833SJulian Elischer }
930ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
931167aa833SJulian Elischer }
932167aa833SJulian Elischer
933167aa833SJulian Elischer /* Do ifmedia setup. */
934167aa833SJulian Elischer ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts);
935ca5fc32dSJohn Baldwin MY_LOCK(sc);
936167aa833SJulian Elischer my_getmode_mii(sc);
937167aa833SJulian Elischer my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1);
938167aa833SJulian Elischer media = sc->ifmedia.ifm_media;
939167aa833SJulian Elischer my_stop(sc);
940ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
941167aa833SJulian Elischer ifmedia_set(&sc->ifmedia, media);
942167aa833SJulian Elischer
943673d9191SSam Leffler ether_ifattach(ifp, eaddr);
944167aa833SJulian Elischer
945ca5fc32dSJohn Baldwin error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE,
946ef544f63SPaolo Pisati NULL, my_intr, sc, &sc->my_intrhand);
947ca5fc32dSJohn Baldwin
948ca5fc32dSJohn Baldwin if (error) {
949ca5fc32dSJohn Baldwin device_printf(dev, "couldn't set up irq\n");
950ca5fc32dSJohn Baldwin goto detach_if;
951ca5fc32dSJohn Baldwin }
952ca5fc32dSJohn Baldwin
953167aa833SJulian Elischer return (0);
954167aa833SJulian Elischer
955ca5fc32dSJohn Baldwin detach_if:
956ca5fc32dSJohn Baldwin ether_ifdetach(ifp);
957ca5fc32dSJohn Baldwin free_if:
958ca5fc32dSJohn Baldwin if_free(ifp);
959fc74a9f9SBrooks Davis free(sc->my_ldata_ptr, M_DEVBUF);
960ca5fc32dSJohn Baldwin release_irq:
961ca5fc32dSJohn Baldwin bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
962ca5fc32dSJohn Baldwin release_io:
963ca5fc32dSJohn Baldwin bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
964ca5fc32dSJohn Baldwin destroy_mutex:
965ca5fc32dSJohn Baldwin mtx_destroy(&sc->my_mtx);
966167aa833SJulian Elischer return (error);
967167aa833SJulian Elischer }
968167aa833SJulian Elischer
969167aa833SJulian Elischer static int
my_detach(device_t dev)970167aa833SJulian Elischer my_detach(device_t dev)
971167aa833SJulian Elischer {
972167aa833SJulian Elischer struct my_softc *sc;
97312d29e15SJustin Hibbits if_t ifp;
974167aa833SJulian Elischer
975167aa833SJulian Elischer sc = device_get_softc(dev);
976d4e576c4SJohn Baldwin ifp = sc->my_ifp;
977d4e576c4SJohn Baldwin ether_ifdetach(ifp);
978167aa833SJulian Elischer MY_LOCK(sc);
979ca5fc32dSJohn Baldwin my_stop(sc);
980ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
981ca5fc32dSJohn Baldwin bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand);
982d4e576c4SJohn Baldwin callout_drain(&sc->my_watchdog);
983d4e576c4SJohn Baldwin callout_drain(&sc->my_autoneg_timer);
984ca5fc32dSJohn Baldwin
985fc74a9f9SBrooks Davis if_free(ifp);
986ca5fc32dSJohn Baldwin free(sc->my_ldata_ptr, M_DEVBUF);
987167aa833SJulian Elischer
988167aa833SJulian Elischer bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
989167aa833SJulian Elischer bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
990167aa833SJulian Elischer mtx_destroy(&sc->my_mtx);
991167aa833SJulian Elischer return (0);
992167aa833SJulian Elischer }
993167aa833SJulian Elischer
994167aa833SJulian Elischer /*
995167aa833SJulian Elischer * Initialize the transmit descriptors.
996167aa833SJulian Elischer */
997167aa833SJulian Elischer static int
my_list_tx_init(struct my_softc * sc)998167aa833SJulian Elischer my_list_tx_init(struct my_softc * sc)
999167aa833SJulian Elischer {
1000167aa833SJulian Elischer struct my_chain_data *cd;
1001167aa833SJulian Elischer struct my_list_data *ld;
1002167aa833SJulian Elischer int i;
1003167aa833SJulian Elischer
1004ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1005167aa833SJulian Elischer cd = &sc->my_cdata;
1006167aa833SJulian Elischer ld = sc->my_ldata;
1007167aa833SJulian Elischer for (i = 0; i < MY_TX_LIST_CNT; i++) {
1008167aa833SJulian Elischer cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i];
1009167aa833SJulian Elischer if (i == (MY_TX_LIST_CNT - 1))
1010167aa833SJulian Elischer cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0];
1011167aa833SJulian Elischer else
1012167aa833SJulian Elischer cd->my_tx_chain[i].my_nextdesc =
1013167aa833SJulian Elischer &cd->my_tx_chain[i + 1];
1014167aa833SJulian Elischer }
1015167aa833SJulian Elischer cd->my_tx_free = &cd->my_tx_chain[0];
1016167aa833SJulian Elischer cd->my_tx_tail = cd->my_tx_head = NULL;
1017167aa833SJulian Elischer return (0);
1018167aa833SJulian Elischer }
1019167aa833SJulian Elischer
1020167aa833SJulian Elischer /*
1021167aa833SJulian Elischer * Initialize the RX descriptors and allocate mbufs for them. Note that we
1022167aa833SJulian Elischer * arrange the descriptors in a closed ring, so that the last descriptor
1023167aa833SJulian Elischer * points back to the first.
1024167aa833SJulian Elischer */
1025167aa833SJulian Elischer static int
my_list_rx_init(struct my_softc * sc)1026167aa833SJulian Elischer my_list_rx_init(struct my_softc * sc)
1027167aa833SJulian Elischer {
1028167aa833SJulian Elischer struct my_chain_data *cd;
1029167aa833SJulian Elischer struct my_list_data *ld;
1030167aa833SJulian Elischer int i;
1031167aa833SJulian Elischer
1032ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1033167aa833SJulian Elischer cd = &sc->my_cdata;
1034167aa833SJulian Elischer ld = sc->my_ldata;
1035167aa833SJulian Elischer for (i = 0; i < MY_RX_LIST_CNT; i++) {
1036167aa833SJulian Elischer cd->my_rx_chain[i].my_ptr =
1037167aa833SJulian Elischer (struct my_desc *) & ld->my_rx_list[i];
1038a86d27acSJulian Elischer if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) {
1039a86d27acSJulian Elischer MY_UNLOCK(sc);
1040167aa833SJulian Elischer return (ENOBUFS);
1041a86d27acSJulian Elischer }
1042167aa833SJulian Elischer if (i == (MY_RX_LIST_CNT - 1)) {
1043167aa833SJulian Elischer cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0];
1044167aa833SJulian Elischer ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]);
1045167aa833SJulian Elischer } else {
1046167aa833SJulian Elischer cd->my_rx_chain[i].my_nextdesc =
1047167aa833SJulian Elischer &cd->my_rx_chain[i + 1];
1048167aa833SJulian Elischer ld->my_rx_list[i].my_next =
1049167aa833SJulian Elischer vtophys(&ld->my_rx_list[i + 1]);
1050167aa833SJulian Elischer }
1051167aa833SJulian Elischer }
1052167aa833SJulian Elischer cd->my_rx_head = &cd->my_rx_chain[0];
1053167aa833SJulian Elischer return (0);
1054167aa833SJulian Elischer }
1055167aa833SJulian Elischer
1056167aa833SJulian Elischer /*
1057167aa833SJulian Elischer * Initialize an RX descriptor and attach an MBUF cluster.
1058167aa833SJulian Elischer */
1059167aa833SJulian Elischer static int
my_newbuf(struct my_softc * sc,struct my_chain_onefrag * c)1060167aa833SJulian Elischer my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c)
1061167aa833SJulian Elischer {
1062167aa833SJulian Elischer struct mbuf *m_new = NULL;
1063167aa833SJulian Elischer
1064ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1065c6499eccSGleb Smirnoff MGETHDR(m_new, M_NOWAIT, MT_DATA);
1066167aa833SJulian Elischer if (m_new == NULL) {
10676b9f5c94SGleb Smirnoff device_printf(sc->my_dev,
106812611131SJohn Baldwin "no memory for rx list -- packet dropped!\n");
1069167aa833SJulian Elischer return (ENOBUFS);
1070167aa833SJulian Elischer }
10712a8c860fSRobert Watson if (!(MCLGET(m_new, M_NOWAIT))) {
10726b9f5c94SGleb Smirnoff device_printf(sc->my_dev,
107312611131SJohn Baldwin "no memory for rx list -- packet dropped!\n");
1074167aa833SJulian Elischer m_freem(m_new);
1075167aa833SJulian Elischer return (ENOBUFS);
1076167aa833SJulian Elischer }
1077167aa833SJulian Elischer c->my_mbuf = m_new;
1078167aa833SJulian Elischer c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t));
1079167aa833SJulian Elischer c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift;
1080167aa833SJulian Elischer c->my_ptr->my_status = MY_OWNByNIC;
1081167aa833SJulian Elischer return (0);
1082167aa833SJulian Elischer }
1083167aa833SJulian Elischer
1084167aa833SJulian Elischer /*
1085167aa833SJulian Elischer * A frame has been uploaded: pass the resulting mbuf chain up to the higher
1086167aa833SJulian Elischer * level protocols.
1087167aa833SJulian Elischer */
1088167aa833SJulian Elischer static void
my_rxeof(struct my_softc * sc)1089167aa833SJulian Elischer my_rxeof(struct my_softc * sc)
1090167aa833SJulian Elischer {
1091167aa833SJulian Elischer struct ether_header *eh;
1092167aa833SJulian Elischer struct mbuf *m;
109312d29e15SJustin Hibbits if_t ifp;
1094167aa833SJulian Elischer struct my_chain_onefrag *cur_rx;
1095167aa833SJulian Elischer int total_len = 0;
1096167aa833SJulian Elischer u_int32_t rxstat;
1097167aa833SJulian Elischer
1098ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1099fc74a9f9SBrooks Davis ifp = sc->my_ifp;
1100167aa833SJulian Elischer while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status)
1101167aa833SJulian Elischer & MY_OWNByNIC)) {
1102167aa833SJulian Elischer cur_rx = sc->my_cdata.my_rx_head;
1103167aa833SJulian Elischer sc->my_cdata.my_rx_head = cur_rx->my_nextdesc;
1104167aa833SJulian Elischer
1105167aa833SJulian Elischer if (rxstat & MY_ES) { /* error summary: give up this rx pkt */
1106dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1107167aa833SJulian Elischer cur_rx->my_ptr->my_status = MY_OWNByNIC;
1108167aa833SJulian Elischer continue;
1109167aa833SJulian Elischer }
1110167aa833SJulian Elischer /* No errors; receive the packet. */
1111167aa833SJulian Elischer total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift;
1112167aa833SJulian Elischer total_len -= ETHER_CRC_LEN;
1113167aa833SJulian Elischer
1114167aa833SJulian Elischer if (total_len < MINCLSIZE) {
1115167aa833SJulian Elischer m = m_devget(mtod(cur_rx->my_mbuf, char *),
1116167aa833SJulian Elischer total_len, 0, ifp, NULL);
1117167aa833SJulian Elischer cur_rx->my_ptr->my_status = MY_OWNByNIC;
1118167aa833SJulian Elischer if (m == NULL) {
1119dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1120167aa833SJulian Elischer continue;
1121167aa833SJulian Elischer }
1122167aa833SJulian Elischer } else {
1123167aa833SJulian Elischer m = cur_rx->my_mbuf;
1124167aa833SJulian Elischer /*
1125167aa833SJulian Elischer * Try to conjure up a new mbuf cluster. If that
1126167aa833SJulian Elischer * fails, it means we have an out of memory condition
1127167aa833SJulian Elischer * and should leave the buffer in place and continue.
1128167aa833SJulian Elischer * This will result in a lost packet, but there's
1129167aa833SJulian Elischer * little else we can do in this situation.
1130167aa833SJulian Elischer */
1131167aa833SJulian Elischer if (my_newbuf(sc, cur_rx) == ENOBUFS) {
1132dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1133167aa833SJulian Elischer cur_rx->my_ptr->my_status = MY_OWNByNIC;
1134167aa833SJulian Elischer continue;
1135167aa833SJulian Elischer }
1136167aa833SJulian Elischer m->m_pkthdr.rcvif = ifp;
1137167aa833SJulian Elischer m->m_pkthdr.len = m->m_len = total_len;
1138167aa833SJulian Elischer }
1139dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
1140167aa833SJulian Elischer eh = mtod(m, struct ether_header *);
1141167aa833SJulian Elischer #if NBPFILTER > 0
1142167aa833SJulian Elischer /*
1143167aa833SJulian Elischer * Handle BPF listeners. Let the BPF user see the packet, but
1144167aa833SJulian Elischer * don't pass it up to the ether_input() layer unless it's a
1145167aa833SJulian Elischer * broadcast packet, multicast packet, matches our ethernet
1146167aa833SJulian Elischer * address or the interface is in promiscuous mode.
1147167aa833SJulian Elischer */
1148*8f31b879SJustin Hibbits if (bpf_peers_present_if(ifp)) {
114912d29e15SJustin Hibbits bpf_mtap_if(ifp, m);
115012d29e15SJustin Hibbits if (if_getflags(ifp) & IFF_PROMISC &&
115112d29e15SJustin Hibbits (bcmp(eh->ether_dhost, if_getlladdr(sc->my_ifp),
1152167aa833SJulian Elischer ETHER_ADDR_LEN) &&
1153167aa833SJulian Elischer (eh->ether_dhost[0] & 1) == 0)) {
1154167aa833SJulian Elischer m_freem(m);
1155167aa833SJulian Elischer continue;
1156167aa833SJulian Elischer }
1157167aa833SJulian Elischer }
1158167aa833SJulian Elischer #endif
11595120abbfSSam Leffler MY_UNLOCK(sc);
116012d29e15SJustin Hibbits if_input(ifp, m);
11615120abbfSSam Leffler MY_LOCK(sc);
1162167aa833SJulian Elischer }
1163167aa833SJulian Elischer return;
1164167aa833SJulian Elischer }
1165167aa833SJulian Elischer
1166167aa833SJulian Elischer /*
1167167aa833SJulian Elischer * A frame was downloaded to the chip. It's safe for us to clean up the list
1168167aa833SJulian Elischer * buffers.
1169167aa833SJulian Elischer */
1170167aa833SJulian Elischer static void
my_txeof(struct my_softc * sc)1171167aa833SJulian Elischer my_txeof(struct my_softc * sc)
1172167aa833SJulian Elischer {
1173167aa833SJulian Elischer struct my_chain *cur_tx;
117412d29e15SJustin Hibbits if_t ifp;
1175167aa833SJulian Elischer
1176ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1177fc74a9f9SBrooks Davis ifp = sc->my_ifp;
1178167aa833SJulian Elischer /* Clear the timeout timer. */
1179d4e576c4SJohn Baldwin sc->my_timer = 0;
11808ac00c27SJulian Elischer if (sc->my_cdata.my_tx_head == NULL) {
1181167aa833SJulian Elischer return;
11828ac00c27SJulian Elischer }
1183167aa833SJulian Elischer /*
1184167aa833SJulian Elischer * Go through our tx list and free mbufs for those frames that have
1185167aa833SJulian Elischer * been transmitted.
1186167aa833SJulian Elischer */
1187167aa833SJulian Elischer while (sc->my_cdata.my_tx_head->my_mbuf != NULL) {
1188167aa833SJulian Elischer u_int32_t txstat;
1189167aa833SJulian Elischer
1190167aa833SJulian Elischer cur_tx = sc->my_cdata.my_tx_head;
1191167aa833SJulian Elischer txstat = MY_TXSTATUS(cur_tx);
1192167aa833SJulian Elischer if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT)
1193167aa833SJulian Elischer break;
1194167aa833SJulian Elischer if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) {
1195167aa833SJulian Elischer if (txstat & MY_TXERR) {
1196dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
1197167aa833SJulian Elischer if (txstat & MY_EC) /* excessive collision */
1198dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1199167aa833SJulian Elischer if (txstat & MY_LC) /* late collision */
1200dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1201167aa833SJulian Elischer }
1202dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS,
1203dde47b55SGleb Smirnoff (txstat & MY_NCRMASK) >> MY_NCRShift);
1204167aa833SJulian Elischer }
1205dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1206167aa833SJulian Elischer m_freem(cur_tx->my_mbuf);
1207167aa833SJulian Elischer cur_tx->my_mbuf = NULL;
1208167aa833SJulian Elischer if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) {
1209167aa833SJulian Elischer sc->my_cdata.my_tx_head = NULL;
1210167aa833SJulian Elischer sc->my_cdata.my_tx_tail = NULL;
1211167aa833SJulian Elischer break;
1212167aa833SJulian Elischer }
1213167aa833SJulian Elischer sc->my_cdata.my_tx_head = cur_tx->my_nextdesc;
1214167aa833SJulian Elischer }
1215167aa833SJulian Elischer if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) {
1216dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, (CSR_READ_4(sc, MY_TSR) & MY_NCRMask));
1217167aa833SJulian Elischer }
1218167aa833SJulian Elischer return;
1219167aa833SJulian Elischer }
1220167aa833SJulian Elischer
1221167aa833SJulian Elischer /*
1222167aa833SJulian Elischer * TX 'end of channel' interrupt handler.
1223167aa833SJulian Elischer */
1224167aa833SJulian Elischer static void
my_txeoc(struct my_softc * sc)1225167aa833SJulian Elischer my_txeoc(struct my_softc * sc)
1226167aa833SJulian Elischer {
122712d29e15SJustin Hibbits if_t ifp;
1228167aa833SJulian Elischer
1229ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1230fc74a9f9SBrooks Davis ifp = sc->my_ifp;
1231d4e576c4SJohn Baldwin sc->my_timer = 0;
1232167aa833SJulian Elischer if (sc->my_cdata.my_tx_head == NULL) {
123312d29e15SJustin Hibbits if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
1234167aa833SJulian Elischer sc->my_cdata.my_tx_tail = NULL;
1235167aa833SJulian Elischer if (sc->my_want_auto)
1236167aa833SJulian Elischer my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1237167aa833SJulian Elischer } else {
1238167aa833SJulian Elischer if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) {
1239167aa833SJulian Elischer MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC;
1240d4e576c4SJohn Baldwin sc->my_timer = 5;
1241167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);
1242167aa833SJulian Elischer }
1243167aa833SJulian Elischer }
1244167aa833SJulian Elischer return;
1245167aa833SJulian Elischer }
1246167aa833SJulian Elischer
1247167aa833SJulian Elischer static void
my_intr(void * arg)1248167aa833SJulian Elischer my_intr(void *arg)
1249167aa833SJulian Elischer {
1250167aa833SJulian Elischer struct my_softc *sc;
125112d29e15SJustin Hibbits if_t ifp;
1252167aa833SJulian Elischer u_int32_t status;
1253167aa833SJulian Elischer
1254167aa833SJulian Elischer sc = arg;
1255167aa833SJulian Elischer MY_LOCK(sc);
1256fc74a9f9SBrooks Davis ifp = sc->my_ifp;
125712d29e15SJustin Hibbits if (!(if_getflags(ifp) & IFF_UP)) {
1258167aa833SJulian Elischer MY_UNLOCK(sc);
1259167aa833SJulian Elischer return;
1260167aa833SJulian Elischer }
1261167aa833SJulian Elischer /* Disable interrupts. */
1262167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1263167aa833SJulian Elischer
1264167aa833SJulian Elischer for (;;) {
1265167aa833SJulian Elischer status = CSR_READ_4(sc, MY_ISR);
1266167aa833SJulian Elischer status &= MY_INTRS;
1267167aa833SJulian Elischer if (status)
1268167aa833SJulian Elischer CSR_WRITE_4(sc, MY_ISR, status);
1269167aa833SJulian Elischer else
1270167aa833SJulian Elischer break;
1271167aa833SJulian Elischer
1272167aa833SJulian Elischer if (status & MY_RI) /* receive interrupt */
1273167aa833SJulian Elischer my_rxeof(sc);
1274167aa833SJulian Elischer
1275167aa833SJulian Elischer if ((status & MY_RBU) || (status & MY_RxErr)) {
1276167aa833SJulian Elischer /* rx buffer unavailable or rx error */
1277dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1278167aa833SJulian Elischer #ifdef foo
1279167aa833SJulian Elischer my_stop(sc);
1280167aa833SJulian Elischer my_reset(sc);
1281ca5fc32dSJohn Baldwin my_init_locked(sc);
1282167aa833SJulian Elischer #endif
1283167aa833SJulian Elischer }
1284167aa833SJulian Elischer if (status & MY_TI) /* tx interrupt */
1285167aa833SJulian Elischer my_txeof(sc);
1286167aa833SJulian Elischer if (status & MY_ETI) /* tx early interrupt */
1287167aa833SJulian Elischer my_txeof(sc);
1288167aa833SJulian Elischer if (status & MY_TBU) /* tx buffer unavailable */
1289167aa833SJulian Elischer my_txeoc(sc);
12900cde2d13SJulian Elischer
12910cde2d13SJulian Elischer #if 0 /* 90/1/18 delete */
12920cde2d13SJulian Elischer if (status & MY_FBE) {
12930cde2d13SJulian Elischer my_reset(sc);
1294ca5fc32dSJohn Baldwin my_init_locked(sc);
12950cde2d13SJulian Elischer }
12960cde2d13SJulian Elischer #endif
1297167aa833SJulian Elischer }
1298167aa833SJulian Elischer
1299167aa833SJulian Elischer /* Re-enable interrupts. */
1300167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
130112d29e15SJustin Hibbits if (!if_sendq_empty(ifp))
1302ca5fc32dSJohn Baldwin my_start_locked(ifp);
1303167aa833SJulian Elischer MY_UNLOCK(sc);
1304167aa833SJulian Elischer return;
1305167aa833SJulian Elischer }
1306167aa833SJulian Elischer
1307167aa833SJulian Elischer /*
1308167aa833SJulian Elischer * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1309167aa833SJulian Elischer * pointers to the fragment pointers.
1310167aa833SJulian Elischer */
1311167aa833SJulian Elischer static int
my_encap(struct my_softc * sc,struct my_chain * c,struct mbuf * m_head)1312167aa833SJulian Elischer my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head)
1313167aa833SJulian Elischer {
1314167aa833SJulian Elischer struct my_desc *f = NULL;
1315167aa833SJulian Elischer int total_len;
1316167aa833SJulian Elischer struct mbuf *m, *m_new = NULL;
1317167aa833SJulian Elischer
1318ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1319167aa833SJulian Elischer /* calculate the total tx pkt length */
1320167aa833SJulian Elischer total_len = 0;
1321167aa833SJulian Elischer for (m = m_head; m != NULL; m = m->m_next)
1322167aa833SJulian Elischer total_len += m->m_len;
1323167aa833SJulian Elischer /*
1324167aa833SJulian Elischer * Start packing the mbufs in this chain into the fragment pointers.
1325167aa833SJulian Elischer * Stop when we run out of fragments or hit the end of the mbuf
1326167aa833SJulian Elischer * chain.
1327167aa833SJulian Elischer */
1328167aa833SJulian Elischer m = m_head;
1329c6499eccSGleb Smirnoff MGETHDR(m_new, M_NOWAIT, MT_DATA);
1330167aa833SJulian Elischer if (m_new == NULL) {
13316b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "no memory for tx list");
1332167aa833SJulian Elischer return (1);
1333167aa833SJulian Elischer }
1334167aa833SJulian Elischer if (m_head->m_pkthdr.len > MHLEN) {
13352a8c860fSRobert Watson if (!(MCLGET(m_new, M_NOWAIT))) {
1336167aa833SJulian Elischer m_freem(m_new);
13376b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "no memory for tx list");
1338167aa833SJulian Elischer return (1);
1339167aa833SJulian Elischer }
1340167aa833SJulian Elischer }
1341167aa833SJulian Elischer m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t));
1342167aa833SJulian Elischer m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len;
1343167aa833SJulian Elischer m_freem(m_head);
1344167aa833SJulian Elischer m_head = m_new;
1345167aa833SJulian Elischer f = &c->my_ptr->my_frag[0];
1346167aa833SJulian Elischer f->my_status = 0;
1347167aa833SJulian Elischer f->my_data = vtophys(mtod(m_new, caddr_t));
1348167aa833SJulian Elischer total_len = m_new->m_len;
1349167aa833SJulian Elischer f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable;
1350167aa833SJulian Elischer f->my_ctl |= total_len << MY_PKTShift; /* pkt size */
1351167aa833SJulian Elischer f->my_ctl |= total_len; /* buffer size */
13522cc8ce3cSJulian Elischer /* 89/12/29 add, for mtd891 *//* [ 89? ] */
1353167aa833SJulian Elischer if (sc->my_info->my_did == MTD891ID)
1354167aa833SJulian Elischer f->my_ctl |= MY_ETIControl | MY_RetryTxLC;
1355167aa833SJulian Elischer c->my_mbuf = m_head;
1356167aa833SJulian Elischer c->my_lastdesc = 0;
1357167aa833SJulian Elischer MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]);
1358167aa833SJulian Elischer return (0);
1359167aa833SJulian Elischer }
1360167aa833SJulian Elischer
1361167aa833SJulian Elischer /*
1362167aa833SJulian Elischer * Main transmit routine. To avoid having to do mbuf copies, we put pointers
1363167aa833SJulian Elischer * to the mbuf data regions directly in the transmit lists. We also save a
1364167aa833SJulian Elischer * copy of the pointers since the transmit list fragment pointers are
1365167aa833SJulian Elischer * physical addresses.
1366167aa833SJulian Elischer */
1367167aa833SJulian Elischer static void
my_start(if_t ifp)136812d29e15SJustin Hibbits my_start(if_t ifp)
1369167aa833SJulian Elischer {
1370167aa833SJulian Elischer struct my_softc *sc;
1371ca5fc32dSJohn Baldwin
137212d29e15SJustin Hibbits sc = if_getsoftc(ifp);
1373ca5fc32dSJohn Baldwin MY_LOCK(sc);
1374ca5fc32dSJohn Baldwin my_start_locked(ifp);
1375ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
1376ca5fc32dSJohn Baldwin }
1377ca5fc32dSJohn Baldwin
1378ca5fc32dSJohn Baldwin static void
my_start_locked(if_t ifp)137912d29e15SJustin Hibbits my_start_locked(if_t ifp)
1380ca5fc32dSJohn Baldwin {
1381ca5fc32dSJohn Baldwin struct my_softc *sc;
1382167aa833SJulian Elischer struct mbuf *m_head = NULL;
1383167aa833SJulian Elischer struct my_chain *cur_tx = NULL, *start_tx;
1384167aa833SJulian Elischer
138512d29e15SJustin Hibbits sc = if_getsoftc(ifp);
1386ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1387167aa833SJulian Elischer if (sc->my_autoneg) {
1388167aa833SJulian Elischer sc->my_tx_pend = 1;
1389167aa833SJulian Elischer return;
1390167aa833SJulian Elischer }
1391167aa833SJulian Elischer /*
1392167aa833SJulian Elischer * Check for an available queue slot. If there are none, punt.
1393167aa833SJulian Elischer */
1394167aa833SJulian Elischer if (sc->my_cdata.my_tx_free->my_mbuf != NULL) {
139512d29e15SJustin Hibbits if_setdrvflagbits(ifp, IFF_DRV_OACTIVE, 0);
1396167aa833SJulian Elischer return;
1397167aa833SJulian Elischer }
1398167aa833SJulian Elischer start_tx = sc->my_cdata.my_tx_free;
1399167aa833SJulian Elischer while (sc->my_cdata.my_tx_free->my_mbuf == NULL) {
140012d29e15SJustin Hibbits m_head = if_dequeue(ifp);
1401167aa833SJulian Elischer if (m_head == NULL)
1402167aa833SJulian Elischer break;
1403167aa833SJulian Elischer
1404167aa833SJulian Elischer /* Pick a descriptor off the free list. */
1405167aa833SJulian Elischer cur_tx = sc->my_cdata.my_tx_free;
1406167aa833SJulian Elischer sc->my_cdata.my_tx_free = cur_tx->my_nextdesc;
1407167aa833SJulian Elischer
1408167aa833SJulian Elischer /* Pack the data into the descriptor. */
1409167aa833SJulian Elischer my_encap(sc, cur_tx, m_head);
1410167aa833SJulian Elischer
1411167aa833SJulian Elischer if (cur_tx != start_tx)
1412167aa833SJulian Elischer MY_TXOWN(cur_tx) = MY_OWNByNIC;
1413167aa833SJulian Elischer #if NBPFILTER > 0
1414167aa833SJulian Elischer /*
1415167aa833SJulian Elischer * If there's a BPF listener, bounce a copy of this frame to
1416167aa833SJulian Elischer * him.
1417167aa833SJulian Elischer */
1418673d9191SSam Leffler BPF_MTAP(ifp, cur_tx->my_mbuf);
1419167aa833SJulian Elischer #endif
1420167aa833SJulian Elischer }
1421167aa833SJulian Elischer /*
1422167aa833SJulian Elischer * If there are no packets queued, bail.
1423167aa833SJulian Elischer */
1424167aa833SJulian Elischer if (cur_tx == NULL) {
1425167aa833SJulian Elischer return;
1426167aa833SJulian Elischer }
1427167aa833SJulian Elischer /*
1428167aa833SJulian Elischer * Place the request for the upload interrupt in the last descriptor
1429167aa833SJulian Elischer * in the chain. This way, if we're chaining several packets at once,
1430976b0106SKevin Lo * we'll only get an interrupt once for the whole chain rather than
1431167aa833SJulian Elischer * once for each packet.
1432167aa833SJulian Elischer */
1433167aa833SJulian Elischer MY_TXCTL(cur_tx) |= MY_TXIC;
1434167aa833SJulian Elischer cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC;
1435167aa833SJulian Elischer sc->my_cdata.my_tx_tail = cur_tx;
1436167aa833SJulian Elischer if (sc->my_cdata.my_tx_head == NULL)
1437167aa833SJulian Elischer sc->my_cdata.my_tx_head = start_tx;
1438167aa833SJulian Elischer MY_TXOWN(start_tx) = MY_OWNByNIC;
1439167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */
1440167aa833SJulian Elischer
1441167aa833SJulian Elischer /*
1442167aa833SJulian Elischer * Set a timeout in case the chip goes out to lunch.
1443167aa833SJulian Elischer */
1444d4e576c4SJohn Baldwin sc->my_timer = 5;
1445167aa833SJulian Elischer return;
1446167aa833SJulian Elischer }
1447167aa833SJulian Elischer
1448167aa833SJulian Elischer static void
my_init(void * xsc)1449167aa833SJulian Elischer my_init(void *xsc)
1450167aa833SJulian Elischer {
1451167aa833SJulian Elischer struct my_softc *sc = xsc;
1452167aa833SJulian Elischer
1453167aa833SJulian Elischer MY_LOCK(sc);
1454ca5fc32dSJohn Baldwin my_init_locked(sc);
1455167aa833SJulian Elischer MY_UNLOCK(sc);
1456ca5fc32dSJohn Baldwin }
1457ca5fc32dSJohn Baldwin
1458ca5fc32dSJohn Baldwin static void
my_init_locked(struct my_softc * sc)1459ca5fc32dSJohn Baldwin my_init_locked(struct my_softc *sc)
1460ca5fc32dSJohn Baldwin {
146112d29e15SJustin Hibbits if_t ifp = sc->my_ifp;
1462ca5fc32dSJohn Baldwin u_int16_t phy_bmcr = 0;
1463ca5fc32dSJohn Baldwin
1464ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1465ca5fc32dSJohn Baldwin if (sc->my_autoneg) {
1466167aa833SJulian Elischer return;
1467167aa833SJulian Elischer }
1468167aa833SJulian Elischer if (sc->my_pinfo != NULL)
1469167aa833SJulian Elischer phy_bmcr = my_phy_readreg(sc, PHY_BMCR);
1470167aa833SJulian Elischer /*
1471167aa833SJulian Elischer * Cancel pending I/O and free all RX/TX buffers.
1472167aa833SJulian Elischer */
1473167aa833SJulian Elischer my_stop(sc);
1474167aa833SJulian Elischer my_reset(sc);
1475167aa833SJulian Elischer
1476167aa833SJulian Elischer /*
1477167aa833SJulian Elischer * Set cache alignment and burst length.
1478167aa833SJulian Elischer */
14790cde2d13SJulian Elischer #if 0 /* 89/9/1 modify, */
14800cde2d13SJulian Elischer CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512);
14810cde2d13SJulian Elischer CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF);
14820cde2d13SJulian Elischer #endif
1483167aa833SJulian Elischer CSR_WRITE_4(sc, MY_BCR, MY_PBL8);
1484167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512);
1485167aa833SJulian Elischer /*
1486167aa833SJulian Elischer * 89/12/29 add, for mtd891,
1487167aa833SJulian Elischer */
1488167aa833SJulian Elischer if (sc->my_info->my_did == MTD891ID) {
1489167aa833SJulian Elischer MY_SETBIT(sc, MY_BCR, MY_PROG);
1490167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced);
1491167aa833SJulian Elischer }
1492167aa833SJulian Elischer my_setcfg(sc, phy_bmcr);
1493167aa833SJulian Elischer /* Init circular RX list. */
1494167aa833SJulian Elischer if (my_list_rx_init(sc) == ENOBUFS) {
14956b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "init failed: no memory for rx buffers\n");
1496167aa833SJulian Elischer my_stop(sc);
1497167aa833SJulian Elischer return;
1498167aa833SJulian Elischer }
1499167aa833SJulian Elischer /* Init TX descriptors. */
1500167aa833SJulian Elischer my_list_tx_init(sc);
1501167aa833SJulian Elischer
1502167aa833SJulian Elischer /* If we want promiscuous mode, set the allframes bit. */
150312d29e15SJustin Hibbits if (if_getflags(ifp) & IFF_PROMISC)
1504167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_PROM);
1505167aa833SJulian Elischer else
1506167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_PROM);
1507167aa833SJulian Elischer
1508167aa833SJulian Elischer /*
1509167aa833SJulian Elischer * Set capture broadcast bit to capture broadcast frames.
1510167aa833SJulian Elischer */
151112d29e15SJustin Hibbits if (if_getflags(ifp) & IFF_BROADCAST)
1512167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_AB);
1513167aa833SJulian Elischer else
1514167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_AB);
1515167aa833SJulian Elischer
1516167aa833SJulian Elischer /*
1517167aa833SJulian Elischer * Program the multicast filter, if necessary.
1518167aa833SJulian Elischer */
1519167aa833SJulian Elischer my_setmulti(sc);
1520167aa833SJulian Elischer
1521167aa833SJulian Elischer /*
1522167aa833SJulian Elischer * Load the address of the RX list.
1523167aa833SJulian Elischer */
1524167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_RE);
1525167aa833SJulian Elischer CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0]));
1526167aa833SJulian Elischer
1527167aa833SJulian Elischer /*
1528167aa833SJulian Elischer * Enable interrupts.
1529167aa833SJulian Elischer */
1530167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
1531167aa833SJulian Elischer CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF);
1532167aa833SJulian Elischer
1533167aa833SJulian Elischer /* Enable receiver and transmitter. */
1534167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_RE);
1535167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_TE);
1536167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0]));
1537167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_TE);
1538167aa833SJulian Elischer
1539167aa833SJulian Elischer /* Restore state of BMCR */
1540167aa833SJulian Elischer if (sc->my_pinfo != NULL)
1541167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, phy_bmcr);
154212d29e15SJustin Hibbits if_setdrvflagbits(ifp, IFF_DRV_RUNNING, 0);
154312d29e15SJustin Hibbits if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
1544d4e576c4SJohn Baldwin
1545d4e576c4SJohn Baldwin callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1546167aa833SJulian Elischer return;
1547167aa833SJulian Elischer }
1548167aa833SJulian Elischer
1549167aa833SJulian Elischer /*
1550167aa833SJulian Elischer * Set media options.
1551167aa833SJulian Elischer */
1552167aa833SJulian Elischer
1553167aa833SJulian Elischer static int
my_ifmedia_upd(if_t ifp)155412d29e15SJustin Hibbits my_ifmedia_upd(if_t ifp)
1555167aa833SJulian Elischer {
1556167aa833SJulian Elischer struct my_softc *sc;
1557167aa833SJulian Elischer struct ifmedia *ifm;
1558167aa833SJulian Elischer
155912d29e15SJustin Hibbits sc = if_getsoftc(ifp);
1560167aa833SJulian Elischer MY_LOCK(sc);
1561167aa833SJulian Elischer ifm = &sc->ifmedia;
1562167aa833SJulian Elischer if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) {
1563167aa833SJulian Elischer MY_UNLOCK(sc);
1564167aa833SJulian Elischer return (EINVAL);
1565167aa833SJulian Elischer }
1566167aa833SJulian Elischer if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO)
1567167aa833SJulian Elischer my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1568167aa833SJulian Elischer else
1569167aa833SJulian Elischer my_setmode_mii(sc, ifm->ifm_media);
1570167aa833SJulian Elischer MY_UNLOCK(sc);
1571167aa833SJulian Elischer return (0);
1572167aa833SJulian Elischer }
1573167aa833SJulian Elischer
1574167aa833SJulian Elischer /*
1575167aa833SJulian Elischer * Report current media status.
1576167aa833SJulian Elischer */
1577167aa833SJulian Elischer
1578167aa833SJulian Elischer static void
my_ifmedia_sts(if_t ifp,struct ifmediareq * ifmr)157912d29e15SJustin Hibbits my_ifmedia_sts(if_t ifp, struct ifmediareq * ifmr)
1580167aa833SJulian Elischer {
1581167aa833SJulian Elischer struct my_softc *sc;
1582167aa833SJulian Elischer u_int16_t advert = 0, ability = 0;
1583167aa833SJulian Elischer
158412d29e15SJustin Hibbits sc = if_getsoftc(ifp);
1585167aa833SJulian Elischer MY_LOCK(sc);
1586167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER;
1587167aa833SJulian Elischer if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) {
15880cde2d13SJulian Elischer #if 0 /* this version did not support 1000M, */
15890cde2d13SJulian Elischer if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000)
15900cde2d13SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_1000TX;
15910cde2d13SJulian Elischer #endif
1592167aa833SJulian Elischer if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL)
1593167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_TX;
1594167aa833SJulian Elischer else
1595167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_10_T;
1596167aa833SJulian Elischer if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX)
1597167aa833SJulian Elischer ifmr->ifm_active |= IFM_FDX;
1598167aa833SJulian Elischer else
1599167aa833SJulian Elischer ifmr->ifm_active |= IFM_HDX;
1600167aa833SJulian Elischer
1601167aa833SJulian Elischer MY_UNLOCK(sc);
1602167aa833SJulian Elischer return;
1603167aa833SJulian Elischer }
1604167aa833SJulian Elischer ability = my_phy_readreg(sc, PHY_LPAR);
1605167aa833SJulian Elischer advert = my_phy_readreg(sc, PHY_ANAR);
1606167aa833SJulian Elischer
16070cde2d13SJulian Elischer #if 0 /* this version did not support 1000M, */
1608167aa833SJulian Elischer if (sc->my_pinfo->my_vid = MarvellPHYID0) {
1609167aa833SJulian Elischer ability2 = my_phy_readreg(sc, PHY_1000SR);
1610167aa833SJulian Elischer if (ability2 & PHY_1000SR_1000BTXFULL) {
1611167aa833SJulian Elischer advert = 0;
1612167aa833SJulian Elischer ability = 0;
1613b418ad5cSPoul-Henning Kamp ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX;
1614167aa833SJulian Elischer } else if (ability & PHY_1000SR_1000BTXHALF) {
1615167aa833SJulian Elischer advert = 0;
1616167aa833SJulian Elischer ability = 0;
1617b418ad5cSPoul-Henning Kamp ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX;
1618167aa833SJulian Elischer }
1619167aa833SJulian Elischer }
1620167aa833SJulian Elischer #endif
1621167aa833SJulian Elischer if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4)
1622167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_T4;
1623167aa833SJulian Elischer else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL)
1624167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX;
1625167aa833SJulian Elischer else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF)
1626167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX;
1627167aa833SJulian Elischer else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL)
1628167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX;
1629167aa833SJulian Elischer else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF)
1630167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX;
1631167aa833SJulian Elischer MY_UNLOCK(sc);
1632167aa833SJulian Elischer return;
1633167aa833SJulian Elischer }
1634167aa833SJulian Elischer
1635167aa833SJulian Elischer static int
my_ioctl(if_t ifp,u_long command,caddr_t data)163612d29e15SJustin Hibbits my_ioctl(if_t ifp, u_long command, caddr_t data)
1637167aa833SJulian Elischer {
163812d29e15SJustin Hibbits struct my_softc *sc = if_getsoftc(ifp);
1639167aa833SJulian Elischer struct ifreq *ifr = (struct ifreq *) data;
1640ca5fc32dSJohn Baldwin int error;
1641167aa833SJulian Elischer
1642167aa833SJulian Elischer switch (command) {
1643167aa833SJulian Elischer case SIOCSIFFLAGS:
1644ca5fc32dSJohn Baldwin MY_LOCK(sc);
164512d29e15SJustin Hibbits if (if_getflags(ifp) & IFF_UP)
1646ca5fc32dSJohn Baldwin my_init_locked(sc);
164712d29e15SJustin Hibbits else if (if_getdrvflags(ifp) & IFF_DRV_RUNNING)
1648167aa833SJulian Elischer my_stop(sc);
1649ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
1650167aa833SJulian Elischer error = 0;
1651167aa833SJulian Elischer break;
1652167aa833SJulian Elischer case SIOCADDMULTI:
1653167aa833SJulian Elischer case SIOCDELMULTI:
1654ca5fc32dSJohn Baldwin MY_LOCK(sc);
1655167aa833SJulian Elischer my_setmulti(sc);
1656ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
1657167aa833SJulian Elischer error = 0;
1658167aa833SJulian Elischer break;
1659167aa833SJulian Elischer case SIOCGIFMEDIA:
1660167aa833SJulian Elischer case SIOCSIFMEDIA:
1661167aa833SJulian Elischer error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command);
1662167aa833SJulian Elischer break;
1663167aa833SJulian Elischer default:
1664673d9191SSam Leffler error = ether_ioctl(ifp, command, data);
1665167aa833SJulian Elischer break;
1666167aa833SJulian Elischer }
1667167aa833SJulian Elischer return (error);
1668167aa833SJulian Elischer }
1669167aa833SJulian Elischer
1670167aa833SJulian Elischer static void
my_watchdog(void * arg)1671d4e576c4SJohn Baldwin my_watchdog(void *arg)
1672167aa833SJulian Elischer {
1673167aa833SJulian Elischer struct my_softc *sc;
167412d29e15SJustin Hibbits if_t ifp;
1675167aa833SJulian Elischer
1676d4e576c4SJohn Baldwin sc = arg;
1677d4e576c4SJohn Baldwin MY_LOCK_ASSERT(sc);
1678d4e576c4SJohn Baldwin callout_reset(&sc->my_watchdog, hz, my_watchdog, sc);
1679d4e576c4SJohn Baldwin if (sc->my_timer == 0 || --sc->my_timer > 0)
1680167aa833SJulian Elischer return;
1681d4e576c4SJohn Baldwin
1682d4e576c4SJohn Baldwin ifp = sc->my_ifp;
1683dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
168412611131SJohn Baldwin if_printf(ifp, "watchdog timeout\n");
1685167aa833SJulian Elischer if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT))
168612611131SJohn Baldwin if_printf(ifp, "no carrier - transceiver cable problem?\n");
1687167aa833SJulian Elischer my_stop(sc);
1688167aa833SJulian Elischer my_reset(sc);
1689ca5fc32dSJohn Baldwin my_init_locked(sc);
169012d29e15SJustin Hibbits if (!if_sendq_empty(ifp))
1691ca5fc32dSJohn Baldwin my_start_locked(ifp);
1692167aa833SJulian Elischer }
1693167aa833SJulian Elischer
1694167aa833SJulian Elischer /*
1695167aa833SJulian Elischer * Stop the adapter and free any mbufs allocated to the RX and TX lists.
1696167aa833SJulian Elischer */
1697167aa833SJulian Elischer static void
my_stop(struct my_softc * sc)1698167aa833SJulian Elischer my_stop(struct my_softc * sc)
1699167aa833SJulian Elischer {
17003e85b721SEd Maste int i;
170112d29e15SJustin Hibbits if_t ifp;
1702167aa833SJulian Elischer
1703ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc);
1704fc74a9f9SBrooks Davis ifp = sc->my_ifp;
1705d4e576c4SJohn Baldwin
1706d4e576c4SJohn Baldwin callout_stop(&sc->my_autoneg_timer);
1707d4e576c4SJohn Baldwin callout_stop(&sc->my_watchdog);
1708167aa833SJulian Elischer
1709167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE));
1710167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1711167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXLBA, 0x00000000);
1712167aa833SJulian Elischer CSR_WRITE_4(sc, MY_RXLBA, 0x00000000);
1713167aa833SJulian Elischer
1714167aa833SJulian Elischer /*
1715167aa833SJulian Elischer * Free data in the RX lists.
1716167aa833SJulian Elischer */
1717167aa833SJulian Elischer for (i = 0; i < MY_RX_LIST_CNT; i++) {
1718167aa833SJulian Elischer if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) {
1719167aa833SJulian Elischer m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf);
1720167aa833SJulian Elischer sc->my_cdata.my_rx_chain[i].my_mbuf = NULL;
1721167aa833SJulian Elischer }
1722167aa833SJulian Elischer }
1723167aa833SJulian Elischer bzero((char *)&sc->my_ldata->my_rx_list,
1724167aa833SJulian Elischer sizeof(sc->my_ldata->my_rx_list));
1725167aa833SJulian Elischer /*
1726167aa833SJulian Elischer * Free the TX list buffers.
1727167aa833SJulian Elischer */
1728167aa833SJulian Elischer for (i = 0; i < MY_TX_LIST_CNT; i++) {
1729167aa833SJulian Elischer if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) {
1730167aa833SJulian Elischer m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf);
1731167aa833SJulian Elischer sc->my_cdata.my_tx_chain[i].my_mbuf = NULL;
1732167aa833SJulian Elischer }
1733167aa833SJulian Elischer }
1734167aa833SJulian Elischer bzero((char *)&sc->my_ldata->my_tx_list,
1735167aa833SJulian Elischer sizeof(sc->my_ldata->my_tx_list));
173612d29e15SJustin Hibbits if_setdrvflagbits(ifp, 0, (IFF_DRV_RUNNING | IFF_DRV_OACTIVE));
1737167aa833SJulian Elischer return;
1738167aa833SJulian Elischer }
1739167aa833SJulian Elischer
1740167aa833SJulian Elischer /*
1741167aa833SJulian Elischer * Stop all chip I/O so that the kernel's probe routines don't get confused
1742167aa833SJulian Elischer * by errant DMAs when rebooting.
1743167aa833SJulian Elischer */
1744174ed15eSWarner Losh static int
my_shutdown(device_t dev)1745167aa833SJulian Elischer my_shutdown(device_t dev)
1746167aa833SJulian Elischer {
1747167aa833SJulian Elischer struct my_softc *sc;
1748167aa833SJulian Elischer
1749167aa833SJulian Elischer sc = device_get_softc(dev);
1750ca5fc32dSJohn Baldwin MY_LOCK(sc);
1751167aa833SJulian Elischer my_stop(sc);
1752ca5fc32dSJohn Baldwin MY_UNLOCK(sc);
1753174ed15eSWarner Losh return 0;
1754167aa833SJulian Elischer }
1755