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