if_le.c revision 1.27 1 1.27 thorpej /* $NetBSD: if_le.c,v 1.27 1997/10/04 09:43:10 thorpej Exp $ */
2 1.7 cgd
3 1.15 chopps /*-
4 1.27 thorpej * Copyright (c) 1997 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.27 thorpej * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.27 thorpej * 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) 1995 Charles M. Hannum. All rights reserved.
43 1.15 chopps * Copyright (c) 1992, 1993
44 1.15 chopps * The Regents of the University of California. All rights reserved.
45 1.15 chopps *
46 1.15 chopps * This code is derived from software contributed to Berkeley by
47 1.15 chopps * Ralph Campbell and Rick Macklem.
48 1.1 mw *
49 1.1 mw * Redistribution and use in source and binary forms, with or without
50 1.1 mw * modification, are permitted provided that the following conditions
51 1.1 mw * are met:
52 1.1 mw * 1. Redistributions of source code must retain the above copyright
53 1.1 mw * notice, this list of conditions and the following disclaimer.
54 1.1 mw * 2. Redistributions in binary form must reproduce the above copyright
55 1.1 mw * notice, this list of conditions and the following disclaimer in the
56 1.1 mw * documentation and/or other materials provided with the distribution.
57 1.1 mw * 3. All advertising materials mentioning features or use of this software
58 1.1 mw * must display the following acknowledgement:
59 1.26 veego * This product includes software developed for the NetBSD Project
60 1.27 thorpej * by Bernd Ernesti.
61 1.1 mw * This product includes software developed by the University of
62 1.1 mw * California, Berkeley and its contributors.
63 1.1 mw * 4. Neither the name of the University nor the names of its contributors
64 1.1 mw * may be used to endorse or promote products derived from this software
65 1.1 mw * without specific prior written permission.
66 1.1 mw *
67 1.1 mw * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
68 1.1 mw * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
69 1.1 mw * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
70 1.1 mw * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
71 1.1 mw * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
72 1.1 mw * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
73 1.1 mw * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
74 1.1 mw * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
75 1.1 mw * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
76 1.1 mw * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
77 1.1 mw * SUCH DAMAGE.
78 1.1 mw *
79 1.15 chopps * @(#)if_le.c 8.2 (Berkeley) 11/16/93
80 1.1 mw */
81 1.1 mw
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.21 thorpej #include <dev/ic/am7990reg.h>
107 1.21 thorpej #include <dev/ic/am7990var.h>
108 1.21 thorpej
109 1.9 chopps #include <amiga/dev/zbusvar.h>
110 1.15 chopps #include <amiga/dev/if_levar.h>
111 1.6 chopps
112 1.22 veego int le_zbus_match __P((struct device *, struct cfdata *, void *));
113 1.17 thorpej void le_zbus_attach __P((struct device *, struct device *, void *));
114 1.6 chopps
115 1.17 thorpej struct cfattach le_zbus_ca = {
116 1.17 thorpej sizeof(struct le_softc), le_zbus_match, le_zbus_attach
117 1.17 thorpej };
118 1.17 thorpej
119 1.26 veego hide void lepcnet_reset __P((struct am7990_softc *));
120 1.21 thorpej hide void lewrcsr __P((struct am7990_softc *, u_int16_t, u_int16_t));
121 1.21 thorpej hide u_int16_t lerdcsr __P((struct am7990_softc *, u_int16_t));
122 1.6 chopps
123 1.26 veego hide u_int16_t ariadne_swapreg __P((u_int16_t));
124 1.26 veego hide void ariadne_wrcsr __P((struct am7990_softc *, u_int16_t, u_int16_t));
125 1.26 veego hide u_int16_t ariadne_rdcsr __P((struct am7990_softc *, u_int16_t));
126 1.26 veego hide void ariadne_wribcr __P((struct am7990_softc *, u_int16_t, u_int16_t));
127 1.26 veego integrate void ariadne_copytodesc_word __P((struct am7990_softc *, void *, int, int));
128 1.26 veego integrate void ariadne_copyfromdesc_word __P((struct am7990_softc *, void *, int, int));
129 1.26 veego integrate void ariadne_copytobuf_word __P((struct am7990_softc *, void *, int, int));
130 1.26 veego integrate void ariadne_copyfrombuf_word __P((struct am7990_softc *, void *, int, int));
131 1.26 veego integrate void ariadne_zerobuf_word __P((struct am7990_softc *, int, int));
132 1.26 veego void ariadne_autoselect __P((struct am7990_softc *, int));
133 1.26 veego int ariadne_mediachange __P((struct am7990_softc *));
134 1.26 veego void ariadne_hwinit __P((struct am7990_softc *));
135 1.26 veego
136 1.26 veego /*
137 1.26 veego * Media types supported by the Ariadne.
138 1.26 veego */
139 1.26 veego int lemedia_ariadne[] = {
140 1.26 veego IFM_ETHER | IFM_10_T,
141 1.26 veego IFM_ETHER | IFM_10_2,
142 1.26 veego IFM_ETHER | IFM_AUTO,
143 1.26 veego };
144 1.26 veego #define NLEMEDIA_ARIADNE (sizeof(lemedia_ariadne) / sizeof(lemedia_ariadne[0]))
145 1.26 veego
146 1.26 veego
147 1.26 veego hide u_int16_t
148 1.26 veego ariadne_swapreg(val)
149 1.26 veego u_int16_t val;
150 1.26 veego {
151 1.26 veego
152 1.26 veego return (((val & 0xff) << 8 ) | (( val >> 8) & 0xff));
153 1.26 veego }
154 1.26 veego
155 1.26 veego hide void
156 1.26 veego ariadne_wrcsr(sc, port, val)
157 1.26 veego struct am7990_softc *sc;
158 1.26 veego u_int16_t port, val;
159 1.26 veego {
160 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
161 1.26 veego
162 1.26 veego ler1->ler1_rap = ariadne_swapreg(port);
163 1.26 veego ler1->ler1_rdp = ariadne_swapreg(val);
164 1.26 veego }
165 1.26 veego
166 1.26 veego hide u_int16_t
167 1.26 veego ariadne_rdcsr(sc, port)
168 1.26 veego struct am7990_softc *sc;
169 1.26 veego u_int16_t port;
170 1.26 veego {
171 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
172 1.26 veego u_int16_t val;
173 1.26 veego
174 1.26 veego ler1->ler1_rap = ariadne_swapreg(port);
175 1.26 veego val = ariadne_swapreg(ler1->ler1_rdp);
176 1.26 veego return (val);
177 1.26 veego }
178 1.26 veego
179 1.26 veego hide void
180 1.26 veego ariadne_wribcr(sc, port, val)
181 1.26 veego struct am7990_softc *sc;
182 1.26 veego u_int16_t port, val;
183 1.26 veego {
184 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
185 1.26 veego
186 1.26 veego ler1->ler1_rap = ariadne_swapreg(port);
187 1.26 veego ler1->ler1_idp = ariadne_swapreg(val);
188 1.26 veego }
189 1.26 veego
190 1.21 thorpej hide void
191 1.15 chopps lewrcsr(sc, port, val)
192 1.21 thorpej struct am7990_softc *sc;
193 1.15 chopps u_int16_t port, val;
194 1.15 chopps {
195 1.21 thorpej struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
196 1.6 chopps
197 1.15 chopps ler1->ler1_rap = port;
198 1.15 chopps ler1->ler1_rdp = val;
199 1.15 chopps }
200 1.6 chopps
201 1.21 thorpej hide u_int16_t
202 1.15 chopps lerdcsr(sc, port)
203 1.21 thorpej struct am7990_softc *sc;
204 1.15 chopps u_int16_t port;
205 1.6 chopps {
206 1.21 thorpej struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
207 1.15 chopps u_int16_t val;
208 1.6 chopps
209 1.15 chopps ler1->ler1_rap = port;
210 1.15 chopps val = ler1->ler1_rdp;
211 1.15 chopps return (val);
212 1.15 chopps }
213 1.6 chopps
214 1.26 veego hide void
215 1.26 veego lepcnet_reset(sc)
216 1.26 veego struct am7990_softc *sc;
217 1.26 veego {
218 1.26 veego struct lereg1 *ler1 = ((struct le_softc *)sc)->sc_r1;
219 1.26 veego volatile int dummy;
220 1.26 veego
221 1.26 veego dummy = ler1->ler1_reset; /* Reset PCNet-ISA */
222 1.26 veego }
223 1.26 veego
224 1.26 veego void
225 1.26 veego ariadne_autoselect(sc, on)
226 1.26 veego struct am7990_softc *sc;
227 1.26 veego int on;
228 1.26 veego {
229 1.26 veego
230 1.26 veego /*
231 1.26 veego * on = 0: autoselect disabled
232 1.26 veego * on = 1: autoselect enabled
233 1.26 veego */
234 1.26 veego if (on == 0)
235 1.26 veego ariadne_wribcr(sc, LE_BCR_MC, 0x0000);
236 1.26 veego else
237 1.26 veego ariadne_wribcr(sc, LE_BCR_MC, LE_MC_ASEL);
238 1.26 veego }
239 1.26 veego
240 1.26 veego int
241 1.26 veego ariadne_mediachange(sc)
242 1.26 veego struct am7990_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.26 veego am7990_init(sc);
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.26 veego am7990_init(sc);
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.26 veego ariadne_hwinit(sc)
280 1.26 veego struct am7990_softc *sc;
281 1.26 veego {
282 1.26 veego
283 1.26 veego /*
284 1.26 veego * Re-program LEDs to match meaning used on the Ariadne board.
285 1.26 veego */
286 1.26 veego ariadne_wribcr(sc, LE_BCR_LED1, 0x0090);
287 1.26 veego ariadne_wribcr(sc, LE_BCR_LED2, 0x0081);
288 1.26 veego ariadne_wribcr(sc, LE_BCR_LED3, 0x0084);
289 1.26 veego
290 1.26 veego /*
291 1.26 veego * Enabel/Disable auto selection
292 1.26 veego */
293 1.26 veego if (sc->sc_initmodemedia == 2)
294 1.26 veego ariadne_autoselect(sc, 1);
295 1.26 veego else
296 1.26 veego ariadne_autoselect(sc, 0);
297 1.26 veego }
298 1.26 veego
299 1.15 chopps int
300 1.22 veego le_zbus_match(parent, cfp, aux)
301 1.15 chopps struct device *parent;
302 1.22 veego struct cfdata *cfp;
303 1.22 veego void *aux;
304 1.15 chopps {
305 1.15 chopps struct zbus_args *zap = aux;
306 1.6 chopps
307 1.6 chopps /* Commodore ethernet card */
308 1.15 chopps if (zap->manid == 514 && zap->prodid == 112)
309 1.15 chopps return (1);
310 1.6 chopps
311 1.6 chopps /* Ameristar ethernet card */
312 1.15 chopps if (zap->manid == 1053 && zap->prodid == 1)
313 1.15 chopps return (1);
314 1.6 chopps
315 1.26 veego /* Ariadne ethernet card */
316 1.26 veego if (zap->manid == 2167 && zap->prodid == 201)
317 1.26 veego return (1);
318 1.26 veego
319 1.6 chopps return (0);
320 1.6 chopps }
321 1.1 mw
322 1.6 chopps void
323 1.17 thorpej le_zbus_attach(parent, self, aux)
324 1.15 chopps struct device *parent, *self;
325 1.15 chopps void *aux;
326 1.1 mw {
327 1.21 thorpej struct le_softc *lesc = (struct le_softc *)self;
328 1.21 thorpej struct am7990_softc *sc = &lesc->sc_am7990;
329 1.15 chopps struct zbus_args *zap = aux;
330 1.15 chopps u_long ser;
331 1.1 mw
332 1.26 veego /* This has no effect on PCnet-ISA LANCE chips */
333 1.15 chopps sc->sc_conf3 = LE_C3_BSWP;
334 1.6 chopps
335 1.6 chopps /*
336 1.6 chopps * Manufacturer decides the 3 first bytes, i.e. ethernet vendor ID.
337 1.6 chopps */
338 1.15 chopps switch (zap->manid) {
339 1.26 veego case 514:
340 1.15 chopps /* Commodore */
341 1.15 chopps sc->sc_memsize = 32768;
342 1.23 is sc->sc_enaddr[0] = 0x00;
343 1.23 is sc->sc_enaddr[1] = 0x80;
344 1.23 is sc->sc_enaddr[2] = 0x10;
345 1.26 veego lesc->sc_r1 = (struct lereg1 *)(0x4000 + (int)zap->va);
346 1.26 veego sc->sc_mem = (void *)(0x8000 + (int)zap->va);
347 1.26 veego sc->sc_addr = 0x8000;
348 1.26 veego sc->sc_copytodesc = am7990_copytobuf_contig;
349 1.26 veego sc->sc_copyfromdesc = am7990_copyfrombuf_contig;
350 1.26 veego sc->sc_copytobuf = am7990_copytobuf_contig;
351 1.26 veego sc->sc_copyfrombuf = am7990_copyfrombuf_contig;
352 1.26 veego sc->sc_zerobuf = am7990_zerobuf_contig;
353 1.26 veego sc->sc_rdcsr = lerdcsr;
354 1.26 veego sc->sc_wrcsr = lewrcsr;
355 1.26 veego sc->sc_hwreset = NULL;
356 1.26 veego sc->sc_hwinit = NULL;
357 1.15 chopps break;
358 1.6 chopps
359 1.26 veego case 1053:
360 1.15 chopps /* Ameristar */
361 1.15 chopps sc->sc_memsize = 32768;
362 1.23 is sc->sc_enaddr[0] = 0x00;
363 1.23 is sc->sc_enaddr[1] = 0x00;
364 1.23 is sc->sc_enaddr[2] = 0x9f;
365 1.26 veego lesc->sc_r1 = (struct lereg1 *)(0x4000 + (int)zap->va);
366 1.26 veego sc->sc_mem = (void *)(0x8000 + (int)zap->va);
367 1.26 veego sc->sc_addr = 0x8000;
368 1.26 veego sc->sc_copytodesc = am7990_copytobuf_contig;
369 1.26 veego sc->sc_copyfromdesc = am7990_copyfrombuf_contig;
370 1.26 veego sc->sc_copytobuf = am7990_copytobuf_contig;
371 1.26 veego sc->sc_copyfrombuf = am7990_copyfrombuf_contig;
372 1.26 veego sc->sc_zerobuf = am7990_zerobuf_contig;
373 1.26 veego sc->sc_rdcsr = lerdcsr;
374 1.26 veego sc->sc_wrcsr = lewrcsr;
375 1.26 veego sc->sc_hwreset = NULL;
376 1.26 veego sc->sc_hwinit = NULL;
377 1.15 chopps break;
378 1.6 chopps
379 1.26 veego case 2167:
380 1.26 veego /* Village Tronic */
381 1.26 veego sc->sc_memsize = 32768;
382 1.26 veego sc->sc_enaddr[0] = 0x00;
383 1.26 veego sc->sc_enaddr[1] = 0x60;
384 1.26 veego sc->sc_enaddr[2] = 0x30;
385 1.26 veego lesc->sc_r1 = (struct lereg1 *)(0x0370 + (int)zap->va);
386 1.26 veego sc->sc_mem = (void *)(0x8000 + (int)zap->va);
387 1.26 veego sc->sc_addr = 0x8000;
388 1.26 veego sc->sc_copytodesc = ariadne_copytodesc_word;
389 1.26 veego sc->sc_copyfromdesc = ariadne_copyfromdesc_word;
390 1.26 veego sc->sc_copytobuf = ariadne_copytobuf_word;
391 1.26 veego sc->sc_copyfrombuf = ariadne_copyfrombuf_word;
392 1.26 veego sc->sc_zerobuf = ariadne_zerobuf_word;
393 1.26 veego sc->sc_rdcsr = ariadne_rdcsr;
394 1.26 veego sc->sc_wrcsr = ariadne_wrcsr;
395 1.26 veego sc->sc_hwreset = lepcnet_reset;
396 1.26 veego sc->sc_hwinit = ariadne_hwinit;
397 1.26 veego sc->sc_mediachange = ariadne_mediachange;
398 1.26 veego sc->sc_supmedia = lemedia_ariadne;
399 1.26 veego sc->sc_nsupmedia = NLEMEDIA_ARIADNE;
400 1.26 veego sc->sc_defaultmedia = IFM_ETHER | IFM_AUTO;
401 1.26 veego sc->sc_initmodemedia = 2;
402 1.26 veego break;
403 1.26 veego
404 1.26 veego default:
405 1.21 thorpej panic("le_zbus_attach: bad manid");
406 1.1 mw }
407 1.6 chopps
408 1.6 chopps /*
409 1.15 chopps * Serial number for board is used as host ID.
410 1.6 chopps */
411 1.15 chopps ser = (u_long)zap->serno;
412 1.23 is sc->sc_enaddr[3] = (ser >> 16) & 0xff;
413 1.23 is sc->sc_enaddr[4] = (ser >> 8) & 0xff;
414 1.23 is sc->sc_enaddr[5] = (ser ) & 0xff;
415 1.1 mw
416 1.21 thorpej am7990_config(sc);
417 1.6 chopps
418 1.21 thorpej lesc->sc_isr.isr_intr = am7990_intr;
419 1.21 thorpej lesc->sc_isr.isr_arg = sc;
420 1.21 thorpej lesc->sc_isr.isr_ipl = 2;
421 1.21 thorpej add_isr(&lesc->sc_isr);
422 1.26 veego }
423 1.26 veego
424 1.26 veego
425 1.26 veego integrate void
426 1.26 veego ariadne_copytodesc_word(sc, from, boff, len)
427 1.26 veego struct am7990_softc *sc;
428 1.26 veego void *from;
429 1.26 veego int boff, len;
430 1.26 veego {
431 1.26 veego u_short *b1 = from;
432 1.26 veego volatile u_short *b2 = sc->sc_mem + boff;
433 1.26 veego
434 1.26 veego for (len >>= 1; len > 0; len--)
435 1.26 veego *b2++ = ariadne_swapreg(*b1++);
436 1.26 veego }
437 1.26 veego
438 1.26 veego integrate void
439 1.26 veego ariadne_copyfromdesc_word(sc, to, boff, len)
440 1.26 veego struct am7990_softc *sc;
441 1.26 veego void *to;
442 1.26 veego int boff, len;
443 1.26 veego {
444 1.26 veego volatile u_short *b1 = sc->sc_mem + boff;
445 1.26 veego u_short *b2 = to;
446 1.26 veego
447 1.26 veego for (len >>= 1; len > 0; len--)
448 1.26 veego *b2++ = ariadne_swapreg(*b1++);
449 1.26 veego }
450 1.26 veego
451 1.26 veego #define isodd(n) ((n) & 1)
452 1.26 veego
453 1.26 veego integrate void
454 1.26 veego ariadne_copytobuf_word(sc, from, boff, len)
455 1.26 veego struct am7990_softc *sc;
456 1.26 veego void *from;
457 1.26 veego int boff, len;
458 1.26 veego {
459 1.26 veego u_char *a1 = from;
460 1.26 veego volatile u_char *a2 = sc->sc_mem + boff;
461 1.26 veego u_short *b1;
462 1.26 veego volatile u_short *b2;
463 1.26 veego int i;
464 1.26 veego
465 1.26 veego if (len > 0 && isodd(boff)) {
466 1.26 veego b1 = (u_short *)(a1 + 1);
467 1.26 veego b2 = (u_short *)(a2 + 1);
468 1.26 veego b2[-1] = (b2[-1] & 0xff00) | (b1[-1] & 0x00ff);
469 1.26 veego --len;
470 1.26 veego } else {
471 1.26 veego b1 = (u_short *)a1;
472 1.26 veego b2 = (u_short *)a2;
473 1.26 veego }
474 1.26 veego
475 1.26 veego for (i = len >> 1; i > 0; i--)
476 1.26 veego *b2++ = *b1++;
477 1.26 veego
478 1.26 veego if (isodd(len))
479 1.26 veego *b2 = (*b2 & 0x00ff) | (*b1 & 0xff00);
480 1.26 veego }
481 1.26 veego
482 1.26 veego integrate void
483 1.26 veego ariadne_copyfrombuf_word(sc, to, boff, len)
484 1.26 veego struct am7990_softc *sc;
485 1.26 veego void *to;
486 1.26 veego int boff, len;
487 1.26 veego {
488 1.26 veego volatile u_char *a1 = sc->sc_mem + boff;
489 1.26 veego u_char *a2 = to;
490 1.26 veego volatile u_short *b1;
491 1.26 veego u_short *b2;
492 1.26 veego int i;
493 1.26 veego
494 1.26 veego if (len > 0 && isodd(boff)) {
495 1.26 veego b1 = (u_short *)(a1 + 1);
496 1.26 veego b2 = (u_short *)(a2 + 1);
497 1.26 veego b2[-1] = (b2[-1] & 0xff00) | (b1[-1] & 0x00ff);
498 1.26 veego --len;
499 1.26 veego } else {
500 1.26 veego b1 = (u_short *)a1;
501 1.26 veego b2 = (u_short *)a2;
502 1.26 veego }
503 1.26 veego
504 1.26 veego for (i = len >> 1; i > 0; i--)
505 1.26 veego *b2++ = *b1++;
506 1.26 veego
507 1.26 veego if (isodd(len))
508 1.26 veego *b2 = (*b2 & 0x00ff) | (*b1 & 0xff00);
509 1.26 veego }
510 1.26 veego
511 1.26 veego integrate void
512 1.26 veego ariadne_zerobuf_word(sc, boff, len)
513 1.26 veego struct am7990_softc *sc;
514 1.26 veego int boff, len;
515 1.26 veego {
516 1.26 veego volatile u_char *a1 = sc->sc_mem + boff;
517 1.26 veego volatile u_short *b1;
518 1.26 veego int i;
519 1.26 veego
520 1.26 veego if (len > 0 && isodd(boff)) {
521 1.26 veego b1 = (u_short *)(a1 + 1);
522 1.26 veego b1[-1] &= 0xff00;
523 1.26 veego --len;
524 1.26 veego } else {
525 1.26 veego b1 = (u_short *)a1;
526 1.26 veego }
527 1.26 veego
528 1.26 veego for (i = len >> 1; i > 0; i--)
529 1.26 veego *b1++ = 0;
530 1.26 veego
531 1.26 veego if (isodd(len))
532 1.26 veego *b1 &= 0x00ff;
533 1.1 mw }
534