1 /* $NetBSD: lance.c,v 1.34 2005/12/24 20:27:30 perry Exp $ */ 2 3 /*- 4 * Copyright (c) 1997, 1998 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Charles M. Hannum and by Jason R. Thorpe of the Numerical Aerospace 9 * Simulation Facility, NASA Ames Research Center. 10 * 11 * Redistribution and use in source and binary forms, with or without 12 * modification, are permitted provided that the following conditions 13 * are met: 14 * 1. Redistributions of source code must retain the above copyright 15 * notice, this list of conditions and the following disclaimer. 16 * 2. Redistributions in binary form must reproduce the above copyright 17 * notice, this list of conditions and the following disclaimer in the 18 * documentation and/or other materials provided with the distribution. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 22 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 23 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 24 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 30 * POSSIBILITY OF SUCH DAMAGE. 31 */ 32 33 /*- 34 * Copyright (c) 1992, 1993 35 * The Regents of the University of California. All rights reserved. 36 * 37 * This code is derived from software contributed to Berkeley by 38 * Ralph Campbell and Rick Macklem. 39 * 40 * Redistribution and use in source and binary forms, with or without 41 * modification, are permitted provided that the following conditions 42 * are met: 43 * 1. Redistributions of source code must retain the above copyright 44 * notice, this list of conditions and the following disclaimer. 45 * 2. Redistributions in binary form must reproduce the above copyright 46 * notice, this list of conditions and the following disclaimer in the 47 * documentation and/or other materials provided with the distribution. 48 * 3. Neither the name of the University nor the names of its contributors 49 * may be used to endorse or promote products derived from this software 50 * without specific prior written permission. 51 * 52 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 53 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 54 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 55 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 56 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 57 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 58 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 59 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 60 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 61 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 62 * SUCH DAMAGE. 63 * 64 * @(#)if_le.c 8.2 (Berkeley) 11/16/93 65 */ 66 67 #include <sys/cdefs.h> 68 __FBSDID("$FreeBSD$"); 69 70 #include <sys/param.h> 71 #include <sys/bus.h> 72 #include <sys/endian.h> 73 #include <sys/lock.h> 74 #include <sys/kernel.h> 75 #include <sys/malloc.h> 76 #include <sys/mbuf.h> 77 #include <sys/mutex.h> 78 #include <sys/socket.h> 79 #include <sys/sockio.h> 80 81 #include <net/ethernet.h> 82 #include <net/if.h> 83 #include <net/if_var.h> 84 #include <net/if_arp.h> 85 #include <net/if_dl.h> 86 #include <net/if_media.h> 87 #include <net/if_types.h> 88 #include <net/if_vlan_var.h> 89 90 #include <machine/bus.h> 91 92 #include <dev/le/lancereg.h> 93 #include <dev/le/lancevar.h> 94 95 devclass_t le_devclass; 96 97 static void lance_start(struct ifnet *); 98 static void lance_stop(struct lance_softc *); 99 static void lance_init(void *); 100 static void lance_watchdog(void *s); 101 static int lance_mediachange(struct ifnet *); 102 static void lance_mediastatus(struct ifnet *, struct ifmediareq *); 103 static int lance_ioctl(struct ifnet *, u_long, caddr_t); 104 105 int 106 lance_config(struct lance_softc *sc, const char* name, int unit) 107 { 108 struct ifnet *ifp; 109 int i, nbuf; 110 111 if (LE_LOCK_INITIALIZED(sc) == 0) 112 return (ENXIO); 113 114 ifp = sc->sc_ifp = if_alloc(IFT_ETHER); 115 if (ifp == NULL) 116 return (ENOSPC); 117 118 callout_init_mtx(&sc->sc_wdog_ch, &sc->sc_mtx, 0); 119 120 /* Initialize ifnet structure. */ 121 ifp->if_softc = sc; 122 if_initname(ifp, name, unit); 123 ifp->if_start = lance_start; 124 ifp->if_ioctl = lance_ioctl; 125 ifp->if_init = lance_init; 126 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 127 #ifdef LANCE_REVC_BUG 128 ifp->if_flags &= ~IFF_MULTICAST; 129 #endif 130 ifp->if_baudrate = IF_Mbps(10); 131 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 132 ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 133 IFQ_SET_READY(&ifp->if_snd); 134 135 /* Initialize ifmedia structures. */ 136 ifmedia_init(&sc->sc_media, 0, lance_mediachange, lance_mediastatus); 137 if (sc->sc_supmedia != NULL) { 138 for (i = 0; i < sc->sc_nsupmedia; i++) 139 ifmedia_add(&sc->sc_media, sc->sc_supmedia[i], 0, NULL); 140 ifmedia_set(&sc->sc_media, sc->sc_defaultmedia); 141 } else { 142 ifmedia_add(&sc->sc_media, 143 IFM_MAKEWORD(IFM_ETHER, IFM_MANUAL, 0, 0), 0, NULL); 144 ifmedia_set(&sc->sc_media, 145 IFM_MAKEWORD(IFM_ETHER, IFM_MANUAL, 0, 0)); 146 } 147 148 switch (sc->sc_memsize) { 149 case 8192: 150 sc->sc_nrbuf = 4; 151 sc->sc_ntbuf = 1; 152 break; 153 case 16384: 154 sc->sc_nrbuf = 8; 155 sc->sc_ntbuf = 2; 156 break; 157 case 32768: 158 sc->sc_nrbuf = 16; 159 sc->sc_ntbuf = 4; 160 break; 161 case 65536: 162 sc->sc_nrbuf = 32; 163 sc->sc_ntbuf = 8; 164 break; 165 case 131072: 166 sc->sc_nrbuf = 64; 167 sc->sc_ntbuf = 16; 168 break; 169 case 262144: 170 sc->sc_nrbuf = 128; 171 sc->sc_ntbuf = 32; 172 break; 173 default: 174 /* weird memory size; cope with it */ 175 nbuf = sc->sc_memsize / LEBLEN; 176 sc->sc_ntbuf = nbuf / 5; 177 sc->sc_nrbuf = nbuf - sc->sc_ntbuf; 178 } 179 180 if_printf(ifp, "%d receive buffers, %d transmit buffers\n", 181 sc->sc_nrbuf, sc->sc_ntbuf); 182 183 /* Make sure the chip is stopped. */ 184 LE_LOCK(sc); 185 lance_stop(sc); 186 LE_UNLOCK(sc); 187 188 return (0); 189 } 190 191 void 192 lance_attach(struct lance_softc *sc) 193 { 194 struct ifnet *ifp = sc->sc_ifp; 195 196 /* Attach the interface. */ 197 ether_ifattach(ifp, sc->sc_enaddr); 198 199 /* Claim 802.1q capability. */ 200 ifp->if_hdrlen = sizeof(struct ether_vlan_header); 201 ifp->if_capabilities |= IFCAP_VLAN_MTU; 202 ifp->if_capenable |= IFCAP_VLAN_MTU; 203 } 204 205 void 206 lance_detach(struct lance_softc *sc) 207 { 208 struct ifnet *ifp = sc->sc_ifp; 209 210 LE_LOCK(sc); 211 lance_stop(sc); 212 LE_UNLOCK(sc); 213 callout_drain(&sc->sc_wdog_ch); 214 ether_ifdetach(ifp); 215 if_free(ifp); 216 } 217 218 void 219 lance_suspend(struct lance_softc *sc) 220 { 221 222 LE_LOCK(sc); 223 lance_stop(sc); 224 LE_UNLOCK(sc); 225 } 226 227 void 228 lance_resume(struct lance_softc *sc) 229 { 230 231 LE_LOCK(sc); 232 if (sc->sc_ifp->if_flags & IFF_UP) 233 lance_init_locked(sc); 234 LE_UNLOCK(sc); 235 } 236 237 static void 238 lance_start(struct ifnet *ifp) 239 { 240 struct lance_softc *sc = ifp->if_softc; 241 242 LE_LOCK(sc); 243 (*sc->sc_start_locked)(sc); 244 LE_UNLOCK(sc); 245 } 246 247 static void 248 lance_stop(struct lance_softc *sc) 249 { 250 struct ifnet *ifp = sc->sc_ifp; 251 252 LE_LOCK_ASSERT(sc, MA_OWNED); 253 254 /* 255 * Mark the interface down and cancel the watchdog timer. 256 */ 257 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 258 callout_stop(&sc->sc_wdog_ch); 259 sc->sc_wdog_timer = 0; 260 261 (*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_STOP); 262 } 263 264 static void 265 lance_init(void *xsc) 266 { 267 struct lance_softc *sc = (struct lance_softc *)xsc; 268 269 LE_LOCK(sc); 270 lance_init_locked(sc); 271 LE_UNLOCK(sc); 272 } 273 274 /* 275 * Initialization of interface; set up initialization block 276 * and transmit/receive descriptor rings. 277 */ 278 void 279 lance_init_locked(struct lance_softc *sc) 280 { 281 struct ifnet *ifp = sc->sc_ifp; 282 u_long a; 283 int timo; 284 285 LE_LOCK_ASSERT(sc, MA_OWNED); 286 287 (*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_STOP); 288 DELAY(100); 289 290 /* Newer LANCE chips have a reset register. */ 291 if (sc->sc_hwreset) 292 (*sc->sc_hwreset)(sc); 293 294 /* Set the correct byte swapping mode, etc. */ 295 (*sc->sc_wrcsr)(sc, LE_CSR3, sc->sc_conf3); 296 297 /* Set the current media. This may require the chip to be stopped. */ 298 if (sc->sc_mediachange) 299 (void)(*sc->sc_mediachange)(sc); 300 301 /* 302 * Update our private copy of the Ethernet address. 303 * We NEED the copy so we can ensure its alignment! 304 */ 305 memcpy(sc->sc_enaddr, IF_LLADDR(ifp), ETHER_ADDR_LEN); 306 307 /* Set up LANCE init block. */ 308 (*sc->sc_meminit)(sc); 309 310 /* Give LANCE the physical address of its init block. */ 311 a = sc->sc_addr + LE_INITADDR(sc); 312 (*sc->sc_wrcsr)(sc, LE_CSR1, a & 0xffff); 313 (*sc->sc_wrcsr)(sc, LE_CSR2, a >> 16); 314 315 /* Try to initialize the LANCE. */ 316 DELAY(100); 317 (*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_INIT); 318 319 /* Wait for initialization to finish. */ 320 for (timo = 100000; timo; timo--) 321 if ((*sc->sc_rdcsr)(sc, LE_CSR0) & LE_C0_IDON) 322 break; 323 324 if ((*sc->sc_rdcsr)(sc, LE_CSR0) & LE_C0_IDON) { 325 /* Start the LANCE. */ 326 (*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_INEA | LE_C0_STRT); 327 ifp->if_drv_flags |= IFF_DRV_RUNNING; 328 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 329 sc->sc_wdog_timer = 0; 330 callout_reset(&sc->sc_wdog_ch, hz, lance_watchdog, sc); 331 (*sc->sc_start_locked)(sc); 332 } else 333 if_printf(ifp, "controller failed to initialize\n"); 334 335 if (sc->sc_hwinit) 336 (*sc->sc_hwinit)(sc); 337 } 338 339 /* 340 * Routine to copy from mbuf chain to transmit buffer in 341 * network buffer memory. 342 */ 343 int 344 lance_put(struct lance_softc *sc, int boff, struct mbuf *m) 345 { 346 struct mbuf *n; 347 int len, tlen = 0; 348 349 LE_LOCK_ASSERT(sc, MA_OWNED); 350 351 for (; m; m = n) { 352 len = m->m_len; 353 if (len == 0) { 354 n = m_free(m); 355 m = NULL; 356 continue; 357 } 358 (*sc->sc_copytobuf)(sc, mtod(m, caddr_t), boff, len); 359 boff += len; 360 tlen += len; 361 n = m_free(m); 362 m = NULL; 363 } 364 if (tlen < LEMINSIZE) { 365 (*sc->sc_zerobuf)(sc, boff, LEMINSIZE - tlen); 366 tlen = LEMINSIZE; 367 } 368 return (tlen); 369 } 370 371 /* 372 * Pull data off an interface. 373 * Len is length of data, with local net header stripped. 374 * We copy the data into mbufs. When full cluster sized units are present 375 * we copy into clusters. 376 */ 377 struct mbuf * 378 lance_get(struct lance_softc *sc, int boff, int totlen) 379 { 380 struct ifnet *ifp = sc->sc_ifp; 381 struct mbuf *m, *m0, *newm; 382 caddr_t newdata; 383 int len; 384 385 if (totlen <= ETHER_HDR_LEN || totlen > LEBLEN - ETHER_CRC_LEN) { 386 #ifdef LEDEBUG 387 if_printf(ifp, "invalid packet size %d; dropping\n", totlen); 388 #endif 389 return (NULL); 390 } 391 392 MGETHDR(m0, M_NOWAIT, MT_DATA); 393 if (m0 == NULL) 394 return (NULL); 395 m0->m_pkthdr.rcvif = ifp; 396 m0->m_pkthdr.len = totlen; 397 len = MHLEN; 398 m = m0; 399 400 while (totlen > 0) { 401 if (totlen >= MINCLSIZE) { 402 if (!(MCLGET(m, M_NOWAIT))) 403 goto bad; 404 len = MCLBYTES; 405 } 406 407 if (m == m0) { 408 newdata = (caddr_t) 409 ALIGN(m->m_data + ETHER_HDR_LEN) - ETHER_HDR_LEN; 410 len -= newdata - m->m_data; 411 m->m_data = newdata; 412 } 413 414 m->m_len = len = min(totlen, len); 415 (*sc->sc_copyfrombuf)(sc, mtod(m, caddr_t), boff, len); 416 boff += len; 417 418 totlen -= len; 419 if (totlen > 0) { 420 MGET(newm, M_NOWAIT, MT_DATA); 421 if (newm == 0) 422 goto bad; 423 len = MLEN; 424 m = m->m_next = newm; 425 } 426 } 427 428 return (m0); 429 430 bad: 431 m_freem(m0); 432 return (NULL); 433 } 434 435 static void 436 lance_watchdog(void *xsc) 437 { 438 struct lance_softc *sc = (struct lance_softc *)xsc; 439 struct ifnet *ifp = sc->sc_ifp; 440 441 LE_LOCK_ASSERT(sc, MA_OWNED); 442 443 if (sc->sc_wdog_timer == 0 || --sc->sc_wdog_timer != 0) { 444 callout_reset(&sc->sc_wdog_ch, hz, lance_watchdog, sc); 445 return; 446 } 447 448 if_printf(ifp, "device timeout\n"); 449 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 450 lance_init_locked(sc); 451 } 452 453 static int 454 lance_mediachange(struct ifnet *ifp) 455 { 456 struct lance_softc *sc = ifp->if_softc; 457 458 if (sc->sc_mediachange) { 459 /* 460 * For setting the port in LE_CSR15 the PCnet chips must 461 * be powered down or stopped and unlike documented may 462 * not take effect without an initialization. So don't 463 * invoke (*sc_mediachange) directly here but go through 464 * lance_init_locked(). 465 */ 466 LE_LOCK(sc); 467 lance_stop(sc); 468 lance_init_locked(sc); 469 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 470 (*sc->sc_start_locked)(sc); 471 LE_UNLOCK(sc); 472 } 473 return (0); 474 } 475 476 static void 477 lance_mediastatus(struct ifnet *ifp, struct ifmediareq *ifmr) 478 { 479 struct lance_softc *sc = ifp->if_softc; 480 481 LE_LOCK(sc); 482 if (!(ifp->if_flags & IFF_UP)) { 483 LE_UNLOCK(sc); 484 return; 485 } 486 487 ifmr->ifm_status = IFM_AVALID; 488 if (sc->sc_flags & LE_CARRIER) 489 ifmr->ifm_status |= IFM_ACTIVE; 490 491 if (sc->sc_mediastatus) 492 (*sc->sc_mediastatus)(sc, ifmr); 493 LE_UNLOCK(sc); 494 } 495 496 /* 497 * Process an ioctl request. 498 */ 499 static int 500 lance_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 501 { 502 struct lance_softc *sc = ifp->if_softc; 503 struct ifreq *ifr = (struct ifreq *)data; 504 int error = 0; 505 506 switch (cmd) { 507 case SIOCSIFFLAGS: 508 LE_LOCK(sc); 509 if (ifp->if_flags & IFF_PROMISC) { 510 if (!(sc->sc_flags & LE_PROMISC)) { 511 sc->sc_flags |= LE_PROMISC; 512 lance_init_locked(sc); 513 } 514 } else if (sc->sc_flags & LE_PROMISC) { 515 sc->sc_flags &= ~LE_PROMISC; 516 lance_init_locked(sc); 517 } 518 519 if ((ifp->if_flags & IFF_ALLMULTI) && 520 !(sc->sc_flags & LE_ALLMULTI)) { 521 sc->sc_flags |= LE_ALLMULTI; 522 lance_init_locked(sc); 523 } else if (!(ifp->if_flags & IFF_ALLMULTI) && 524 (sc->sc_flags & LE_ALLMULTI)) { 525 sc->sc_flags &= ~LE_ALLMULTI; 526 lance_init_locked(sc); 527 } 528 529 if (!(ifp->if_flags & IFF_UP) && 530 ifp->if_drv_flags & IFF_DRV_RUNNING) { 531 /* 532 * If interface is marked down and it is running, then 533 * stop it. 534 */ 535 lance_stop(sc); 536 } else if (ifp->if_flags & IFF_UP && 537 !(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 538 /* 539 * If interface is marked up and it is stopped, then 540 * start it. 541 */ 542 lance_init_locked(sc); 543 } 544 #ifdef LEDEBUG 545 if (ifp->if_flags & IFF_DEBUG) 546 sc->sc_flags |= LE_DEBUG; 547 else 548 sc->sc_flags &= ~LE_DEBUG; 549 #endif 550 LE_UNLOCK(sc); 551 break; 552 553 case SIOCADDMULTI: 554 case SIOCDELMULTI: 555 /* 556 * Multicast list has changed; set the hardware filter 557 * accordingly. 558 */ 559 LE_LOCK(sc); 560 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 561 lance_init_locked(sc); 562 LE_UNLOCK(sc); 563 break; 564 565 case SIOCGIFMEDIA: 566 case SIOCSIFMEDIA: 567 error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd); 568 break; 569 570 default: 571 error = ether_ioctl(ifp, cmd, data); 572 break; 573 } 574 575 return (error); 576 } 577 578 /* 579 * Set up the logical address filter. 580 */ 581 void 582 lance_setladrf(struct lance_softc *sc, uint16_t *af) 583 { 584 struct ifnet *ifp = sc->sc_ifp; 585 struct ifmultiaddr *ifma; 586 uint32_t crc; 587 588 /* 589 * Set up multicast address filter by passing all multicast addresses 590 * through a crc generator, and then using the high order 6 bits as an 591 * index into the 64 bit logical address filter. The high order bit 592 * selects the word, while the rest of the bits select the bit within 593 * the word. 594 */ 595 596 if (ifp->if_flags & IFF_PROMISC || sc->sc_flags & LE_ALLMULTI) { 597 af[0] = af[1] = af[2] = af[3] = 0xffff; 598 return; 599 } 600 601 af[0] = af[1] = af[2] = af[3] = 0x0000; 602 if_maddr_rlock(ifp); 603 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 604 if (ifma->ifma_addr->sa_family != AF_LINK) 605 continue; 606 607 crc = ether_crc32_le(LLADDR((struct sockaddr_dl *) 608 ifma->ifma_addr), ETHER_ADDR_LEN); 609 610 /* Just want the 6 most significant bits. */ 611 crc >>= 26; 612 613 /* Set the corresponding bit in the filter. */ 614 af[crc >> 4] |= LE_HTOLE16(1 << (crc & 0xf)); 615 } 616 if_maddr_runlock(ifp); 617 } 618 619 /* 620 * Routines for accessing the transmit and receive buffers. 621 * The various CPU and adapter configurations supported by this 622 * driver require three different access methods for buffers 623 * and descriptors: 624 * (1) contig (contiguous data; no padding), 625 * (2) gap2 (two bytes of data followed by two bytes of padding), 626 * (3) gap16 (16 bytes of data followed by 16 bytes of padding). 627 */ 628 629 /* 630 * contig: contiguous data with no padding. 631 * 632 * Buffers may have any alignment. 633 */ 634 635 void 636 lance_copytobuf_contig(struct lance_softc *sc, void *from, int boff, int len) 637 { 638 volatile caddr_t buf = sc->sc_mem; 639 640 /* 641 * Just call memcpy() to do the work. 642 */ 643 memcpy(buf + boff, from, len); 644 } 645 646 void 647 lance_copyfrombuf_contig(struct lance_softc *sc, void *to, int boff, int len) 648 { 649 volatile caddr_t buf = sc->sc_mem; 650 651 /* 652 * Just call memcpy() to do the work. 653 */ 654 memcpy(to, buf + boff, len); 655 } 656 657 void 658 lance_zerobuf_contig(struct lance_softc *sc, int boff, int len) 659 { 660 volatile caddr_t buf = sc->sc_mem; 661 662 /* 663 * Just let memset() do the work 664 */ 665 memset(buf + boff, 0, len); 666 } 667 668 #if 0 669 /* 670 * Examples only; duplicate these and tweak (if necessary) in 671 * machine-specific front-ends. 672 */ 673 674 /* 675 * gap2: two bytes of data followed by two bytes of pad. 676 * 677 * Buffers must be 4-byte aligned. The code doesn't worry about 678 * doing an extra byte. 679 */ 680 681 static void 682 lance_copytobuf_gap2(struct lance_softc *sc, void *fromv, int boff, int len) 683 { 684 volatile caddr_t buf = sc->sc_mem; 685 caddr_t from = fromv; 686 volatile uint16_t *bptr; 687 688 if (boff & 0x1) { 689 /* Handle unaligned first byte. */ 690 bptr = ((volatile uint16_t *)buf) + (boff - 1); 691 *bptr = (*from++ << 8) | (*bptr & 0xff); 692 bptr += 2; 693 len--; 694 } else 695 bptr = ((volatile uint16_t *)buf) + boff; 696 while (len > 1) { 697 *bptr = (from[1] << 8) | (from[0] & 0xff); 698 bptr += 2; 699 from += 2; 700 len -= 2; 701 } 702 if (len == 1) 703 *bptr = (uint16_t)*from; 704 } 705 706 static void 707 lance_copyfrombuf_gap2(struct lance_softc *sc, void *tov, int boff, int len) 708 { 709 volatile caddr_t buf = sc->sc_mem; 710 caddr_t to = tov; 711 volatile uint16_t *bptr; 712 uint16_t tmp; 713 714 if (boff & 0x1) { 715 /* Handle unaligned first byte. */ 716 bptr = ((volatile uint16_t *)buf) + (boff - 1); 717 *to++ = (*bptr >> 8) & 0xff; 718 bptr += 2; 719 len--; 720 } else 721 bptr = ((volatile uint16_t *)buf) + boff; 722 while (len > 1) { 723 tmp = *bptr; 724 *to++ = tmp & 0xff; 725 *to++ = (tmp >> 8) & 0xff; 726 bptr += 2; 727 len -= 2; 728 } 729 if (len == 1) 730 *to = *bptr & 0xff; 731 } 732 733 static void 734 lance_zerobuf_gap2(struct lance_softc *sc, int boff, int len) 735 { 736 volatile caddr_t buf = sc->sc_mem; 737 volatile uint16_t *bptr; 738 739 if ((unsigned)boff & 0x1) { 740 bptr = ((volatile uint16_t *)buf) + (boff - 1); 741 *bptr &= 0xff; 742 bptr += 2; 743 len--; 744 } else 745 bptr = ((volatile uint16_t *)buf) + boff; 746 while (len > 0) { 747 *bptr = 0; 748 bptr += 2; 749 len -= 2; 750 } 751 } 752 753 /* 754 * gap16: 16 bytes of data followed by 16 bytes of pad. 755 * 756 * Buffers must be 32-byte aligned. 757 */ 758 759 static void 760 lance_copytobuf_gap16(struct lance_softc *sc, void *fromv, int boff, int len) 761 { 762 volatile caddr_t buf = sc->sc_mem; 763 caddr_t bptr, from = fromv; 764 int xfer; 765 766 bptr = buf + ((boff << 1) & ~0x1f); 767 boff &= 0xf; 768 xfer = min(len, 16 - boff); 769 while (len > 0) { 770 memcpy(bptr + boff, from, xfer); 771 from += xfer; 772 bptr += 32; 773 boff = 0; 774 len -= xfer; 775 xfer = min(len, 16); 776 } 777 } 778 779 static void 780 lance_copyfrombuf_gap16(struct lance_softc *sc, void *tov, int boff, int len) 781 { 782 volatile caddr_t buf = sc->sc_mem; 783 caddr_t bptr, to = tov; 784 int xfer; 785 786 bptr = buf + ((boff << 1) & ~0x1f); 787 boff &= 0xf; 788 xfer = min(len, 16 - boff); 789 while (len > 0) { 790 memcpy(to, bptr + boff, xfer); 791 to += xfer; 792 bptr += 32; 793 boff = 0; 794 len -= xfer; 795 xfer = min(len, 16); 796 } 797 } 798 799 static void 800 lance_zerobuf_gap16(struct lance_softc *sc, int boff, int len) 801 { 802 volatile caddr_t buf = sc->sc_mem; 803 caddr_t bptr; 804 int xfer; 805 806 bptr = buf + ((boff << 1) & ~0x1f); 807 boff &= 0xf; 808 xfer = min(len, 16 - boff); 809 while (len > 0) { 810 memset(bptr + boff, 0, xfer); 811 bptr += 32; 812 boff = 0; 813 len -= xfer; 814 xfer = min(len, 16); 815 } 816 } 817 #endif /* Example only */ 818