network code: Convert if_multiaddrs from LIST to TAILQ.
[dragonfly.git] / sys / dev / netif / lnc / lance.c
CommitLineData
cfa96c6c
SZ
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 $ */
9db4b353 3/* $DragonFly: src/sys/dev/netif/lnc/lance.c,v 1.7 2008/05/14 11:59:20 sephe Exp $ */
cfa96c6c
SZ
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
cfa96c6c
SZ
94#include <dev/netif/lnc/lancereg.h>
95#include <dev/netif/lnc/lancevar.h>
96
97devclass_t le_devclass;
98
99static void lance_start(struct ifnet *);
100static void lance_init(void *);
101static void lance_watchdog(struct ifnet *);
102static int lance_mediachange(struct ifnet *);
103static void lance_mediastatus(struct ifnet *, struct ifmediareq *);
104static int lance_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
105
106int
107lance_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
183void
184lance_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
197void
198lance_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
206void
207lance_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
216static void
217lance_start(struct ifnet *ifp)
218{
219 struct lance_softc *sc = ifp->if_softc;
220
221 (*sc->sc_start_locked)(sc);
222}
223
224void
225lance_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
238static void
239lance_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 */
252void
253lance_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)
7b9f668c 294 (*sc->sc_mediachange)(sc);
cfa96c6c
SZ
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;
9db4b353 302 if_devstart(ifp);
cfa96c6c
SZ
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 */
314int
315lance_put(struct lance_softc *sc, int boff, struct mbuf *m)
316{
b8f5d60d
JH
317 int tlen = 0;
318
319 for (; m; m = m_free(m)) {
320 if (m->m_len == 0)
cfa96c6c 321 continue;
b8f5d60d
JH
322 (*sc->sc_copytobuf)(sc, mtod(m, caddr_t), boff, m->m_len);
323 boff += m->m_len;
324 tlen += m->m_len;
cfa96c6c
SZ
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 */
339struct mbuf *
340lance_get(struct lance_softc *sc, int boff, int totlen)
341{
342 struct ifnet *ifp = sc->ifp;
d35a95a4 343 struct mbuf *m0 = NULL, *newm;
5432735e 344 struct mbuf *m = NULL;
d35a95a4 345 int mlen;
cfa96c6c
SZ
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
d35a95a4
JH
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;
cfa96c6c 359
d35a95a4
JH
360 if (m0 == NULL) {
361 caddr_t newdata;
362
363 m0 = newm;
364 m0->m_pkthdr.rcvif = ifp;
365 m0->m_pkthdr.len = totlen;
cfa96c6c 366 newdata = (caddr_t)
d35a95a4
JH
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;
cfa96c6c 372 }
d35a95a4 373 m = newm;
cfa96c6c 374
d35a95a4
JH
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);
cfa96c6c
SZ
380
381 return (m0);
382
d35a95a4 383bad:
cfa96c6c
SZ
384 m_freem(m0);
385 return (NULL);
386}
387
388static void
389lance_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
398static int
399lance_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
411static void
412lance_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 */
431static int
432lance_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 */
513void
514lance_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
441d34b2 535 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
cfa96c6c
SZ
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
566void
567lance_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
577void
578lance_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
588void
589lance_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
612static void
613lance_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
637static void
638lance_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
664static void
665lance_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
690static void
691lance_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
710static void
711lance_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
730static void
731lance_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 */