if_le.c revision 1.35 1 1.35 aymeric /* $NetBSD: if_le.c,v 1.35 2002/01/26 13:40:56 aymeric Exp $ */
2 1.7 cgd
3 1.15 chopps /*-
4 1.31 mycroft * Copyright (c) 1997, 1998 The NetBSD Foundation, Inc.
5 1.27 thorpej * All rights reserved.
6 1.27 thorpej *
7 1.27 thorpej * This code is derived from software contributed to The NetBSD Foundation
8 1.31 mycroft * by Charles M. Hannum and by Jason R. Thorpe of the Numerical Aerospace
9 1.31 mycroft * Simulation Facility, NASA Ames Research Center.
10 1.27 thorpej *
11 1.27 thorpej * Redistribution and use in source and binary forms, with or without
12 1.27 thorpej * modification, are permitted provided that the following conditions
13 1.27 thorpej * are met:
14 1.27 thorpej * 1. Redistributions of source code must retain the above copyright
15 1.27 thorpej * notice, this list of conditions and the following disclaimer.
16 1.27 thorpej * 2. Redistributions in binary form must reproduce the above copyright
17 1.27 thorpej * notice, this list of conditions and the following disclaimer in the
18 1.27 thorpej * documentation and/or other materials provided with the distribution.
19 1.27 thorpej * 3. All advertising materials mentioning features or use of this software
20 1.27 thorpej * must display the following acknowledgement:
21 1.27 thorpej * This product includes software developed by the NetBSD
22 1.27 thorpej * Foundation, Inc. and its contributors.
23 1.27 thorpej * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.27 thorpej * contributors may be used to endorse or promote products derived
25 1.27 thorpej * from this software without specific prior written permission.
26 1.27 thorpej *
27 1.27 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.27 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.27 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.27 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.27 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.27 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.27 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.27 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.27 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.27 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.27 thorpej * POSSIBILITY OF SUCH DAMAGE.
38 1.27 thorpej */
39 1.27 thorpej
40 1.27 thorpej /*-
41 1.27 thorpej * Copyright (c) 1997 Bernd Ernesti. All rights reserved.
42 1.15 chopps * Copyright (c) 1992, 1993
43 1.15 chopps * The Regents of the University of California. All rights reserved.
44 1.15 chopps *
45 1.15 chopps * This code is derived from software contributed to Berkeley by
46 1.15 chopps * Ralph Campbell and Rick Macklem.
47 1.1 mw *
48 1.1 mw * Redistribution and use in source and binary forms, with or without
49 1.1 mw * modification, are permitted provided that the following conditions
50 1.1 mw * are met:
51 1.1 mw * 1. Redistributions of source code must retain the above copyright
52 1.1 mw * notice, this list of conditions and the following disclaimer.
53 1.1 mw * 2. Redistributions in binary form must reproduce the above copyright
54 1.1 mw * notice, this list of conditions and the following disclaimer in the
55 1.1 mw * documentation and/or other materials provided with the distribution.
56 1.1 mw * 3. All advertising materials mentioning features or use of this software
57 1.1 mw * must display the following acknowledgement:
58 1.26 veego * This product includes software developed for the NetBSD Project
59 1.27 thorpej * by Bernd Ernesti.
60 1.1 mw * This product includes software developed by the University of
61 1.1 mw * California, Berkeley and its contributors.
62 1.1 mw * 4. Neither the name of the University nor the names of its contributors
63 1.1 mw * may be used to endorse or promote products derived from this software
64 1.1 mw * without specific prior written permission.
65 1.1 mw *
66 1.1 mw * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
67 1.1 mw * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
68 1.1 mw * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
69 1.1 mw * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
70 1.1 mw * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
71 1.1 mw * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
72 1.1 mw * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
73 1.1 mw * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
74 1.1 mw * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
75 1.1 mw * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
76 1.1 mw * SUCH DAMAGE.
77 1.1 mw *
78 1.15 chopps * @(#)if_le.c 8.2 (Berkeley) 11/16/93
79 1.1 mw */
80 1.1 mw
81 1.29 jonathan #include "opt_inet.h"
82 1.1 mw #include "bpfilter.h"
83 1.1 mw
84 1.5 chopps #include <sys/param.h>
85 1.5 chopps #include <sys/systm.h>
86 1.5 chopps #include <sys/mbuf.h>
87 1.15 chopps #include <sys/syslog.h>
88 1.5 chopps #include <sys/socket.h>
89 1.6 chopps #include <sys/device.h>
90 1.5 chopps
91 1.5 chopps #include <net/if.h>
92 1.23 is #include <net/if_ether.h>
93 1.24 thorpej #include <net/if_media.h>
94 1.1 mw
95 1.1 mw #ifdef INET
96 1.5 chopps #include <netinet/in.h>
97 1.23 is #include <netinet/if_inarp.h>
98 1.1 mw #endif
99 1.1 mw
100 1.5 chopps #include <machine/cpu.h>
101 1.5 chopps #include <machine/mtpr.h>
102 1.15 chopps
103 1.6 chopps #include <amiga/amiga/device.h>
104 1.10 chopps #include <amiga/amiga/isr.h>
105 1.21 thorpej
106 1.30 drochner #include <dev/ic/lancereg.h>
107 1.30 drochner #include <dev/ic/lancevar.h>
108 1.21 thorpej #include <dev/ic/am7990reg.h>
109 1.21 thorpej #include <dev/ic/am7990var.h>
110 1.21 thorpej
111 1.9 chopps #include <amiga/dev/zbusvar.h>
112 1.15 chopps #include <amiga/dev/if_levar.h>
113 1.6 chopps
114 1.35 aymeric int le_zbus_match(struct device *, struct cfdata *, void *);
115 1.35 aymeric void le_zbus_attach(struct device *, struct device *, void *);
116 1.6 chopps
117 1.17 thorpej struct cfattach le_zbus_ca = {
118 1.17 thorpej sizeof(struct le_softc), le_zbus_match, le_zbus_attach
119 1.17 thorpej };
120 1.17 thorpej
121 1.33 mrg #if defined(_KERNEL_OPT)
122 1.30 drochner #include "opt_ddb.h"
123 1.30 drochner #endif
124 1.30 drochner
125 1.30 drochner #ifdef DDB
126 1.30 drochner #define integrate
127 1.30 drochner #define hide
128 1.30 drochner #else
129 1.30 drochner #define integrate static __inline
130 1.30 drochner #define hide static
131 1.30 drochner #endif
132 1.30 drochner
133 1.35 aymeric hide void lepcnet_reset(struct lance_softc *);
134 1.35 aymeric hide void lewrcsr(struct lance_softc *, u_int16_t, u_int16_t);
135 1.35 aymeric hide u_int16_t lerdcsr(struct lance_softc *, u_int16_t);
136 1.35 aymeric
137 1.35 aymeric hide u_int16_t ariadne_swapreg(u_int16_t);
138 1.35 aymeric hide void ariadne_wrcsr(struct lance_softc *, u_int16_t, u_int16_t);
139 1.35 aymeric hide u_int16_t ariadne_rdcsr(struct lance_softc *, u_int16_t);
140 1.35 aymeric hide void ariadne_wribcr(struct lance_softc *, u_int16_t, u_int16_t);
141 1.35 aymeric integrate void ariadne_copytodesc_word(struct lance_softc *, void *, int, int);
142 1.35 aymeric integrate void ariadne_copyfromdesc_word(struct lance_softc *, void *,
143 1.35 aymeric int, int);
144 1.35 aymeric integrate void ariadne_copytobuf_word(struct lance_softc *, void *, int, int);
145 1.35 aymeric integrate void ariadne_copyfrombuf_word(struct lance_softc *, void *, int, int);
146 1.35 aymeric integrate void ariadne_zerobuf_word(struct lance_softc *, int, int);
147 1.35 aymeric void ariadne_autoselect(struct lance_softc *, int);
148 1.35 aymeric int ariadne_mediachange(struct lance_softc *);
149 1.35 aymeric void ariadne_hwinit(struct lance_softc *);
150 1.26 veego
151 1.35 aymeric /*
152 1.26 veego * Media types supported by the Ariadne.
153 1.26 veego */
154 1.26 veego int lemedia_ariadne[] = {
155 1.26 veego IFM_ETHER | IFM_10_T,
156 1.26 veego IFM_ETHER | IFM_10_2,
157 1.26 veego IFM_ETHER | IFM_AUTO,
158 1.26 veego };
159 1.26 veego #define NLEMEDIA_ARIADNE (sizeof(lemedia_ariadne) / sizeof(lemedia_ariadne[0]))
160 1.26 veego
161 1.26 veego
162 1.26 veego hide u_int16_t
163 1.35 aymeric ariadne_swapreg(u_int16_t val)
164 1.26 veego {
165 1.26 veego
166 1.26 veego return (((val & 0xff) << 8 ) | (( val >> 8) & 0xff));
167 1.26 veego }
168 1.26 veego
169 1.26 veego hide void
170 1.35 aymeric ariadne_wrcsr(struct lance_softc *sc, u_int16_t port, u_int16_t val)
171 1.26 veego {
172 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
173 1.26 veego
174 1.26 veego ler1->ler1_rap = ariadne_swapreg(port);
175 1.26 veego ler1->ler1_rdp = ariadne_swapreg(val);
176 1.26 veego }
177 1.26 veego
178 1.26 veego hide u_int16_t
179 1.35 aymeric ariadne_rdcsr(struct lance_softc *sc, u_int16_t port)
180 1.26 veego {
181 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
182 1.26 veego u_int16_t val;
183 1.26 veego
184 1.26 veego ler1->ler1_rap = ariadne_swapreg(port);
185 1.26 veego val = ariadne_swapreg(ler1->ler1_rdp);
186 1.26 veego return (val);
187 1.26 veego }
188 1.26 veego
189 1.26 veego hide void
190 1.35 aymeric ariadne_wribcr(struct lance_softc *sc, u_int16_t port, u_int16_t val)
191 1.26 veego {
192 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
193 1.26 veego
194 1.26 veego ler1->ler1_rap = ariadne_swapreg(port);
195 1.26 veego ler1->ler1_idp = ariadne_swapreg(val);
196 1.26 veego }
197 1.26 veego
198 1.21 thorpej hide void
199 1.35 aymeric lewrcsr(struct lance_softc *sc, u_int16_t port, u_int16_t val)
200 1.15 chopps {
201 1.21 thorpej struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
202 1.6 chopps
203 1.15 chopps ler1->ler1_rap = port;
204 1.15 chopps ler1->ler1_rdp = val;
205 1.15 chopps }
206 1.6 chopps
207 1.21 thorpej hide u_int16_t
208 1.35 aymeric lerdcsr(struct lance_softc *sc, u_int16_t port)
209 1.6 chopps {
210 1.21 thorpej struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
211 1.15 chopps u_int16_t val;
212 1.6 chopps
213 1.15 chopps ler1->ler1_rap = port;
214 1.15 chopps val = ler1->ler1_rdp;
215 1.15 chopps return (val);
216 1.15 chopps }
217 1.6 chopps
218 1.26 veego hide void
219 1.35 aymeric lepcnet_reset(struct lance_softc *sc)
220 1.26 veego {
221 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
222 1.26 veego volatile int dummy;
223 1.26 veego
224 1.26 veego dummy = ler1->ler1_reset; /* Reset PCNet-ISA */
225 1.26 veego }
226 1.26 veego
227 1.26 veego void
228 1.35 aymeric ariadne_autoselect(struct lance_softc *sc, int on)
229 1.26 veego {
230 1.26 veego
231 1.26 veego /*
232 1.26 veego * on = 0: autoselect disabled
233 1.26 veego * on = 1: autoselect enabled
234 1.26 veego */
235 1.26 veego if (on == 0)
236 1.26 veego ariadne_wribcr(sc, LE_BCR_MC, 0x0000);
237 1.26 veego else
238 1.26 veego ariadne_wribcr(sc, LE_BCR_MC, LE_MC_ASEL);
239 1.26 veego }
240 1.26 veego
241 1.26 veego int
242 1.35 aymeric ariadne_mediachange(struct lance_softc *sc)
243 1.26 veego {
244 1.26 veego struct ifmedia *ifm = &sc->sc_media;
245 1.26 veego
246 1.26 veego if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
247 1.26 veego return (EINVAL);
248 1.26 veego
249 1.26 veego /*
250 1.26 veego * Switch to the selected media. If autoselect is
251 1.26 veego * set, switch it on otherwise disable it. We'll
252 1.26 veego * switch to the other media when we detect loss of
253 1.26 veego * carrier.
254 1.26 veego */
255 1.26 veego switch (IFM_SUBTYPE(ifm->ifm_media)) {
256 1.26 veego case IFM_10_T:
257 1.26 veego sc->sc_initmodemedia = 1;
258 1.34 jdolecek lance_init(&sc->sc_ethercom.ec_if);
259 1.26 veego break;
260 1.26 veego
261 1.26 veego case IFM_10_2:
262 1.26 veego sc->sc_initmodemedia = 0;
263 1.34 jdolecek lance_init(&sc->sc_ethercom.ec_if);
264 1.26 veego break;
265 1.26 veego
266 1.26 veego case IFM_AUTO:
267 1.26 veego sc->sc_initmodemedia = 2;
268 1.26 veego ariadne_hwinit(sc);
269 1.26 veego break;
270 1.26 veego
271 1.26 veego default:
272 1.26 veego return (EINVAL);
273 1.26 veego }
274 1.26 veego
275 1.26 veego return (0);
276 1.26 veego }
277 1.26 veego
278 1.26 veego void
279 1.35 aymeric ariadne_hwinit(struct lance_softc *sc)
280 1.26 veego {
281 1.26 veego
282 1.26 veego /*
283 1.26 veego * Re-program LEDs to match meaning used on the Ariadne board.
284 1.26 veego */
285 1.26 veego ariadne_wribcr(sc, LE_BCR_LED1, 0x0090);
286 1.26 veego ariadne_wribcr(sc, LE_BCR_LED2, 0x0081);
287 1.26 veego ariadne_wribcr(sc, LE_BCR_LED3, 0x0084);
288 1.26 veego
289 1.26 veego /*
290 1.35 aymeric * Enabel/Disable auto selection
291 1.26 veego */
292 1.26 veego if (sc->sc_initmodemedia == 2)
293 1.26 veego ariadne_autoselect(sc, 1);
294 1.26 veego else
295 1.26 veego ariadne_autoselect(sc, 0);
296 1.26 veego }
297 1.26 veego
298 1.15 chopps int
299 1.35 aymeric le_zbus_match(struct device *parent, struct cfdata *cfp, void *aux)
300 1.15 chopps {
301 1.15 chopps struct zbus_args *zap = aux;
302 1.6 chopps
303 1.6 chopps /* Commodore ethernet card */
304 1.15 chopps if (zap->manid == 514 && zap->prodid == 112)
305 1.15 chopps return (1);
306 1.6 chopps
307 1.6 chopps /* Ameristar ethernet card */
308 1.15 chopps if (zap->manid == 1053 && zap->prodid == 1)
309 1.15 chopps return (1);
310 1.6 chopps
311 1.26 veego /* Ariadne ethernet card */
312 1.26 veego if (zap->manid == 2167 && zap->prodid == 201)
313 1.26 veego return (1);
314 1.26 veego
315 1.6 chopps return (0);
316 1.6 chopps }
317 1.1 mw
318 1.6 chopps void
319 1.35 aymeric le_zbus_attach(struct device *parent, struct device *self, void *aux)
320 1.1 mw {
321 1.21 thorpej struct le_softc *lesc = (struct le_softc *)self;
322 1.30 drochner struct lance_softc *sc = &lesc->sc_am7990.lsc;
323 1.15 chopps struct zbus_args *zap = aux;
324 1.15 chopps u_long ser;
325 1.1 mw
326 1.26 veego /* This has no effect on PCnet-ISA LANCE chips */
327 1.15 chopps sc->sc_conf3 = LE_C3_BSWP;
328 1.6 chopps
329 1.6 chopps /*
330 1.6 chopps * Manufacturer decides the 3 first bytes, i.e. ethernet vendor ID.
331 1.6 chopps */
332 1.15 chopps switch (zap->manid) {
333 1.26 veego case 514:
334 1.15 chopps /* Commodore */
335 1.15 chopps sc->sc_memsize = 32768;
336 1.23 is sc->sc_enaddr[0] = 0x00;
337 1.23 is sc->sc_enaddr[1] = 0x80;
338 1.23 is sc->sc_enaddr[2] = 0x10;
339 1.26 veego lesc->sc_r1 = (struct lereg1 *)(0x4000 + (int)zap->va);
340 1.26 veego sc->sc_mem = (void *)(0x8000 + (int)zap->va);
341 1.26 veego sc->sc_addr = 0x8000;
342 1.30 drochner sc->sc_copytodesc = lance_copytobuf_contig;
343 1.30 drochner sc->sc_copyfromdesc = lance_copyfrombuf_contig;
344 1.30 drochner sc->sc_copytobuf = lance_copytobuf_contig;
345 1.30 drochner sc->sc_copyfrombuf = lance_copyfrombuf_contig;
346 1.30 drochner sc->sc_zerobuf = lance_zerobuf_contig;
347 1.26 veego sc->sc_rdcsr = lerdcsr;
348 1.26 veego sc->sc_wrcsr = lewrcsr;
349 1.26 veego sc->sc_hwreset = NULL;
350 1.26 veego sc->sc_hwinit = NULL;
351 1.15 chopps break;
352 1.6 chopps
353 1.26 veego case 1053:
354 1.15 chopps /* Ameristar */
355 1.15 chopps sc->sc_memsize = 32768;
356 1.23 is sc->sc_enaddr[0] = 0x00;
357 1.23 is sc->sc_enaddr[1] = 0x00;
358 1.23 is sc->sc_enaddr[2] = 0x9f;
359 1.26 veego lesc->sc_r1 = (struct lereg1 *)(0x4000 + (int)zap->va);
360 1.26 veego sc->sc_mem = (void *)(0x8000 + (int)zap->va);
361 1.26 veego sc->sc_addr = 0x8000;
362 1.30 drochner sc->sc_copytodesc = lance_copytobuf_contig;
363 1.30 drochner sc->sc_copyfromdesc = lance_copyfrombuf_contig;
364 1.30 drochner sc->sc_copytobuf = lance_copytobuf_contig;
365 1.30 drochner sc->sc_copyfrombuf = lance_copyfrombuf_contig;
366 1.30 drochner sc->sc_zerobuf = lance_zerobuf_contig;
367 1.26 veego sc->sc_rdcsr = lerdcsr;
368 1.26 veego sc->sc_wrcsr = lewrcsr;
369 1.26 veego sc->sc_hwreset = NULL;
370 1.26 veego sc->sc_hwinit = NULL;
371 1.15 chopps break;
372 1.6 chopps
373 1.26 veego case 2167:
374 1.26 veego /* Village Tronic */
375 1.26 veego sc->sc_memsize = 32768;
376 1.26 veego sc->sc_enaddr[0] = 0x00;
377 1.26 veego sc->sc_enaddr[1] = 0x60;
378 1.26 veego sc->sc_enaddr[2] = 0x30;
379 1.26 veego lesc->sc_r1 = (struct lereg1 *)(0x0370 + (int)zap->va);
380 1.26 veego sc->sc_mem = (void *)(0x8000 + (int)zap->va);
381 1.26 veego sc->sc_addr = 0x8000;
382 1.26 veego sc->sc_copytodesc = ariadne_copytodesc_word;
383 1.26 veego sc->sc_copyfromdesc = ariadne_copyfromdesc_word;
384 1.26 veego sc->sc_copytobuf = ariadne_copytobuf_word;
385 1.26 veego sc->sc_copyfrombuf = ariadne_copyfrombuf_word;
386 1.26 veego sc->sc_zerobuf = ariadne_zerobuf_word;
387 1.26 veego sc->sc_rdcsr = ariadne_rdcsr;
388 1.26 veego sc->sc_wrcsr = ariadne_wrcsr;
389 1.26 veego sc->sc_hwreset = lepcnet_reset;
390 1.26 veego sc->sc_hwinit = ariadne_hwinit;
391 1.26 veego sc->sc_mediachange = ariadne_mediachange;
392 1.26 veego sc->sc_supmedia = lemedia_ariadne;
393 1.26 veego sc->sc_nsupmedia = NLEMEDIA_ARIADNE;
394 1.26 veego sc->sc_defaultmedia = IFM_ETHER | IFM_AUTO;
395 1.26 veego sc->sc_initmodemedia = 2;
396 1.26 veego break;
397 1.26 veego
398 1.26 veego default:
399 1.21 thorpej panic("le_zbus_attach: bad manid");
400 1.1 mw }
401 1.6 chopps
402 1.6 chopps /*
403 1.15 chopps * Serial number for board is used as host ID.
404 1.6 chopps */
405 1.15 chopps ser = (u_long)zap->serno;
406 1.23 is sc->sc_enaddr[3] = (ser >> 16) & 0xff;
407 1.23 is sc->sc_enaddr[4] = (ser >> 8) & 0xff;
408 1.23 is sc->sc_enaddr[5] = (ser ) & 0xff;
409 1.1 mw
410 1.30 drochner am7990_config(&lesc->sc_am7990);
411 1.6 chopps
412 1.21 thorpej lesc->sc_isr.isr_intr = am7990_intr;
413 1.21 thorpej lesc->sc_isr.isr_arg = sc;
414 1.21 thorpej lesc->sc_isr.isr_ipl = 2;
415 1.21 thorpej add_isr(&lesc->sc_isr);
416 1.26 veego }
417 1.26 veego
418 1.26 veego
419 1.26 veego integrate void
420 1.35 aymeric ariadne_copytodesc_word(struct lance_softc *sc, void *from, int boff, int len)
421 1.26 veego {
422 1.26 veego u_short *b1 = from;
423 1.32 tron volatile u_short *b2 = (u_short *)((u_char *)sc->sc_mem + boff);
424 1.26 veego
425 1.26 veego for (len >>= 1; len > 0; len--)
426 1.26 veego *b2++ = ariadne_swapreg(*b1++);
427 1.26 veego }
428 1.26 veego
429 1.26 veego integrate void
430 1.35 aymeric ariadne_copyfromdesc_word(struct lance_softc *sc, void *to, int boff, int len)
431 1.26 veego {
432 1.32 tron volatile u_short *b1 = (u_short *)((u_char *)sc->sc_mem + boff);
433 1.26 veego u_short *b2 = to;
434 1.26 veego
435 1.26 veego for (len >>= 1; len > 0; len--)
436 1.26 veego *b2++ = ariadne_swapreg(*b1++);
437 1.26 veego }
438 1.26 veego
439 1.26 veego #define isodd(n) ((n) & 1)
440 1.26 veego
441 1.26 veego integrate void
442 1.35 aymeric ariadne_copytobuf_word(struct lance_softc *sc, void *from, int boff, int len)
443 1.26 veego {
444 1.26 veego u_char *a1 = from;
445 1.32 tron volatile u_char *a2 = (u_char *)sc->sc_mem + boff;
446 1.26 veego u_short *b1;
447 1.26 veego volatile u_short *b2;
448 1.26 veego int i;
449 1.26 veego
450 1.26 veego if (len > 0 && isodd(boff)) {
451 1.28 is /* adjust source pointer */
452 1.26 veego b1 = (u_short *)(a1 + 1);
453 1.28 is /* compute aligned destination pointer */
454 1.26 veego b2 = (u_short *)(a2 + 1);
455 1.28 is /* copy first unaligned byte to buf */
456 1.28 is b2[-1] = (b2[-1] & 0xff00) | *a1;
457 1.26 veego --len;
458 1.26 veego } else {
459 1.28 is /* destination is aligned or length is zero */
460 1.26 veego b1 = (u_short *)a1;
461 1.26 veego b2 = (u_short *)a2;
462 1.26 veego }
463 1.26 veego
464 1.28 is /* copy full words with aligned destination */
465 1.26 veego for (i = len >> 1; i > 0; i--)
466 1.26 veego *b2++ = *b1++;
467 1.26 veego
468 1.28 is /* copy remaining byte */
469 1.26 veego if (isodd(len))
470 1.28 is *b2 = (*b2 & 0x00ff) | (*(u_char *)b1) << 8;
471 1.26 veego }
472 1.26 veego
473 1.26 veego integrate void
474 1.35 aymeric ariadne_copyfrombuf_word(struct lance_softc *sc, void *to, int boff, int len)
475 1.26 veego {
476 1.32 tron volatile u_char *a1 = (u_char *)sc->sc_mem + boff;
477 1.26 veego u_char *a2 = to;
478 1.26 veego volatile u_short *b1;
479 1.26 veego u_short *b2;
480 1.26 veego int i;
481 1.26 veego
482 1.26 veego if (len > 0 && isodd(boff)) {
483 1.28 is /* compute aligned source pointer */
484 1.28 is b1 = (u_short *)(a1 + 1);
485 1.28 is /* adjust destination pointer (possibly unaligned) */
486 1.28 is b2 = (u_short *)(a2 + 1);
487 1.28 is /* copy first unaligned byte from buf */
488 1.28 is *a2 = b1[-1];
489 1.26 veego --len;
490 1.26 veego } else {
491 1.28 is /* source is aligned or length is zero */
492 1.26 veego b1 = (u_short *)a1;
493 1.26 veego b2 = (u_short *)a2;
494 1.26 veego }
495 1.26 veego
496 1.28 is /* copy full words with aligned source */
497 1.26 veego for (i = len >> 1; i > 0; i--)
498 1.26 veego *b2++ = *b1++;
499 1.26 veego
500 1.28 is /* copy remaining byte */
501 1.26 veego if (isodd(len))
502 1.28 is *(u_char *)b2 = *b1 >> 8;
503 1.26 veego }
504 1.26 veego
505 1.26 veego integrate void
506 1.35 aymeric ariadne_zerobuf_word(struct lance_softc *sc, int boff, int len)
507 1.26 veego {
508 1.32 tron volatile u_char *a1 = (u_char *)sc->sc_mem + boff;
509 1.26 veego volatile u_short *b1;
510 1.26 veego int i;
511 1.26 veego
512 1.26 veego if (len > 0 && isodd(boff)) {
513 1.26 veego b1 = (u_short *)(a1 + 1);
514 1.26 veego b1[-1] &= 0xff00;
515 1.26 veego --len;
516 1.26 veego } else {
517 1.26 veego b1 = (u_short *)a1;
518 1.26 veego }
519 1.35 aymeric
520 1.26 veego for (i = len >> 1; i > 0; i--)
521 1.26 veego *b1++ = 0;
522 1.26 veego
523 1.26 veego if (isodd(len))
524 1.26 veego *b1 &= 0x00ff;
525 1.1 mw }
526