b78f981c39a89683d74c3300afebd8d89451b7ac
[dragonfly.git] / sys / dev / netif / my / if_my.c
1 /*
2  * Copyright (c) 2002 Myson Technology Inc.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions, and the following disclaimer,
10  *    without modification, immediately at the beginning of the file.
11  * 2. The name of the author may not be used to endorse or promote products
12  *    derived from this software without specific prior written permission.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
18  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  *
26  * Written by: yen_cw@myson.com.tw  available at: http://www.myson.com.tw/
27  *
28  * $FreeBSD: src/sys/dev/my/if_my.c,v 1.2.2.4 2002/04/17 02:05:27 julian Exp $
29  * $DragonFly: src/sys/dev/netif/my/if_my.c,v 1.23 2005/11/28 17:13:43 dillon Exp $
30  *
31  * Myson fast ethernet PCI NIC driver
32  *
33  * $Id: if_my.c,v 1.40 2001/11/30 03:55:00 <yen_cw@myson.com.tw> wpaul Exp $
34  */
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/sockio.h>
38 #include <sys/mbuf.h>
39 #include <sys/malloc.h>
40 #include <sys/kernel.h>
41 #include <sys/socket.h>
42 #include <sys/queue.h>
43 #include <sys/bus.h>
44 #include <sys/module.h>
45 #include <sys/serialize.h>
46
47 #include <sys/thread2.h>
48
49 #include <net/if.h>
50 #include <net/ifq_var.h>
51 #include <net/if_arp.h>
52 #include <net/ethernet.h>
53 #include <net/if_media.h>
54 #include <net/if_dl.h>
55 #include <net/bpf.h>
56
57 #include <vm/vm.h>              /* for vtophys */
58 #include <vm/pmap.h>            /* for vtophys */
59 #include <machine/clock.h>      /* for DELAY */
60 #include <machine/bus_memio.h>
61 #include <machine/bus_pio.h>
62 #include <machine/bus.h>
63 #include <machine/resource.h>
64 #include <sys/bus.h>
65 #include <sys/rman.h>
66
67 #include <bus/pci/pcireg.h>
68 #include <bus/pci/pcivar.h>
69
70 #include "../mii_layer/mii.h"
71 #include "../mii_layer/miivar.h"
72
73 #include "miibus_if.h"
74
75 /*
76  * #define MY_USEIOSPACE
77  */
78
79 static int      MY_USEIOSPACE = 1;
80
81 #if (MY_USEIOSPACE)
82 #define MY_RES                  SYS_RES_IOPORT
83 #define MY_RID                  MY_PCI_LOIO
84 #else
85 #define MY_RES                  SYS_RES_MEMORY
86 #define MY_RID                  MY_PCI_LOMEM
87 #endif
88
89
90 #include "if_myreg.h"
91
92 /*
93  * Various supported device vendors/types and their names.
94  */
95 static struct my_type my_devs[] = {
96         {MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"},
97         {MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"},
98         {MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"},
99         {0, 0, NULL}
100 };
101
102 /*
103  * Various supported PHY vendors/types and their names. Note that this driver
104  * will work with pretty much any MII-compliant PHY, so failure to positively
105  * identify the chip is not a fatal error.
106  */
107 static struct my_type my_phys[] = {
108         {MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"},
109         {SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"},
110         {AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"},
111         {MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"},
112         {LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"},
113         {0, 0, "<MII-compliant physical interface>"}
114 };
115
116 static int      my_probe(device_t);
117 static int      my_attach(device_t);
118 static int      my_detach(device_t);
119 static int      my_newbuf(struct my_softc *, struct my_chain_onefrag *);
120 static int      my_encap(struct my_softc *, struct my_chain *, struct mbuf *);
121 static void     my_rxeof(struct my_softc *);
122 static void     my_txeof(struct my_softc *);
123 static void     my_txeoc(struct my_softc *);
124 static void     my_intr(void *);
125 static void     my_start(struct ifnet *);
126 static int      my_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
127 static void     my_init(void *);
128 static void     my_stop(struct my_softc *);
129 static void     my_watchdog(struct ifnet *);
130 static void     my_shutdown(device_t);
131 static int      my_ifmedia_upd(struct ifnet *);
132 static void     my_ifmedia_sts(struct ifnet *, struct ifmediareq *);
133 static u_int16_t my_phy_readreg(struct my_softc *, int);
134 static void     my_phy_writereg(struct my_softc *, int, int);
135 static void     my_autoneg_xmit(struct my_softc *);
136 static void     my_autoneg_mii(struct my_softc *, int, int);
137 static void     my_setmode_mii(struct my_softc *, int);
138 static void     my_getmode_mii(struct my_softc *);
139 static void     my_setcfg(struct my_softc *, int);
140 static u_int8_t my_calchash(caddr_t);
141 static void     my_setmulti(struct my_softc *);
142 static void     my_reset(struct my_softc *);
143 static int      my_list_rx_init(struct my_softc *);
144 static int      my_list_tx_init(struct my_softc *);
145 static long     my_send_cmd_to_phy(struct my_softc *, int, int);
146
147 #define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | x)
148 #define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~x)
149
150 static device_method_t my_methods[] = {
151         /* Device interface */
152         DEVMETHOD(device_probe, my_probe),
153         DEVMETHOD(device_attach, my_attach),
154         DEVMETHOD(device_detach, my_detach),
155         DEVMETHOD(device_shutdown, my_shutdown),
156
157         {0, 0}
158 };
159
160 static driver_t my_driver = {
161         "my",
162         my_methods,
163         sizeof(struct my_softc)
164 };
165
166 static devclass_t my_devclass;
167
168 DECLARE_DUMMY_MODULE(if_my);
169 DRIVER_MODULE(if_my, pci, my_driver, my_devclass, 0, 0);
170
171 static long
172 my_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad)
173 {
174         long            miir;
175         int             i;
176         int             mask, data;
177
178         /* enable MII output */
179         miir = CSR_READ_4(sc, MY_MANAGEMENT);
180         miir &= 0xfffffff0;
181
182         miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO;
183
184         /* send 32 1's preamble */
185         for (i = 0; i < 32; i++) {
186                 /* low MDC; MDO is already high (miir) */
187                 miir &= ~MY_MASK_MIIR_MII_MDC;
188                 CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
189
190                 /* high MDC */
191                 miir |= MY_MASK_MIIR_MII_MDC;
192                 CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
193         }
194
195         /* calculate ST+OP+PHYAD+REGAD+TA */
196         data = opcode | (sc->my_phy_addr << 7) | (regad << 2);
197
198         /* sent out */
199         mask = 0x8000;
200         while (mask) {
201                 /* low MDC, prepare MDO */
202                 miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
203                 if (mask & data)
204                         miir |= MY_MASK_MIIR_MII_MDO;
205
206                 CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
207                 /* high MDC */
208                 miir |= MY_MASK_MIIR_MII_MDC;
209                 CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
210                 DELAY(30);
211
212                 /* next */
213                 mask >>= 1;
214                 if (mask == 0x2 && opcode == MY_OP_READ)
215                         miir &= ~MY_MASK_MIIR_MII_WRITE;
216         }
217
218         return miir;
219 }
220
221
222 static          u_int16_t
223 my_phy_readreg(struct my_softc * sc, int reg)
224 {
225         long            miir;
226         int             mask, data;
227
228         if (sc->my_info->my_did == MTD803ID)
229                 data = CSR_READ_2(sc, MY_PHYBASE + reg * 2);
230         else {
231                 miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg);
232
233                 /* read data */
234                 mask = 0x8000;
235                 data = 0;
236                 while (mask) {
237                         /* low MDC */
238                         miir &= ~MY_MASK_MIIR_MII_MDC;
239                         CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
240
241                         /* read MDI */
242                         miir = CSR_READ_4(sc, MY_MANAGEMENT);
243                         if (miir & MY_MASK_MIIR_MII_MDI)
244                                 data |= mask;
245
246                         /* high MDC, and wait */
247                         miir |= MY_MASK_MIIR_MII_MDC;
248                         CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
249                         DELAY(30);
250
251                         /* next */
252                         mask >>= 1;
253                 }
254
255                 /* low MDC */
256                 miir &= ~MY_MASK_MIIR_MII_MDC;
257                 CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
258         }
259
260         return (u_int16_t) data;
261 }
262
263
264 static void
265 my_phy_writereg(struct my_softc * sc, int reg, int data)
266 {
267         long            miir;
268         int             mask;
269
270         if (sc->my_info->my_did == MTD803ID)
271                 CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data);
272         else {
273                 miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg);
274
275                 /* write data */
276                 mask = 0x8000;
277                 while (mask) {
278                         /* low MDC, prepare MDO */
279                         miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO);
280                         if (mask & data)
281                                 miir |= MY_MASK_MIIR_MII_MDO;
282                         CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
283                         DELAY(1);
284
285                         /* high MDC */
286                         miir |= MY_MASK_MIIR_MII_MDC;
287                         CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
288                         DELAY(1);
289
290                         /* next */
291                         mask >>= 1;
292                 }
293
294                 /* low MDC */
295                 miir &= ~MY_MASK_MIIR_MII_MDC;
296                 CSR_WRITE_4(sc, MY_MANAGEMENT, miir);
297         }
298 }
299
300 static          u_int8_t
301 my_calchash(caddr_t addr)
302 {
303         u_int32_t       crc, carry;
304         int             i, j;
305         u_int8_t        c;
306
307         /* Compute CRC for the address value. */
308         crc = 0xFFFFFFFF;       /* initial value */
309
310         for (i = 0; i < 6; i++) {
311                 c = *(addr + i);
312                 for (j = 0; j < 8; j++) {
313                         carry = ((crc & 0x80000000) ? 1 : 0) ^ (c & 0x01);
314                         crc <<= 1;
315                         c >>= 1;
316                         if (carry)
317                                 crc = (crc ^ 0x04c11db6) | carry;
318                 }
319         }
320
321         /*
322          * return the filter bit position Note: I arrived at the following
323          * nonsense through experimentation. It's not the usual way to
324          * generate the bit position but it's the only thing I could come up
325          * with that works.
326          */
327         return (~(crc >> 26) & 0x0000003F);
328 }
329
330
331 /*
332  * Program the 64-bit multicast hash filter.
333  */
334 static void
335 my_setmulti(struct my_softc * sc)
336 {
337         struct ifnet *ifp = &sc->arpcom.ac_if;
338         int             h = 0;
339         u_int32_t       hashes[2] = {0, 0};
340         struct ifmultiaddr *ifma;
341         u_int32_t       rxfilt;
342         int             mcnt = 0;
343
344         rxfilt = CSR_READ_4(sc, MY_TCRRCR);
345
346         if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
347                 rxfilt |= MY_AM;
348                 CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
349                 CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF);
350                 CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF);
351
352                 return;
353         }
354         /* first, zot all the existing hash bits */
355         CSR_WRITE_4(sc, MY_MAR0, 0);
356         CSR_WRITE_4(sc, MY_MAR1, 0);
357
358         /* now program new ones */
359         LIST_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
360                 if (ifma->ifma_addr->sa_family != AF_LINK)
361                         continue;
362                 h = my_calchash(LLADDR((struct sockaddr_dl *) ifma->ifma_addr));
363                 if (h < 32)
364                         hashes[0] |= (1 << h);
365                 else
366                         hashes[1] |= (1 << (h - 32));
367                 mcnt++;
368         }
369
370         if (mcnt)
371                 rxfilt |= MY_AM;
372         else
373                 rxfilt &= ~MY_AM;
374         CSR_WRITE_4(sc, MY_MAR0, hashes[0]);
375         CSR_WRITE_4(sc, MY_MAR1, hashes[1]);
376         CSR_WRITE_4(sc, MY_TCRRCR, rxfilt);
377 }
378
379 /*
380  * Initiate an autonegotiation session.
381  */
382 static void
383 my_autoneg_xmit(struct my_softc * sc)
384 {
385         u_int16_t       phy_sts = 0;
386
387         my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET);
388         DELAY(500);
389         while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET);
390
391         phy_sts = my_phy_readreg(sc, PHY_BMCR);
392         phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR;
393         my_phy_writereg(sc, PHY_BMCR, phy_sts);
394 }
395
396
397 /*
398  * Invoke autonegotiation on a PHY.
399  */
400 static void
401 my_autoneg_mii(struct my_softc * sc, int flag, int verbose)
402 {
403         u_int16_t       phy_sts = 0, media, advert, ability;
404         u_int16_t       ability2 = 0;
405         struct ifnet *ifp = &sc->arpcom.ac_if;
406         struct ifmedia *ifm = &sc->ifmedia;
407
408         ifm->ifm_media = IFM_ETHER | IFM_AUTO;
409
410 #ifndef FORCE_AUTONEG_TFOUR
411         /*
412          * First, see if autoneg is supported. If not, there's no point in
413          * continuing.
414          */
415         phy_sts = my_phy_readreg(sc, PHY_BMSR);
416         if (!(phy_sts & PHY_BMSR_CANAUTONEG)) {
417                 if (verbose)
418                         printf("my%d: autonegotiation not supported\n",
419                             sc->my_unit);
420                 ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
421                 return;
422         }
423 #endif
424         switch (flag) {
425         case MY_FLAG_FORCEDELAY:
426                 /*
427                  * XXX Never use this option anywhere but in the probe
428                  * routine: making the kernel stop dead in its tracks for
429                  * three whole seconds after we've gone multi-user is really
430                  * bad manners.
431                  */
432                 my_autoneg_xmit(sc);
433                 DELAY(5000000);
434                 break;
435         case MY_FLAG_SCHEDDELAY:
436                 /*
437                  * Wait for the transmitter to go idle before starting an
438                  * autoneg session, otherwise my_start() may clobber our
439                  * timeout, and we don't want to allow transmission during an
440                  * autoneg session since that can screw it up.
441                  */
442                 if (sc->my_cdata.my_tx_head != NULL) {
443                         sc->my_want_auto = 1;
444                         return;
445                 }
446                 my_autoneg_xmit(sc);
447                 ifp->if_timer = 5;
448                 sc->my_autoneg = 1;
449                 sc->my_want_auto = 0;
450                 return;
451         case MY_FLAG_DELAYTIMEO:
452                 ifp->if_timer = 0;
453                 sc->my_autoneg = 0;
454                 break;
455         default:
456                 printf("my%d: invalid autoneg flag: %d\n", sc->my_unit, flag);
457                 return;
458         }
459
460         if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) {
461                 if (verbose)
462                         printf("my%d: autoneg complete, ", sc->my_unit);
463                 phy_sts = my_phy_readreg(sc, PHY_BMSR);
464         } else {
465                 if (verbose)
466                         printf("my%d: autoneg not complete, ", sc->my_unit);
467         }
468
469         media = my_phy_readreg(sc, PHY_BMCR);
470
471         /* Link is good. Report modes and set duplex mode. */
472         if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) {
473                 if (verbose)
474                         printf("my%d: link status good. ", sc->my_unit);
475                 advert = my_phy_readreg(sc, PHY_ANAR);
476                 ability = my_phy_readreg(sc, PHY_LPAR);
477                 if ((sc->my_pinfo->my_vid == MarvellPHYID0) ||
478                     (sc->my_pinfo->my_vid == LevelOnePHYID0)) {
479                         ability2 = my_phy_readreg(sc, PHY_1000SR);
480                         if (ability2 & PHY_1000SR_1000BTXFULL) {
481                                 advert = 0;
482                                 ability = 0;
483                                 /*
484                                  * this version did not support 1000M,
485                                  * ifm->ifm_media =
486                                  * IFM_ETHER | IFM_1000_T | IFM_FDX;
487                                  */
488                                 ifm->ifm_media =
489                                     IFM_ETHER | IFM_100_TX | IFM_FDX;
490                                 media &= ~PHY_BMCR_SPEEDSEL;
491                                 media |= PHY_BMCR_1000;
492                                 media |= PHY_BMCR_DUPLEX;
493                                 printf("(full-duplex, 1000Mbps)\n");
494                         } else if (ability2 & PHY_1000SR_1000BTXHALF) {
495                                 advert = 0;
496                                 ability = 0;
497                                 /*
498                                  * this version did not support 1000M,
499                                  * ifm->ifm_media = IFM_ETHER | IFM_1000_T;
500                                  */
501                                 ifm->ifm_media = IFM_ETHER | IFM_100_TX;
502                                 media &= ~PHY_BMCR_SPEEDSEL;
503                                 media &= ~PHY_BMCR_DUPLEX;
504                                 media |= PHY_BMCR_1000;
505                                 printf("(half-duplex, 1000Mbps)\n");
506                         }
507                 }
508                 if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) {
509                         ifm->ifm_media = IFM_ETHER | IFM_100_T4;
510                         media |= PHY_BMCR_SPEEDSEL;
511                         media &= ~PHY_BMCR_DUPLEX;
512                         printf("(100baseT4)\n");
513                 } else if (advert & PHY_ANAR_100BTXFULL &&
514                            ability & PHY_ANAR_100BTXFULL) {
515                         ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
516                         media |= PHY_BMCR_SPEEDSEL;
517                         media |= PHY_BMCR_DUPLEX;
518                         printf("(full-duplex, 100Mbps)\n");
519                 } else if (advert & PHY_ANAR_100BTXHALF &&
520                            ability & PHY_ANAR_100BTXHALF) {
521                         ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
522                         media |= PHY_BMCR_SPEEDSEL;
523                         media &= ~PHY_BMCR_DUPLEX;
524                         printf("(half-duplex, 100Mbps)\n");
525                 } else if (advert & PHY_ANAR_10BTFULL &&
526                            ability & PHY_ANAR_10BTFULL) {
527                         ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
528                         media &= ~PHY_BMCR_SPEEDSEL;
529                         media |= PHY_BMCR_DUPLEX;
530                         printf("(full-duplex, 10Mbps)\n");
531                 } else if (advert) {
532                         ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
533                         media &= ~PHY_BMCR_SPEEDSEL;
534                         media &= ~PHY_BMCR_DUPLEX;
535                         printf("(half-duplex, 10Mbps)\n");
536                 }
537                 media &= ~PHY_BMCR_AUTONEGENBL;
538
539                 /* Set ASIC's duplex mode to match the PHY. */
540                 my_phy_writereg(sc, PHY_BMCR, media);
541                 my_setcfg(sc, media);
542         } else {
543                 if (verbose)
544                         printf("my%d: no carrier\n", sc->my_unit);
545         }
546
547         my_init(sc);
548         if (sc->my_tx_pend) {
549                 sc->my_autoneg = 0;
550                 sc->my_tx_pend = 0;
551                 my_start(ifp);
552         }
553 }
554
555 /*
556  * To get PHY ability.
557  */
558 static void
559 my_getmode_mii(struct my_softc * sc)
560 {
561         struct ifnet *ifp = &sc->arpcom.ac_if;
562         u_int16_t       bmsr;
563
564         bmsr = my_phy_readreg(sc, PHY_BMSR);
565         if (bootverbose)
566                 printf("my%d: PHY status word: %x\n", sc->my_unit, bmsr);
567
568         /* fallback */
569         sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX;
570
571         if (bmsr & PHY_BMSR_10BTHALF) {
572                 if (bootverbose)
573                         printf("my%d: 10Mbps half-duplex mode supported\n",
574                                sc->my_unit);
575                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX,
576                     0, NULL);
577                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL);
578         }
579         if (bmsr & PHY_BMSR_10BTFULL) {
580                 if (bootverbose)
581                         printf("my%d: 10Mbps full-duplex mode supported\n",
582                             sc->my_unit);
583
584                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX,
585                     0, NULL);
586                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX;
587         }
588         if (bmsr & PHY_BMSR_100BTXHALF) {
589                 if (bootverbose)
590                         printf("my%d: 100Mbps half-duplex mode supported\n",
591                                sc->my_unit);
592                 ifp->if_baudrate = 100000000;
593                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL);
594                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX,
595                             0, NULL);
596                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX;
597         }
598         if (bmsr & PHY_BMSR_100BTXFULL) {
599                 if (bootverbose)
600                         printf("my%d: 100Mbps full-duplex mode supported\n",
601                             sc->my_unit);
602                 ifp->if_baudrate = 100000000;
603                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX,
604                     0, NULL);
605                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX;
606         }
607         /* Some also support 100BaseT4. */
608         if (bmsr & PHY_BMSR_100BT4) {
609                 if (bootverbose)
610                         printf("my%d: 100baseT4 mode supported\n", sc->my_unit);
611                 ifp->if_baudrate = 100000000;
612                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL);
613                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4;
614 #ifdef FORCE_AUTONEG_TFOUR
615                 if (bootverbose)
616                         printf("my%d: forcing on autoneg support for BT4\n",
617                             sc->my_unit);
618                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL):
619                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
620 #endif
621         }
622 #if 0                           /* this version did not support 1000M, */
623         if (sc->my_pinfo->my_vid == MarvellPHYID0) {
624                 if (bootverbose)
625                         printf("my%d: 1000Mbps half-duplex mode supported\n",
626                                sc->my_unit);
627
628                 ifp->if_baudrate = 1000000000;
629                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL);
630                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX,
631                     0, NULL);
632                 if (bootverbose)
633                         printf("my%d: 1000Mbps full-duplex mode supported\n",
634                            sc->my_unit);
635                 ifp->if_baudrate = 1000000000;
636                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX,
637                     0, NULL);
638                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX;
639         }
640 #endif
641         if (bmsr & PHY_BMSR_CANAUTONEG) {
642                 if (bootverbose)
643                         printf("my%d: autoneg supported\n", sc->my_unit);
644                 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL);
645                 sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO;
646         }
647 }
648
649 /*
650  * Set speed and duplex mode.
651  */
652 static void
653 my_setmode_mii(struct my_softc * sc, int media)
654 {
655         struct ifnet *ifp = &sc->arpcom.ac_if;
656         u_int16_t       bmcr;
657
658         /*
659          * If an autoneg session is in progress, stop it.
660          */
661         if (sc->my_autoneg) {
662                 printf("my%d: canceling autoneg session\n", sc->my_unit);
663                 ifp->if_timer = sc->my_autoneg = sc->my_want_auto = 0;
664                 bmcr = my_phy_readreg(sc, PHY_BMCR);
665                 bmcr &= ~PHY_BMCR_AUTONEGENBL;
666                 my_phy_writereg(sc, PHY_BMCR, bmcr);
667         }
668         printf("my%d: selecting MII, ", sc->my_unit);
669         bmcr = my_phy_readreg(sc, PHY_BMCR);
670         bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 |
671                   PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK);
672
673 #if 0                           /* this version did not support 1000M, */
674         if (IFM_SUBTYPE(media) == IFM_1000_T) {
675                 printf("1000Mbps/T4, half-duplex\n");
676                 bmcr &= ~PHY_BMCR_SPEEDSEL;
677                 bmcr &= ~PHY_BMCR_DUPLEX;
678                 bmcr |= PHY_BMCR_1000;
679         }
680 #endif
681         if (IFM_SUBTYPE(media) == IFM_100_T4) {
682                 printf("100Mbps/T4, half-duplex\n");
683                 bmcr |= PHY_BMCR_SPEEDSEL;
684                 bmcr &= ~PHY_BMCR_DUPLEX;
685         }
686         if (IFM_SUBTYPE(media) == IFM_100_TX) {
687                 printf("100Mbps, ");
688                 bmcr |= PHY_BMCR_SPEEDSEL;
689         }
690         if (IFM_SUBTYPE(media) == IFM_10_T) {
691                 printf("10Mbps, ");
692                 bmcr &= ~PHY_BMCR_SPEEDSEL;
693         }
694         if ((media & IFM_GMASK) == IFM_FDX) {
695                 printf("full duplex\n");
696                 bmcr |= PHY_BMCR_DUPLEX;
697         } else {
698                 printf("half duplex\n");
699                 bmcr &= ~PHY_BMCR_DUPLEX;
700         }
701         my_phy_writereg(sc, PHY_BMCR, bmcr);
702         my_setcfg(sc, bmcr);
703 }
704
705 /*
706  * The Myson manual states that in order to fiddle with the 'full-duplex' and
707  * '100Mbps' bits in the netconfig register, we first have to put the
708  * transmit and/or receive logic in the idle state.
709  */
710 static void
711 my_setcfg(struct my_softc * sc, int bmcr)
712 {
713         int             i, restart = 0;
714
715         if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) {
716                 restart = 1;
717                 MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE));
718                 for (i = 0; i < MY_TIMEOUT; i++) {
719                         DELAY(10);
720                         if (!(CSR_READ_4(sc, MY_TCRRCR) &
721                             (MY_TXRUN | MY_RXRUN)))
722                                 break;
723                 }
724                 if (i == MY_TIMEOUT)
725                         printf("my%d: failed to force tx and rx to idle \n",
726                             sc->my_unit);
727         }
728         MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000);
729         MY_CLRBIT(sc, MY_TCRRCR, MY_PS10);
730         if (bmcr & PHY_BMCR_1000)
731                 MY_SETBIT(sc, MY_TCRRCR, MY_PS1000);
732         else if (!(bmcr & PHY_BMCR_SPEEDSEL))
733                 MY_SETBIT(sc, MY_TCRRCR, MY_PS10);
734         if (bmcr & PHY_BMCR_DUPLEX)
735                 MY_SETBIT(sc, MY_TCRRCR, MY_FD);
736         else
737                 MY_CLRBIT(sc, MY_TCRRCR, MY_FD);
738         if (restart)
739                 MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE);
740 }
741
742 static void
743 my_reset(struct my_softc * sc)
744 {
745         int    i;
746
747         MY_SETBIT(sc, MY_BCR, MY_SWR);
748         for (i = 0; i < MY_TIMEOUT; i++) {
749                 DELAY(10);
750                 if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR))
751                         break;
752         }
753         if (i == MY_TIMEOUT)
754                 printf("m0x%d: reset never completed!\n", sc->my_unit);
755
756         /* Wait a little while for the chip to get its brains in order. */
757         DELAY(1000);
758 }
759
760 /*
761  * Probe for a Myson chip. Check the PCI vendor and device IDs against our
762  * list and return a device name if we find a match.
763  */
764 static int
765 my_probe(device_t dev)
766 {
767         struct my_type *t;
768         uint16_t vendor, product;
769
770         vendor = pci_get_vendor(dev);
771         product = pci_get_device(dev);
772
773         for (t = my_devs; t->my_name != NULL; t++) {
774                 if (vendor == t->my_vid && product == t->my_did) {
775                         device_set_desc(dev, t->my_name);
776                         return (0);
777                 }
778         }
779
780         return (ENXIO);
781 }
782
783 /*
784  * Attach the interface. Allocate softc structures, do ifmedia setup and
785  * ethernet/BPF attach.
786  */
787 static int
788 my_attach(device_t dev)
789 {
790         int             i;
791         u_char          eaddr[ETHER_ADDR_LEN];
792         u_int32_t       command, iobase;
793         struct my_softc *sc;
794         struct ifnet   *ifp;
795         int             media = IFM_ETHER | IFM_100_TX | IFM_FDX;
796         unsigned int    round;
797         caddr_t         roundptr;
798         struct my_type *p;
799         u_int16_t       phy_vid, phy_did, phy_sts = 0;
800         int             rid, unit, error = 0;
801         struct my_type *t;
802         uint16_t vendor, product;
803
804         vendor = pci_get_vendor(dev);
805         product = pci_get_device(dev);
806
807         for (t = my_devs; t->my_name != NULL; t++) {
808                 if (vendor == t->my_vid && product == t->my_did)
809                         break;
810         }
811
812         if (t->my_name == NULL)
813                 return(ENXIO);
814
815         sc = device_get_softc(dev);
816         unit = device_get_unit(dev);
817
818         /*
819          * Map control/status registers.
820          */
821         command = pci_read_config(dev, PCIR_COMMAND, 4);
822         command |= (PCIM_CMD_PORTEN | PCIM_CMD_MEMEN | PCIM_CMD_BUSMASTEREN);
823         pci_write_config(dev, PCIR_COMMAND, command & 0x000000ff, 4);
824         command = pci_read_config(dev, PCIR_COMMAND, 4);
825
826         if (t->my_did == MTD800ID) {
827                 iobase = pci_read_config(dev, MY_PCI_LOIO, 4);
828                 if (iobase & 0x300)
829                         MY_USEIOSPACE = 0;
830         }
831         if (MY_USEIOSPACE) {
832                 if (!(command & PCIM_CMD_PORTEN)) {
833                         printf("my%d: failed to enable I/O ports!\n", unit);
834                         error = ENXIO;
835                         return(error);
836                 }
837         } else {
838                 if (!(command & PCIM_CMD_MEMEN)) {
839                         printf("my%d: failed to enable memory mapping!\n",
840                             unit);
841                         error = ENXIO;
842                         return(error);
843                 }
844         }
845
846         rid = MY_RID;
847         sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE);
848
849         if (sc->my_res == NULL) {
850                 printf("my%d: couldn't map ports/memory\n", unit);
851                 error = ENXIO;
852                 goto fail;
853         }
854         sc->my_btag = rman_get_bustag(sc->my_res);
855         sc->my_bhandle = rman_get_bushandle(sc->my_res);
856
857         rid = 0;
858         sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
859             RF_SHAREABLE | RF_ACTIVE);
860
861         if (sc->my_irq == NULL) {
862                 printf("my%d: couldn't map interrupt\n", unit);
863                 error = ENXIO;
864                 goto fail;
865         }
866
867         sc->my_info = t;
868
869         /* Reset the adapter. */
870         my_reset(sc);
871
872         /*
873          * Get station address
874          */
875         for (i = 0; i < ETHER_ADDR_LEN; ++i)
876                 eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i);
877
878         sc->my_unit = unit;
879
880         sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8,
881                                   M_DEVBUF, M_WAITOK);
882         if (sc->my_ldata_ptr == NULL) {
883                 printf("my%d: no memory for list buffers!\n", unit);
884                 error = ENXIO;
885                 goto fail;
886         }
887         sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr;
888         round = (unsigned int)sc->my_ldata_ptr & 0xF;
889         roundptr = sc->my_ldata_ptr;
890         for (i = 0; i < 8; i++) {
891                 if (round % 8) {
892                         round++;
893                         roundptr++;
894                 } else
895                         break;
896         }
897         sc->my_ldata = (struct my_list_data *) roundptr;
898         bzero(sc->my_ldata, sizeof(struct my_list_data));
899
900         ifp = &sc->arpcom.ac_if;
901         ifp->if_softc = sc;
902         if_initname(ifp, "my", unit);
903         ifp->if_mtu = ETHERMTU;
904         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
905         ifp->if_ioctl = my_ioctl;
906         ifp->if_start = my_start;
907         ifp->if_watchdog = my_watchdog;
908         ifp->if_init = my_init;
909         ifp->if_baudrate = 10000000;
910         ifq_set_maxlen(&ifp->if_snd, IFQ_MAXLEN);
911         ifq_set_ready(&ifp->if_snd);
912
913         if (sc->my_info->my_did == MTD803ID)
914                 sc->my_pinfo = my_phys;
915         else {
916                 if (bootverbose)
917                         printf("my%d: probing for a PHY\n", sc->my_unit);
918                 for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) {
919                         if (bootverbose)
920                                 printf("my%d: checking address: %d\n",
921                                     sc->my_unit, i);
922                         sc->my_phy_addr = i;
923                         phy_sts = my_phy_readreg(sc, PHY_BMSR);
924                         if ((phy_sts != 0) && (phy_sts != 0xffff))
925                                 break;
926                         else
927                                 phy_sts = 0;
928                 }
929                 if (phy_sts) {
930                         phy_vid = my_phy_readreg(sc, PHY_VENID);
931                         phy_did = my_phy_readreg(sc, PHY_DEVID);
932                         if (bootverbose) {
933                                 printf("my%d: found PHY at address %d, ",
934                                     sc->my_unit, sc->my_phy_addr);
935                                 printf("vendor id: %x device id: %x\n",
936                                     phy_vid, phy_did);
937                         }
938                         p = my_phys;
939                         while (p->my_vid) {
940                                 if (phy_vid == p->my_vid) {
941                                         sc->my_pinfo = p;
942                                         break;
943                                 }
944                                 p++;
945                         }
946                         if (sc->my_pinfo == NULL)
947                                 sc->my_pinfo = &my_phys[PHY_UNKNOWN];
948                         if (bootverbose)
949                                 printf("my%d: PHY type: %s\n",
950                                        sc->my_unit, sc->my_pinfo->my_name);
951                 } else {
952                         printf("my%d: MII without any phy!\n", sc->my_unit);
953                         error = ENXIO;
954                         goto fail;
955                 }
956         }
957
958         /* Do ifmedia setup. */
959         ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts);
960         my_getmode_mii(sc);
961         my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1);
962         media = sc->ifmedia.ifm_media;
963         my_stop(sc);
964         ifmedia_set(&sc->ifmedia, media);
965
966         ether_ifattach(ifp, eaddr, NULL);
967
968         error = bus_setup_intr(dev, sc->my_irq, INTR_NETSAFE,
969                                my_intr, sc, &sc->my_intrhand, 
970                                ifp->if_serializer);
971         if (error) {
972                 ether_ifdetach(ifp);
973                 printf("my%d: couldn't set up irq\n", unit);
974                 goto fail;
975         }
976
977         return (0);
978
979 fail:
980         my_detach(dev);
981         return (error);
982 }
983
984 static int
985 my_detach(device_t dev)
986 {
987         struct my_softc *sc = device_get_softc(dev);
988         struct ifnet *ifp = &sc->arpcom.ac_if;
989
990         lwkt_serialize_enter(ifp->if_serializer);
991         if (device_is_attached(dev)) {
992                 ether_ifdetach(ifp);
993                 my_stop(sc);
994         }
995
996         if (sc->my_intrhand)
997                 bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand);
998
999         lwkt_serialize_exit(ifp->if_serializer);
1000
1001         if (sc->my_irq)
1002                 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq);
1003         if (sc->my_res)
1004                 bus_release_resource(dev, MY_RES, MY_RID, sc->my_res);
1005
1006         return (0);
1007 }
1008
1009
1010 /*
1011  * Initialize the transmit descriptors.
1012  */
1013 static int
1014 my_list_tx_init(struct my_softc * sc)
1015 {
1016         struct my_chain_data *cd;
1017         struct my_list_data *ld;
1018         int             i;
1019
1020         cd = &sc->my_cdata;
1021         ld = sc->my_ldata;
1022         for (i = 0; i < MY_TX_LIST_CNT; i++) {
1023                 cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i];
1024                 if (i == (MY_TX_LIST_CNT - 1))
1025                         cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0];
1026                 else
1027                         cd->my_tx_chain[i].my_nextdesc =
1028                             &cd->my_tx_chain[i + 1];
1029         }
1030         cd->my_tx_free = &cd->my_tx_chain[0];
1031         cd->my_tx_tail = cd->my_tx_head = NULL;
1032         return (0);
1033 }
1034
1035 /*
1036  * Initialize the RX descriptors and allocate mbufs for them. Note that we
1037  * arrange the descriptors in a closed ring, so that the last descriptor
1038  * points back to the first.
1039  */
1040 static int
1041 my_list_rx_init(struct my_softc * sc)
1042 {
1043         struct my_chain_data *cd;
1044         struct my_list_data *ld;
1045         int             i;
1046
1047         cd = &sc->my_cdata;
1048         ld = sc->my_ldata;
1049         for (i = 0; i < MY_RX_LIST_CNT; i++) {
1050                 cd->my_rx_chain[i].my_ptr =
1051                     (struct my_desc *) & ld->my_rx_list[i];
1052                 if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS)
1053                         return (ENOBUFS);
1054                 if (i == (MY_RX_LIST_CNT - 1)) {
1055                         cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0];
1056                         ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]);
1057                 } else {
1058                         cd->my_rx_chain[i].my_nextdesc =
1059                             &cd->my_rx_chain[i + 1];
1060                         ld->my_rx_list[i].my_next =
1061                             vtophys(&ld->my_rx_list[i + 1]);
1062                 }
1063         }
1064         cd->my_rx_head = &cd->my_rx_chain[0];
1065         return (0);
1066 }
1067
1068 /*
1069  * Initialize an RX descriptor and attach an MBUF cluster.
1070  */
1071 static int
1072 my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c)
1073 {
1074         struct mbuf    *m_new = NULL;
1075
1076         MGETHDR(m_new, MB_DONTWAIT, MT_DATA);
1077         if (m_new == NULL) {
1078                 printf("my%d: no memory for rx list -- packet dropped!\n",
1079                        sc->my_unit);
1080                 return (ENOBUFS);
1081         }
1082         MCLGET(m_new, MB_DONTWAIT);
1083         if (!(m_new->m_flags & M_EXT)) {
1084                 printf("my%d: no memory for rx list -- packet dropped!\n",
1085                        sc->my_unit);
1086                 m_freem(m_new);
1087                 return (ENOBUFS);
1088         }
1089         c->my_mbuf = m_new;
1090         c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t));
1091         c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift;
1092         c->my_ptr->my_status = MY_OWNByNIC;
1093         return (0);
1094 }
1095
1096 /*
1097  * A frame has been uploaded: pass the resulting mbuf chain up to the higher
1098  * level protocols.
1099  */
1100 static void
1101 my_rxeof(struct my_softc * sc)
1102 {
1103         struct mbuf *m;
1104         struct ifnet *ifp = &sc->arpcom.ac_if;
1105         struct my_chain_onefrag *cur_rx;
1106         int total_len = 0;
1107         u_int32_t rxstat;
1108
1109         while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status)
1110             & MY_OWNByNIC)) {
1111                 cur_rx = sc->my_cdata.my_rx_head;
1112                 sc->my_cdata.my_rx_head = cur_rx->my_nextdesc;
1113
1114                 if (rxstat & MY_ES) {   /* error summary: give up this rx pkt */
1115                         ifp->if_ierrors++;
1116                         cur_rx->my_ptr->my_status = MY_OWNByNIC;
1117                         continue;
1118                 }
1119                 /* No errors; receive the packet. */
1120                 total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift;
1121                 total_len -= ETHER_CRC_LEN;
1122
1123                 if (total_len < MINCLSIZE) {
1124                         m = m_devget(mtod(cur_rx->my_mbuf, char *),
1125                             total_len, 0, ifp, NULL);
1126                         cur_rx->my_ptr->my_status = MY_OWNByNIC;
1127                         if (m == NULL) {
1128                                 ifp->if_ierrors++;
1129                                 continue;
1130                         }
1131                 } else {
1132                         m = cur_rx->my_mbuf;
1133                         /*
1134                          * Try to conjure up a new mbuf cluster. If that
1135                          * fails, it means we have an out of memory condition
1136                          * and should leave the buffer in place and continue.
1137                          * This will result in a lost packet, but there's
1138                          * little else we can do in this situation.
1139                          */
1140                         if (my_newbuf(sc, cur_rx) == ENOBUFS) {
1141                                 ifp->if_ierrors++;
1142                                 cur_rx->my_ptr->my_status = MY_OWNByNIC;
1143                                 continue;
1144                         }
1145                         m->m_pkthdr.rcvif = ifp;
1146                         m->m_pkthdr.len = m->m_len = total_len;
1147                 }
1148                 ifp->if_ipackets++;
1149                 ifp->if_input(ifp, m);
1150         }
1151 }
1152
1153
1154 /*
1155  * A frame was downloaded to the chip. It's safe for us to clean up the list
1156  * buffers.
1157  */
1158 static void
1159 my_txeof(struct my_softc * sc)
1160 {
1161         struct ifnet *ifp = &sc->arpcom.ac_if;
1162         struct my_chain *cur_tx;
1163
1164         /* Clear the timeout timer. */
1165         ifp->if_timer = 0;
1166         if (sc->my_cdata.my_tx_head == NULL)
1167                 return;
1168         /*
1169          * Go through our tx list and free mbufs for those frames that have
1170          * been transmitted.
1171          */
1172         while (sc->my_cdata.my_tx_head->my_mbuf != NULL) {
1173                 u_int32_t       txstat;
1174
1175                 cur_tx = sc->my_cdata.my_tx_head;
1176                 txstat = MY_TXSTATUS(cur_tx);
1177                 if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT)
1178                         break;
1179                 if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) {
1180                         if (txstat & MY_TXERR) {
1181                                 ifp->if_oerrors++;
1182                                 if (txstat & MY_EC) /* excessive collision */
1183                                         ifp->if_collisions++;
1184                                 if (txstat & MY_LC)     /* late collision */
1185                                         ifp->if_collisions++;
1186                         }
1187                         ifp->if_collisions += (txstat & MY_NCRMASK) >>
1188                             MY_NCRShift;
1189                 }
1190                 ifp->if_opackets++;
1191                 m_freem(cur_tx->my_mbuf);
1192                 cur_tx->my_mbuf = NULL;
1193                 if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) {
1194                         sc->my_cdata.my_tx_head = NULL;
1195                         sc->my_cdata.my_tx_tail = NULL;
1196                         break;
1197                 }
1198                 sc->my_cdata.my_tx_head = cur_tx->my_nextdesc;
1199         }
1200         if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) {
1201                 ifp->if_collisions += (CSR_READ_4(sc, MY_TSR) & MY_NCRMask);
1202         }
1203 }
1204
1205 /*
1206  * TX 'end of channel' interrupt handler.
1207  */
1208 static void
1209 my_txeoc(struct my_softc * sc)
1210 {
1211         struct ifnet *ifp = &sc->arpcom.ac_if;
1212
1213         ifp->if_timer = 0;
1214         if (sc->my_cdata.my_tx_head == NULL) {
1215                 ifp->if_flags &= ~IFF_OACTIVE;
1216                 sc->my_cdata.my_tx_tail = NULL;
1217                 if (sc->my_want_auto)
1218                         my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1219         } else {
1220                 if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) {
1221                         MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC;
1222                         ifp->if_timer = 5;
1223                         CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);
1224                 }
1225         }
1226 }
1227
1228 static void
1229 my_intr(void *arg)
1230 {
1231         struct my_softc *sc = arg;
1232         struct ifnet *ifp = &sc->arpcom.ac_if;
1233         u_int32_t status;
1234
1235         if (!(ifp->if_flags & IFF_UP))
1236                 return;
1237
1238         /* Disable interrupts. */
1239         CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1240
1241         for (;;) {
1242                 status = CSR_READ_4(sc, MY_ISR);
1243                 status &= MY_INTRS;
1244                 if (status)
1245                         CSR_WRITE_4(sc, MY_ISR, status);
1246                 else
1247                         break;
1248
1249                 if (status & MY_RI)     /* receive interrupt */
1250                         my_rxeof(sc);
1251
1252                 if ((status & MY_RBU) || (status & MY_RxErr)) {
1253                         /* rx buffer unavailable or rx error */
1254                         ifp->if_ierrors++;
1255 #ifdef foo
1256                         my_stop(sc);
1257                         my_reset(sc);
1258                         my_init(sc);
1259 #endif
1260                 }
1261                 if (status & MY_TI)     /* tx interrupt */
1262                         my_txeof(sc);
1263                 if (status & MY_ETI)    /* tx early interrupt */
1264                         my_txeof(sc);
1265                 if (status & MY_TBU)    /* tx buffer unavailable */
1266                         my_txeoc(sc);
1267
1268 #if 0                           /* 90/1/18 delete */
1269                 if (status & MY_FBE) {
1270                         my_reset(sc);
1271                         my_init(sc);
1272                 }
1273 #endif
1274
1275         }
1276
1277         /* Re-enable interrupts. */
1278         CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
1279         if (!ifq_is_empty(&ifp->if_snd))
1280                 my_start(ifp);
1281 }
1282
1283 /*
1284  * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1285  * pointers to the fragment pointers.
1286  */
1287 static int
1288 my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head)
1289 {
1290         struct my_desc *f = NULL;
1291         int             total_len;
1292         struct mbuf    *m, *m_new = NULL;
1293
1294         /* calculate the total tx pkt length */
1295         total_len = 0;
1296         for (m = m_head; m != NULL; m = m->m_next)
1297                 total_len += m->m_len;
1298         /*
1299          * Start packing the mbufs in this chain into the fragment pointers.
1300          * Stop when we run out of fragments or hit the end of the mbuf
1301          * chain.
1302          */
1303         m = m_head;
1304         MGETHDR(m_new, MB_DONTWAIT, MT_DATA);
1305         if (m_new == NULL) {
1306                 printf("my%d: no memory for tx list", sc->my_unit);
1307                 return (1);
1308         }
1309         if (m_head->m_pkthdr.len > MHLEN) {
1310                 MCLGET(m_new, MB_DONTWAIT);
1311                 if (!(m_new->m_flags & M_EXT)) {
1312                         m_freem(m_new);
1313                         printf("my%d: no memory for tx list", sc->my_unit);
1314                         return (1);
1315                 }
1316         }
1317         m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t));
1318         m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len;
1319         m_freem(m_head);
1320         m_head = m_new;
1321         f = &c->my_ptr->my_frag[0];
1322         f->my_status = 0;
1323         f->my_data = vtophys(mtod(m_new, caddr_t));
1324         total_len = m_new->m_len;
1325         f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable;
1326         f->my_ctl |= total_len << MY_PKTShift;  /* pkt size */
1327         f->my_ctl |= total_len; /* buffer size */
1328         /* 89/12/29 add, for mtd891 *//* [ 89? ] */
1329         if (sc->my_info->my_did == MTD891ID)
1330                 f->my_ctl |= MY_ETIControl | MY_RetryTxLC;
1331         c->my_mbuf = m_head;
1332         c->my_lastdesc = 0;
1333         MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]);
1334         return (0);
1335 }
1336
1337 /*
1338  * Main transmit routine. To avoid having to do mbuf copies, we put pointers
1339  * to the mbuf data regions directly in the transmit lists. We also save a
1340  * copy of the pointers since the transmit list fragment pointers are
1341  * physical addresses.
1342  */
1343 static void
1344 my_start(struct ifnet * ifp)
1345 {
1346         struct my_softc *sc = ifp->if_softc;
1347         struct mbuf    *m_head = NULL;
1348         struct my_chain *cur_tx = NULL, *start_tx;
1349
1350         crit_enter();
1351
1352         if (sc->my_autoneg) {
1353                 sc->my_tx_pend = 1;
1354                 crit_exit();
1355                 return;
1356         }
1357         /*
1358          * Check for an available queue slot. If there are none, punt.
1359          */
1360         if (sc->my_cdata.my_tx_free->my_mbuf != NULL) {
1361                 ifp->if_flags |= IFF_OACTIVE;
1362                 crit_exit();
1363                 return;
1364         }
1365
1366         start_tx = sc->my_cdata.my_tx_free;
1367         while (sc->my_cdata.my_tx_free->my_mbuf == NULL) {
1368                 m_head = ifq_dequeue(&ifp->if_snd, NULL);
1369                 if (m_head == NULL)
1370                         break;
1371
1372                 /* Pick a descriptor off the free list. */
1373                 cur_tx = sc->my_cdata.my_tx_free;
1374                 sc->my_cdata.my_tx_free = cur_tx->my_nextdesc;
1375
1376                 /* Pack the data into the descriptor. */
1377                 my_encap(sc, cur_tx, m_head);
1378
1379                 if (cur_tx != start_tx)
1380                         MY_TXOWN(cur_tx) = MY_OWNByNIC;
1381                 BPF_MTAP(ifp, cur_tx->my_mbuf);
1382         }
1383         /*
1384          * If there are no packets queued, bail.
1385          */
1386         if (cur_tx == NULL) {
1387                 crit_exit();
1388                 return;
1389         }
1390         /*
1391          * Place the request for the upload interrupt in the last descriptor
1392          * in the chain. This way, if we're chaining several packets at once,
1393          * we'll only get an interupt once for the whole chain rather than
1394          * once for each packet.
1395          */
1396         MY_TXCTL(cur_tx) |= MY_TXIC;
1397         cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC;
1398         sc->my_cdata.my_tx_tail = cur_tx;
1399         if (sc->my_cdata.my_tx_head == NULL)
1400                 sc->my_cdata.my_tx_head = start_tx;
1401         MY_TXOWN(start_tx) = MY_OWNByNIC;
1402         CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF);  /* tx polling demand */
1403
1404         /*
1405          * Set a timeout in case the chip goes out to lunch.
1406          */
1407         ifp->if_timer = 5;
1408
1409         crit_exit();
1410 }
1411
1412 static void
1413 my_init(void *xsc)
1414 {
1415         struct my_softc *sc = xsc;
1416         struct ifnet   *ifp = &sc->arpcom.ac_if;
1417         u_int16_t       phy_bmcr = 0;
1418
1419         crit_enter();
1420         if (sc->my_autoneg) {
1421                 crit_exit();
1422                 return;
1423         }
1424         if (sc->my_pinfo != NULL)
1425                 phy_bmcr = my_phy_readreg(sc, PHY_BMCR);
1426         /*
1427          * Cancel pending I/O and free all RX/TX buffers.
1428          */
1429         my_stop(sc);
1430         my_reset(sc);
1431
1432         /*
1433          * Set cache alignment and burst length.
1434          */
1435 #if 0                           /* 89/9/1 modify,  */
1436         CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512);
1437         CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF);
1438 #endif
1439         CSR_WRITE_4(sc, MY_BCR, MY_PBL8);
1440         CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512);
1441         /*
1442          * 89/12/29 add, for mtd891,
1443          */
1444         if (sc->my_info->my_did == MTD891ID) {
1445                 MY_SETBIT(sc, MY_BCR, MY_PROG);
1446                 MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced);
1447         }
1448         my_setcfg(sc, phy_bmcr);
1449         /* Init circular RX list. */
1450         if (my_list_rx_init(sc) == ENOBUFS) {
1451                 printf("my%d: init failed: no memory for rx buffers\n",
1452                     sc->my_unit);
1453                 my_stop(sc);
1454                 crit_exit();
1455                 return;
1456         }
1457         /* Init TX descriptors. */
1458         my_list_tx_init(sc);
1459
1460         /* If we want promiscuous mode, set the allframes bit. */
1461         if (ifp->if_flags & IFF_PROMISC)
1462                 MY_SETBIT(sc, MY_TCRRCR, MY_PROM);
1463         else
1464                 MY_CLRBIT(sc, MY_TCRRCR, MY_PROM);
1465
1466         /*
1467          * Set capture broadcast bit to capture broadcast frames.
1468          */
1469         if (ifp->if_flags & IFF_BROADCAST)
1470                 MY_SETBIT(sc, MY_TCRRCR, MY_AB);
1471         else
1472                 MY_CLRBIT(sc, MY_TCRRCR, MY_AB);
1473
1474         /*
1475          * Program the multicast filter, if necessary.
1476          */
1477         my_setmulti(sc);
1478
1479         /*
1480          * Load the address of the RX list.
1481          */
1482         MY_CLRBIT(sc, MY_TCRRCR, MY_RE);
1483         CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0]));
1484
1485         /*
1486          * Enable interrupts.
1487          */
1488         CSR_WRITE_4(sc, MY_IMR, MY_INTRS);
1489         CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF);
1490
1491         /* Enable receiver and transmitter. */
1492         MY_SETBIT(sc, MY_TCRRCR, MY_RE);
1493         MY_CLRBIT(sc, MY_TCRRCR, MY_TE);
1494         CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0]));
1495         MY_SETBIT(sc, MY_TCRRCR, MY_TE);
1496
1497         /* Restore state of BMCR */
1498         if (sc->my_pinfo != NULL)
1499                 my_phy_writereg(sc, PHY_BMCR, phy_bmcr);
1500         ifp->if_flags |= IFF_RUNNING;
1501         ifp->if_flags &= ~IFF_OACTIVE;
1502         crit_exit();
1503 }
1504
1505 /*
1506  * Set media options.
1507  */
1508
1509 static int
1510 my_ifmedia_upd(struct ifnet * ifp)
1511 {
1512         struct my_softc *sc = ifp->if_softc;
1513         struct ifmedia *ifm = &sc->ifmedia;
1514
1515         if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
1516                 return (EINVAL);
1517
1518         crit_enter();
1519
1520         if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO)
1521                 my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1);
1522         else
1523                 my_setmode_mii(sc, ifm->ifm_media);
1524
1525         crit_exit();
1526
1527         return (0);
1528 }
1529
1530 /*
1531  * Report current media status.
1532  */
1533
1534 static void
1535 my_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr)
1536 {
1537         struct my_softc *sc = ifp->if_softc;
1538         u_int16_t advert = 0, ability = 0;
1539
1540         crit_enter();
1541
1542         ifmr->ifm_active = IFM_ETHER;
1543         if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) {
1544 #if 0                           /* this version did not support 1000M, */
1545                 if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000)
1546                         ifmr->ifm_active = IFM_ETHER | IFM_1000TX;
1547 #endif
1548                 if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL)
1549                         ifmr->ifm_active = IFM_ETHER | IFM_100_TX;
1550                 else
1551                         ifmr->ifm_active = IFM_ETHER | IFM_10_T;
1552                 if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX)
1553                         ifmr->ifm_active |= IFM_FDX;
1554                 else
1555                         ifmr->ifm_active |= IFM_HDX;
1556
1557                 crit_exit();
1558
1559                 return;
1560         }
1561         ability = my_phy_readreg(sc, PHY_LPAR);
1562         advert = my_phy_readreg(sc, PHY_ANAR);
1563
1564 #if 0                           /* this version did not support 1000M, */
1565         if (sc->my_pinfo->my_vid = MarvellPHYID0) {
1566                 ability2 = my_phy_readreg(sc, PHY_1000SR);
1567                 if (ability2 & PHY_1000SR_1000BTXFULL) {
1568                         advert = 0;
1569                         ability = 0;
1570                         ifmr->ifm_active = IFM_ETHER | IFM_1000_T | IFM_FDX;
1571                 } else if (ability & PHY_1000SR_1000BTXHALF) {
1572                         advert = 0;
1573                         ability = 0;
1574                         ifmr->ifm_active = IFM_ETHER | IFM_1000_T | IFM_HDX;
1575                 }
1576         }
1577 #endif
1578         if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4)
1579                 ifmr->ifm_active = IFM_ETHER | IFM_100_T4;
1580         else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL)
1581                 ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX;
1582         else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF)
1583                 ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX;
1584         else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL)
1585                 ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX;
1586         else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF)
1587                 ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX;
1588
1589         crit_exit();
1590 }
1591
1592 static int
1593 my_ioctl(struct ifnet * ifp, u_long command, caddr_t data, struct ucred *cr)
1594 {
1595         struct my_softc *sc = ifp->if_softc;
1596         struct ifreq   *ifr = (struct ifreq *) data;
1597         int             error = 0;
1598
1599         crit_enter();
1600         switch (command) {
1601         case SIOCSIFFLAGS:
1602                 if (ifp->if_flags & IFF_UP)
1603                         my_init(sc);
1604                 else if (ifp->if_flags & IFF_RUNNING)
1605                         my_stop(sc);
1606                 error = 0;
1607                 break;
1608         case SIOCADDMULTI:
1609         case SIOCDELMULTI:
1610                 my_setmulti(sc);
1611                 error = 0;
1612                 break;
1613         case SIOCGIFMEDIA:
1614         case SIOCSIFMEDIA:
1615                 error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command);
1616                 break;
1617         default:
1618                 error = ether_ioctl(ifp, command, data);
1619                 break;
1620         }
1621
1622         crit_exit();
1623         return (error);
1624 }
1625
1626 static void
1627 my_watchdog(struct ifnet * ifp)
1628 {
1629         struct my_softc *sc = ifp->if_softc;
1630
1631         crit_enter();
1632
1633         if (sc->my_autoneg) {
1634                 my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1);
1635                 crit_exit();
1636                 return;
1637         }
1638         ifp->if_oerrors++;
1639         printf("my%d: watchdog timeout\n", sc->my_unit);
1640         if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT))
1641                 printf("my%d: no carrier - transceiver cable problem?\n",
1642                     sc->my_unit);
1643         my_stop(sc);
1644         my_reset(sc);
1645         my_init(sc);
1646         if (!ifq_is_empty(&ifp->if_snd))
1647                 my_start(ifp);
1648         crit_exit();
1649 }
1650
1651
1652 /*
1653  * Stop the adapter and free any mbufs allocated to the RX and TX lists.
1654  */
1655 static void
1656 my_stop(struct my_softc * sc)
1657 {
1658         struct ifnet *ifp = &sc->arpcom.ac_if;
1659         int    i;
1660
1661         ifp->if_timer = 0;
1662
1663         MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE));
1664         CSR_WRITE_4(sc, MY_IMR, 0x00000000);
1665         CSR_WRITE_4(sc, MY_TXLBA, 0x00000000);
1666         CSR_WRITE_4(sc, MY_RXLBA, 0x00000000);
1667
1668         /*
1669          * Free data in the RX lists.
1670          */
1671         for (i = 0; i < MY_RX_LIST_CNT; i++) {
1672                 if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) {
1673                         m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf);
1674                         sc->my_cdata.my_rx_chain[i].my_mbuf = NULL;
1675                 }
1676         }
1677         bzero((char *)&sc->my_ldata->my_rx_list,
1678             sizeof(sc->my_ldata->my_rx_list));
1679         /*
1680          * Free the TX list buffers.
1681          */
1682         for (i = 0; i < MY_TX_LIST_CNT; i++) {
1683                 if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) {
1684                         m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf);
1685                         sc->my_cdata.my_tx_chain[i].my_mbuf = NULL;
1686                 }
1687         }
1688         bzero((char *)&sc->my_ldata->my_tx_list,
1689             sizeof(sc->my_ldata->my_tx_list));
1690         ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
1691 }
1692
1693 /*
1694  * Stop all chip I/O so that the kernel's probe routines don't get confused
1695  * by errant DMAs when rebooting.
1696  */
1697 static void
1698 my_shutdown(device_t dev)
1699 {
1700         struct my_softc *sc;
1701
1702         sc = device_get_softc(dev);
1703         my_stop(sc);
1704         return;
1705 }