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