dio.c revision 1.26 1 1.26 tsutsui /* $NetBSD: dio.c,v 1.26 2003/11/17 14:37:59 tsutsui Exp $ */
2 1.1 thorpej
3 1.1 thorpej /*-
4 1.11 thorpej * Copyright (c) 1996, 1997, 1998 The NetBSD Foundation, Inc.
5 1.1 thorpej * All rights reserved.
6 1.1 thorpej *
7 1.1 thorpej * This code is derived from software contributed to The NetBSD Foundation
8 1.1 thorpej * by Jason R. Thorpe.
9 1.1 thorpej *
10 1.1 thorpej * Redistribution and use in source and binary forms, with or without
11 1.1 thorpej * modification, are permitted provided that the following conditions
12 1.1 thorpej * are met:
13 1.1 thorpej * 1. Redistributions of source code must retain the above copyright
14 1.1 thorpej * notice, this list of conditions and the following disclaimer.
15 1.1 thorpej * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 thorpej * notice, this list of conditions and the following disclaimer in the
17 1.1 thorpej * documentation and/or other materials provided with the distribution.
18 1.1 thorpej * 3. All advertising materials mentioning features or use of this software
19 1.1 thorpej * must display the following acknowledgement:
20 1.1 thorpej * This product includes software developed by the NetBSD
21 1.1 thorpej * Foundation, Inc. and its contributors.
22 1.1 thorpej * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 thorpej * contributors may be used to endorse or promote products derived
24 1.1 thorpej * from this software without specific prior written permission.
25 1.1 thorpej *
26 1.1 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.10 jtc * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.10 jtc * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 thorpej * POSSIBILITY OF SUCH DAMAGE.
37 1.1 thorpej */
38 1.1 thorpej
39 1.1 thorpej /*
40 1.1 thorpej * Autoconfiguration and mapping support for the DIO bus.
41 1.1 thorpej */
42 1.16 gmcgarry
43 1.16 gmcgarry #include <sys/cdefs.h>
44 1.26 tsutsui __KERNEL_RCSID(0, "$NetBSD: dio.c,v 1.26 2003/11/17 14:37:59 tsutsui Exp $");
45 1.1 thorpej
46 1.7 thorpej #define _HP300_INTR_H_PRIVATE
47 1.7 thorpej
48 1.1 thorpej #include <sys/param.h>
49 1.1 thorpej #include <sys/systm.h>
50 1.1 thorpej #include <sys/kernel.h>
51 1.1 thorpej #include <sys/device.h>
52 1.1 thorpej
53 1.23 gmcgarry #include <machine/bus.h>
54 1.23 gmcgarry
55 1.22 thorpej #include <uvm/uvm_extern.h>
56 1.22 thorpej
57 1.1 thorpej #include <machine/autoconf.h>
58 1.1 thorpej #include <machine/cpu.h>
59 1.6 thorpej #include <machine/hp300spu.h>
60 1.1 thorpej
61 1.7 thorpej #include <hp300/dev/dmavar.h>
62 1.7 thorpej
63 1.1 thorpej #include <hp300/dev/dioreg.h>
64 1.1 thorpej #include <hp300/dev/diovar.h>
65 1.1 thorpej
66 1.1 thorpej #include <hp300/dev/diodevs.h>
67 1.1 thorpej #include <hp300/dev/diodevs_data.h>
68 1.1 thorpej
69 1.23 gmcgarry #include "locators.h"
70 1.23 gmcgarry #define diocf_scode cf_loc[DIOCF_SCODE]
71 1.23 gmcgarry
72 1.24 tsutsui struct dio_softc {
73 1.24 tsutsui struct device sc_dev;
74 1.24 tsutsui struct bus_space_tag sc_tag;
75 1.24 tsutsui };
76 1.1 thorpej
77 1.23 gmcgarry static int dio_scodesize __P((struct dio_attach_args *));
78 1.1 thorpej char *dio_devinfo __P((struct dio_attach_args *, char *, size_t));
79 1.1 thorpej
80 1.1 thorpej int diomatch __P((struct device *, struct cfdata *, void *));
81 1.1 thorpej void dioattach __P((struct device *, struct device *, void *));
82 1.1 thorpej int dioprint __P((void *, const char *));
83 1.1 thorpej int diosubmatch __P((struct device *, struct cfdata *, void *));
84 1.1 thorpej
85 1.24 tsutsui CFATTACH_DECL(dio, sizeof(struct dio_softc),
86 1.19 thorpej diomatch, dioattach, NULL, NULL);
87 1.1 thorpej
88 1.1 thorpej int
89 1.1 thorpej diomatch(parent, match, aux)
90 1.1 thorpej struct device *parent;
91 1.1 thorpej struct cfdata *match;
92 1.1 thorpej void *aux;
93 1.1 thorpej {
94 1.1 thorpej static int dio_matched = 0;
95 1.1 thorpej
96 1.1 thorpej /* Allow only one instance. */
97 1.1 thorpej if (dio_matched)
98 1.1 thorpej return (0);
99 1.1 thorpej
100 1.1 thorpej dio_matched = 1;
101 1.1 thorpej return (1);
102 1.1 thorpej }
103 1.1 thorpej
104 1.1 thorpej void
105 1.1 thorpej dioattach(parent, self, aux)
106 1.1 thorpej struct device *parent, *self;
107 1.1 thorpej void *aux;
108 1.1 thorpej {
109 1.24 tsutsui struct dio_softc *sc = (struct dio_softc *)self;
110 1.1 thorpej struct dio_attach_args da;
111 1.1 thorpej caddr_t pa, va;
112 1.24 tsutsui bus_space_tag_t bst = &sc->sc_tag;
113 1.23 gmcgarry int scode, scmax, scodesize;
114 1.1 thorpej
115 1.20 gmcgarry printf("\n");
116 1.20 gmcgarry
117 1.24 tsutsui memset(bst, 0, sizeof(struct bus_space_tag));
118 1.24 tsutsui bst->bustype = HP300_BUS_SPACE_DIO;
119 1.24 tsutsui
120 1.1 thorpej scmax = DIO_SCMAX(machineid);
121 1.1 thorpej
122 1.1 thorpej for (scode = 0; scode < scmax; ) {
123 1.1 thorpej if (DIO_INHOLE(scode)) {
124 1.1 thorpej scode++;
125 1.1 thorpej continue;
126 1.1 thorpej }
127 1.1 thorpej
128 1.1 thorpej /*
129 1.1 thorpej * Temporarily map the space corresponding to
130 1.1 thorpej * the current select code unless:
131 1.1 thorpej */
132 1.1 thorpej pa = dio_scodetopa(scode);
133 1.26 tsutsui va = iomap(pa, PAGE_SIZE);
134 1.26 tsutsui if (va == NULL) {
135 1.26 tsutsui printf("%s: can't map scode %d\n",
136 1.26 tsutsui self->dv_xname, scode);
137 1.26 tsutsui scode++;
138 1.26 tsutsui continue;
139 1.1 thorpej }
140 1.1 thorpej
141 1.1 thorpej /* Check for hardware. */
142 1.1 thorpej if (badaddr(va)) {
143 1.23 gmcgarry iounmap(va, PAGE_SIZE);
144 1.1 thorpej scode++;
145 1.1 thorpej continue;
146 1.1 thorpej }
147 1.1 thorpej
148 1.1 thorpej /* Fill out attach args. */
149 1.14 gmcgarry memset(&da, 0, sizeof(da));
150 1.24 tsutsui da.da_bst = bst;
151 1.1 thorpej da.da_scode = scode;
152 1.1 thorpej
153 1.23 gmcgarry da.da_id = DIO_ID(va);
154 1.1 thorpej if (DIO_ISFRAMEBUFFER(da.da_id))
155 1.1 thorpej da.da_secid = DIO_SECID(va);
156 1.23 gmcgarry da.da_addr = (bus_addr_t)dio_scodetopa(scode);
157 1.1 thorpej da.da_size = DIO_SIZE(scode, va);
158 1.1 thorpej scodesize = dio_scodesize(&da);
159 1.1 thorpej if (DIO_ISDIO(scode))
160 1.1 thorpej da.da_size *= scodesize;
161 1.23 gmcgarry da.da_ipl = DIO_IPL(va);
162 1.1 thorpej
163 1.1 thorpej /* No longer need the device to be mapped. */
164 1.23 gmcgarry iounmap(va, PAGE_SIZE);
165 1.1 thorpej
166 1.1 thorpej /* Attach matching device. */
167 1.1 thorpej config_found_sm(self, &da, dioprint, diosubmatch);
168 1.1 thorpej scode += scodesize;
169 1.1 thorpej }
170 1.1 thorpej }
171 1.1 thorpej
172 1.1 thorpej int
173 1.1 thorpej diosubmatch(parent, cf, aux)
174 1.1 thorpej struct device *parent;
175 1.1 thorpej struct cfdata *cf;
176 1.1 thorpej void *aux;
177 1.1 thorpej {
178 1.1 thorpej struct dio_attach_args *da = aux;
179 1.1 thorpej
180 1.8 jtk if (cf->diocf_scode != DIOCF_SCODE_DEFAULT &&
181 1.1 thorpej cf->diocf_scode != da->da_scode)
182 1.1 thorpej return (0);
183 1.1 thorpej
184 1.17 thorpej return (config_match(parent, cf, aux));
185 1.1 thorpej }
186 1.1 thorpej
187 1.1 thorpej int
188 1.1 thorpej dioprint(aux, pnp)
189 1.1 thorpej void *aux;
190 1.1 thorpej const char *pnp;
191 1.1 thorpej {
192 1.1 thorpej struct dio_attach_args *da = aux;
193 1.1 thorpej char buf[128];
194 1.1 thorpej
195 1.1 thorpej if (pnp)
196 1.21 thorpej aprint_normal("%s at %s",
197 1.21 thorpej dio_devinfo(da, buf, sizeof(buf)), pnp);
198 1.23 gmcgarry aprint_normal(" scode %d ipl %d", da->da_scode, da->da_ipl);
199 1.1 thorpej return (UNCONF);
200 1.1 thorpej }
201 1.1 thorpej
202 1.1 thorpej /*
203 1.1 thorpej * Convert a select code to a system physical address.
204 1.1 thorpej */
205 1.1 thorpej void *
206 1.1 thorpej dio_scodetopa(scode)
207 1.1 thorpej int scode;
208 1.1 thorpej {
209 1.1 thorpej u_long rval;
210 1.1 thorpej
211 1.23 gmcgarry if (DIO_ISDIO(scode))
212 1.1 thorpej rval = DIO_BASE + (scode * DIO_DEVSIZE);
213 1.1 thorpej else if (DIO_ISDIOII(scode))
214 1.2 thorpej rval = DIOII_BASE + ((scode - DIOII_SCBASE) * DIOII_DEVSIZE);
215 1.1 thorpej else
216 1.1 thorpej rval = 0;
217 1.1 thorpej
218 1.1 thorpej return ((void *)rval);
219 1.1 thorpej }
220 1.1 thorpej
221 1.1 thorpej /*
222 1.1 thorpej * Return the select code size for this device, defaulting to 1
223 1.1 thorpej * if we don't know what kind of device we have.
224 1.1 thorpej */
225 1.23 gmcgarry static int
226 1.1 thorpej dio_scodesize(da)
227 1.1 thorpej struct dio_attach_args *da;
228 1.1 thorpej {
229 1.1 thorpej int i;
230 1.1 thorpej
231 1.1 thorpej /*
232 1.1 thorpej * Find the dio_devdata matchind the primary id.
233 1.1 thorpej * If we're a framebuffer, we also check the secondary id.
234 1.1 thorpej */
235 1.1 thorpej for (i = 0; i < DIO_NDEVICES; i++) {
236 1.1 thorpej if (da->da_id == dio_devdatas[i].dd_id) {
237 1.1 thorpej if (DIO_ISFRAMEBUFFER(da->da_id)) {
238 1.1 thorpej if (da->da_secid == dio_devdatas[i].dd_secid) {
239 1.1 thorpej goto foundit;
240 1.1 thorpej }
241 1.1 thorpej } else {
242 1.1 thorpej foundit:
243 1.1 thorpej return (dio_devdatas[i].dd_nscode);
244 1.1 thorpej }
245 1.1 thorpej }
246 1.1 thorpej }
247 1.1 thorpej
248 1.1 thorpej /*
249 1.1 thorpej * Device is unknown. Print a warning and assume a default.
250 1.1 thorpej */
251 1.1 thorpej printf("WARNING: select code size unknown for id = 0x%x secid = 0x%x\n",
252 1.1 thorpej da->da_id, da->da_secid);
253 1.1 thorpej return (1);
254 1.1 thorpej }
255 1.1 thorpej
256 1.1 thorpej /*
257 1.1 thorpej * Return a reasonable description of a DIO device.
258 1.1 thorpej */
259 1.1 thorpej char *
260 1.1 thorpej dio_devinfo(da, buf, buflen)
261 1.1 thorpej struct dio_attach_args *da;
262 1.1 thorpej char *buf;
263 1.1 thorpej size_t buflen;
264 1.1 thorpej {
265 1.5 thorpej #ifdef DIOVERBOSE
266 1.1 thorpej int i;
267 1.5 thorpej #endif
268 1.1 thorpej
269 1.14 gmcgarry memset(buf, 0, buflen);
270 1.1 thorpej
271 1.1 thorpej #ifdef DIOVERBOSE
272 1.1 thorpej /*
273 1.1 thorpej * Find the description matching our primary id.
274 1.1 thorpej * If we're a framebuffer, we also check the secondary id.
275 1.1 thorpej */
276 1.1 thorpej for (i = 0; i < DIO_NDEVICES; i++) {
277 1.1 thorpej if (da->da_id == dio_devdescs[i].dd_id) {
278 1.1 thorpej if (DIO_ISFRAMEBUFFER(da->da_id)) {
279 1.1 thorpej if (da->da_secid == dio_devdescs[i].dd_secid) {
280 1.1 thorpej goto foundit;
281 1.1 thorpej }
282 1.1 thorpej } else {
283 1.1 thorpej foundit:
284 1.1 thorpej sprintf(buf, "%s", dio_devdescs[i].dd_desc);
285 1.1 thorpej return (buf);
286 1.1 thorpej }
287 1.1 thorpej }
288 1.1 thorpej }
289 1.1 thorpej #endif /* DIOVERBOSE */
290 1.1 thorpej
291 1.1 thorpej /*
292 1.1 thorpej * Device is unknown. Construct something reasonable.
293 1.1 thorpej */
294 1.1 thorpej sprintf(buf, "device id = 0x%x secid = 0x%x",
295 1.1 thorpej da->da_id, da->da_secid);
296 1.1 thorpej return (buf);
297 1.7 thorpej }
298 1.7 thorpej
299 1.7 thorpej /*
300 1.7 thorpej * Establish an interrupt handler for a DIO device.
301 1.7 thorpej */
302 1.7 thorpej void *
303 1.7 thorpej dio_intr_establish(func, arg, ipl, priority)
304 1.7 thorpej int (*func) __P((void *));
305 1.7 thorpej void *arg;
306 1.7 thorpej int ipl;
307 1.7 thorpej int priority;
308 1.7 thorpej {
309 1.7 thorpej void *ih;
310 1.7 thorpej
311 1.7 thorpej ih = intr_establish(func, arg, ipl, priority);
312 1.7 thorpej
313 1.7 thorpej if (priority == IPL_BIO)
314 1.7 thorpej dmacomputeipl();
315 1.7 thorpej
316 1.7 thorpej return (ih);
317 1.7 thorpej }
318 1.7 thorpej
319 1.7 thorpej /*
320 1.7 thorpej * Remove an interrupt handler for a DIO device.
321 1.7 thorpej */
322 1.7 thorpej void
323 1.7 thorpej dio_intr_disestablish(arg)
324 1.7 thorpej void *arg;
325 1.7 thorpej {
326 1.14 gmcgarry struct hp300_intrhand *ih = arg;
327 1.14 gmcgarry int priority = ih->ih_priority;
328 1.7 thorpej
329 1.7 thorpej intr_disestablish(arg);
330 1.7 thorpej
331 1.7 thorpej if (priority == IPL_BIO)
332 1.7 thorpej dmacomputeipl();
333 1.25 tsutsui }
334 1.25 tsutsui
335 1.25 tsutsui /*
336 1.25 tsutsui * DIO specific bus_space(9) support functions.
337 1.25 tsutsui */
338 1.25 tsutsui static u_int8_t dio_bus_space_read_oddbyte_1 __P((bus_space_tag_t,
339 1.25 tsutsui bus_space_handle_t, bus_size_t));
340 1.25 tsutsui static void dio_bus_space_write_oddbyte_1 __P((bus_space_tag_t,
341 1.25 tsutsui bus_space_handle_t, bus_size_t, u_int8_t));
342 1.25 tsutsui
343 1.25 tsutsui static void dio_bus_space_read_multi_oddbyte_1 __P((bus_space_tag_t,
344 1.25 tsutsui bus_space_handle_t, bus_size_t, u_int8_t *, bus_size_t));
345 1.25 tsutsui static void dio_bus_space_write_multi_oddbyte_1 __P((bus_space_tag_t,
346 1.25 tsutsui bus_space_handle_t, bus_size_t, const u_int8_t *, bus_size_t));
347 1.25 tsutsui
348 1.25 tsutsui static void dio_bus_space_read_region_oddbyte_1 __P((bus_space_tag_t,
349 1.25 tsutsui bus_space_handle_t, bus_size_t, u_int8_t *, bus_size_t));
350 1.25 tsutsui static void dio_bus_space_write_region_oddbyte_1 __P((bus_space_tag_t,
351 1.25 tsutsui bus_space_handle_t, bus_size_t, const u_int8_t *, bus_size_t));
352 1.25 tsutsui
353 1.25 tsutsui static void dio_bus_space_set_multi_oddbyte_1 __P((bus_space_tag_t,
354 1.25 tsutsui bus_space_handle_t, bus_size_t, u_int8_t, bus_size_t));
355 1.25 tsutsui
356 1.25 tsutsui static void dio_bus_space_set_region_oddbyte_1 __P((bus_space_tag_t,
357 1.25 tsutsui bus_space_handle_t, bus_size_t, u_int8_t, bus_size_t));
358 1.25 tsutsui
359 1.25 tsutsui /*
360 1.25 tsutsui * dio_set_bus_space_oddbyte():
361 1.25 tsutsui * Override bus_space functions in bus_space_tag_t
362 1.25 tsutsui * for devices which have odd byte address space.
363 1.25 tsutsui */
364 1.25 tsutsui void
365 1.25 tsutsui dio_set_bus_space_oddbyte(bst)
366 1.25 tsutsui bus_space_tag_t bst;
367 1.25 tsutsui {
368 1.25 tsutsui
369 1.25 tsutsui /* XXX only 1-byte functions for now */
370 1.25 tsutsui bst->bsr1 = dio_bus_space_read_oddbyte_1;
371 1.25 tsutsui bst->bsw1 = dio_bus_space_write_oddbyte_1;
372 1.25 tsutsui
373 1.25 tsutsui bst->bsrm1 = dio_bus_space_read_multi_oddbyte_1;
374 1.25 tsutsui bst->bswm1 = dio_bus_space_write_multi_oddbyte_1;
375 1.25 tsutsui
376 1.25 tsutsui bst->bsrr1 = dio_bus_space_read_region_oddbyte_1;
377 1.25 tsutsui bst->bswr1 = dio_bus_space_write_region_oddbyte_1;
378 1.25 tsutsui
379 1.25 tsutsui bst->bssm1 = dio_bus_space_set_multi_oddbyte_1;
380 1.25 tsutsui
381 1.25 tsutsui bst->bssr1 = dio_bus_space_set_region_oddbyte_1;
382 1.25 tsutsui }
383 1.25 tsutsui
384 1.25 tsutsui static u_int8_t
385 1.25 tsutsui dio_bus_space_read_oddbyte_1(bst, bsh, offset)
386 1.25 tsutsui bus_space_tag_t bst;
387 1.25 tsutsui bus_space_handle_t bsh;
388 1.25 tsutsui bus_size_t offset;
389 1.25 tsutsui {
390 1.25 tsutsui
391 1.25 tsutsui return *(volatile u_int8_t *)(bsh + (offset << 1) + 1);
392 1.25 tsutsui }
393 1.25 tsutsui
394 1.25 tsutsui static void dio_bus_space_write_oddbyte_1(bst, bsh, offset, val)
395 1.25 tsutsui bus_space_tag_t bst;
396 1.25 tsutsui bus_space_handle_t bsh;
397 1.25 tsutsui bus_size_t offset;
398 1.25 tsutsui u_int8_t val;
399 1.25 tsutsui {
400 1.25 tsutsui
401 1.25 tsutsui *(volatile u_int8_t *)(bsh + (offset << 1) + 1) = val;
402 1.25 tsutsui }
403 1.25 tsutsui
404 1.25 tsutsui static void
405 1.25 tsutsui dio_bus_space_read_multi_oddbyte_1(bst, bsh, offset, addr, len)
406 1.25 tsutsui bus_space_tag_t bst;
407 1.25 tsutsui bus_space_handle_t bsh;
408 1.25 tsutsui bus_size_t offset;
409 1.25 tsutsui u_int8_t *addr;
410 1.25 tsutsui bus_size_t len;
411 1.25 tsutsui {
412 1.25 tsutsui
413 1.25 tsutsui __asm __volatile (
414 1.25 tsutsui " movl %0,%%a0 ;\n"
415 1.25 tsutsui " movl %1,%%a1 ;\n"
416 1.25 tsutsui " movl %2,%%d0 ;\n"
417 1.25 tsutsui "1: movb %%a0@,%%a1@+ ;\n"
418 1.25 tsutsui " subql #1,%%d0 ;\n"
419 1.25 tsutsui " jne 1b"
420 1.25 tsutsui :
421 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
422 1.25 tsutsui : "%a0","%a1","%d0");
423 1.25 tsutsui }
424 1.25 tsutsui
425 1.25 tsutsui static void
426 1.25 tsutsui dio_bus_space_write_multi_oddbyte_1(bst, bsh, offset, addr, len)
427 1.25 tsutsui bus_space_tag_t bst;
428 1.25 tsutsui bus_space_handle_t bsh;
429 1.25 tsutsui bus_size_t offset;
430 1.25 tsutsui const u_int8_t *addr;
431 1.25 tsutsui bus_size_t len;
432 1.25 tsutsui {
433 1.25 tsutsui
434 1.25 tsutsui __asm __volatile (
435 1.25 tsutsui " movl %0,%%a0 ;\n"
436 1.25 tsutsui " movl %1,%%a1 ;\n"
437 1.25 tsutsui " movl %2,%%d0 ;\n"
438 1.25 tsutsui "1: movb %%a1@+,%%a0@ ;\n"
439 1.25 tsutsui " subql #1,%%d0 ;\n"
440 1.25 tsutsui " jne 1b"
441 1.25 tsutsui :
442 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
443 1.25 tsutsui : "%a0","%a1","%d0");
444 1.25 tsutsui }
445 1.25 tsutsui
446 1.25 tsutsui static void
447 1.25 tsutsui dio_bus_space_read_region_oddbyte_1(bst, bsh, offset, addr, len)
448 1.25 tsutsui bus_space_tag_t bst;
449 1.25 tsutsui bus_space_handle_t bsh;
450 1.25 tsutsui bus_size_t offset;
451 1.25 tsutsui u_int8_t *addr;
452 1.25 tsutsui bus_size_t len;
453 1.25 tsutsui {
454 1.25 tsutsui __asm __volatile (
455 1.25 tsutsui " movl %0,%%a0 ;\n"
456 1.25 tsutsui " movl %1,%%a1 ;\n"
457 1.25 tsutsui " movl %2,%%d0 ;\n"
458 1.25 tsutsui "1: movb %%a0@,%%a1@+ ;\n"
459 1.25 tsutsui " addql #2,%%a0 ;\n"
460 1.25 tsutsui " subql #1,%%d0 ;\n"
461 1.25 tsutsui " jne 1b"
462 1.25 tsutsui :
463 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
464 1.25 tsutsui : "%a0","%a1","%d0");
465 1.25 tsutsui }
466 1.25 tsutsui
467 1.25 tsutsui static void
468 1.25 tsutsui dio_bus_space_write_region_oddbyte_1(bst, bsh, offset, addr, len)
469 1.25 tsutsui bus_space_tag_t bst;
470 1.25 tsutsui bus_space_handle_t bsh;
471 1.25 tsutsui bus_size_t offset;
472 1.25 tsutsui const u_int8_t *addr;
473 1.25 tsutsui bus_size_t len;
474 1.25 tsutsui {
475 1.25 tsutsui
476 1.25 tsutsui __asm __volatile (
477 1.25 tsutsui " movl %0,%%a0 ;\n"
478 1.25 tsutsui " movl %1,%%a1 ;\n"
479 1.25 tsutsui " movl %2,%%d0 ;\n"
480 1.25 tsutsui "1: movb %%a1@+,%%a0@ ;\n"
481 1.25 tsutsui " addql #2,%%a0 ;\n"
482 1.25 tsutsui " subql #1,%%d0 ;\n"
483 1.25 tsutsui " jne 1b"
484 1.25 tsutsui :
485 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
486 1.25 tsutsui : "%a0","%a1","%d0");
487 1.25 tsutsui }
488 1.25 tsutsui
489 1.25 tsutsui static void
490 1.25 tsutsui dio_bus_space_set_multi_oddbyte_1(bst, bsh, offset, val, count)
491 1.25 tsutsui bus_space_tag_t bst;
492 1.25 tsutsui bus_space_handle_t bsh;
493 1.25 tsutsui bus_size_t offset;
494 1.25 tsutsui u_int8_t val;
495 1.25 tsutsui bus_size_t count;
496 1.25 tsutsui {
497 1.25 tsutsui __asm __volatile (
498 1.25 tsutsui " movl %0,%%a0 ;\n"
499 1.25 tsutsui " movl %1,%%d1 ;\n"
500 1.25 tsutsui " movl %2,%%d0 ;\n"
501 1.25 tsutsui "1: movb %%d1,%%a0@ ;\n"
502 1.25 tsutsui " subql #1,%%d0 ;\n"
503 1.25 tsutsui " jne 1b"
504 1.25 tsutsui :
505 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
506 1.25 tsutsui : "%a0","%d0","%d1");
507 1.25 tsutsui }
508 1.25 tsutsui
509 1.25 tsutsui static void
510 1.25 tsutsui dio_bus_space_set_region_oddbyte_1(bst, bsh, offset, val, count)
511 1.25 tsutsui bus_space_tag_t bst;
512 1.25 tsutsui bus_space_handle_t bsh;
513 1.25 tsutsui bus_size_t offset;
514 1.25 tsutsui u_int8_t val;
515 1.25 tsutsui bus_size_t count;
516 1.25 tsutsui {
517 1.25 tsutsui
518 1.25 tsutsui __asm __volatile (
519 1.25 tsutsui " movl %0,%%a0 ;\n"
520 1.25 tsutsui " movl %1,%%d1 ;\n"
521 1.25 tsutsui " movl %2,%%d0 ;\n"
522 1.25 tsutsui "1: movb %%d1,%%a0@ ;\n"
523 1.25 tsutsui " addql #2,%%a0 ;\n"
524 1.25 tsutsui " subql #1,%%d0 ;\n"
525 1.25 tsutsui " jne 1b"
526 1.25 tsutsui :
527 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
528 1.25 tsutsui : "%a0","%d0","%d1");
529 1.1 thorpej }
530