dio.c revision 1.27 1 1.27 thorpej /* $NetBSD: dio.c,v 1.27 2004/08/28 17:37:00 thorpej 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.27 thorpej __KERNEL_RCSID(0, "$NetBSD: dio.c,v 1.27 2004/08/28 17:37:00 thorpej 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.27 thorpej static int dio_scodesize(struct dio_attach_args *);
78 1.27 thorpej static const char *dio_devinfo(struct dio_attach_args *, char *, size_t);
79 1.1 thorpej
80 1.27 thorpej static int diomatch(struct device *, struct cfdata *, void *);
81 1.27 thorpej static void dioattach(struct device *, struct device *, void *);
82 1.27 thorpej static int dioprint(void *, const char *);
83 1.27 thorpej static int diosubmatch(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.27 thorpej static int
89 1.27 thorpej diomatch(struct device *parent, struct cfdata *match, void *aux)
90 1.1 thorpej {
91 1.1 thorpej static int dio_matched = 0;
92 1.1 thorpej
93 1.1 thorpej /* Allow only one instance. */
94 1.1 thorpej if (dio_matched)
95 1.1 thorpej return (0);
96 1.1 thorpej
97 1.1 thorpej dio_matched = 1;
98 1.1 thorpej return (1);
99 1.1 thorpej }
100 1.1 thorpej
101 1.27 thorpej static void
102 1.27 thorpej dioattach(struct device *parent, struct device *self, void *aux)
103 1.1 thorpej {
104 1.24 tsutsui struct dio_softc *sc = (struct dio_softc *)self;
105 1.1 thorpej struct dio_attach_args da;
106 1.1 thorpej caddr_t pa, va;
107 1.24 tsutsui bus_space_tag_t bst = &sc->sc_tag;
108 1.23 gmcgarry int scode, scmax, scodesize;
109 1.1 thorpej
110 1.20 gmcgarry printf("\n");
111 1.20 gmcgarry
112 1.24 tsutsui memset(bst, 0, sizeof(struct bus_space_tag));
113 1.24 tsutsui bst->bustype = HP300_BUS_SPACE_DIO;
114 1.24 tsutsui
115 1.1 thorpej scmax = DIO_SCMAX(machineid);
116 1.1 thorpej
117 1.1 thorpej for (scode = 0; scode < scmax; ) {
118 1.1 thorpej if (DIO_INHOLE(scode)) {
119 1.1 thorpej scode++;
120 1.1 thorpej continue;
121 1.1 thorpej }
122 1.1 thorpej
123 1.1 thorpej /*
124 1.1 thorpej * Temporarily map the space corresponding to
125 1.1 thorpej * the current select code unless:
126 1.1 thorpej */
127 1.1 thorpej pa = dio_scodetopa(scode);
128 1.26 tsutsui va = iomap(pa, PAGE_SIZE);
129 1.26 tsutsui if (va == NULL) {
130 1.26 tsutsui printf("%s: can't map scode %d\n",
131 1.26 tsutsui self->dv_xname, scode);
132 1.26 tsutsui scode++;
133 1.26 tsutsui continue;
134 1.1 thorpej }
135 1.1 thorpej
136 1.1 thorpej /* Check for hardware. */
137 1.1 thorpej if (badaddr(va)) {
138 1.23 gmcgarry iounmap(va, PAGE_SIZE);
139 1.1 thorpej scode++;
140 1.1 thorpej continue;
141 1.1 thorpej }
142 1.1 thorpej
143 1.1 thorpej /* Fill out attach args. */
144 1.14 gmcgarry memset(&da, 0, sizeof(da));
145 1.24 tsutsui da.da_bst = bst;
146 1.1 thorpej da.da_scode = scode;
147 1.1 thorpej
148 1.23 gmcgarry da.da_id = DIO_ID(va);
149 1.1 thorpej if (DIO_ISFRAMEBUFFER(da.da_id))
150 1.1 thorpej da.da_secid = DIO_SECID(va);
151 1.23 gmcgarry da.da_addr = (bus_addr_t)dio_scodetopa(scode);
152 1.1 thorpej da.da_size = DIO_SIZE(scode, va);
153 1.1 thorpej scodesize = dio_scodesize(&da);
154 1.1 thorpej if (DIO_ISDIO(scode))
155 1.1 thorpej da.da_size *= scodesize;
156 1.23 gmcgarry da.da_ipl = DIO_IPL(va);
157 1.1 thorpej
158 1.1 thorpej /* No longer need the device to be mapped. */
159 1.23 gmcgarry iounmap(va, PAGE_SIZE);
160 1.1 thorpej
161 1.1 thorpej /* Attach matching device. */
162 1.1 thorpej config_found_sm(self, &da, dioprint, diosubmatch);
163 1.1 thorpej scode += scodesize;
164 1.1 thorpej }
165 1.1 thorpej }
166 1.1 thorpej
167 1.27 thorpej static int
168 1.27 thorpej diosubmatch(struct device *parent, struct cfdata *cf, void *aux)
169 1.1 thorpej {
170 1.1 thorpej struct dio_attach_args *da = aux;
171 1.1 thorpej
172 1.8 jtk if (cf->diocf_scode != DIOCF_SCODE_DEFAULT &&
173 1.1 thorpej cf->diocf_scode != da->da_scode)
174 1.1 thorpej return (0);
175 1.1 thorpej
176 1.17 thorpej return (config_match(parent, cf, aux));
177 1.1 thorpej }
178 1.1 thorpej
179 1.27 thorpej static int
180 1.27 thorpej dioprint(void *aux, const char *pnp)
181 1.1 thorpej {
182 1.1 thorpej struct dio_attach_args *da = aux;
183 1.1 thorpej char buf[128];
184 1.1 thorpej
185 1.1 thorpej if (pnp)
186 1.21 thorpej aprint_normal("%s at %s",
187 1.21 thorpej dio_devinfo(da, buf, sizeof(buf)), pnp);
188 1.23 gmcgarry aprint_normal(" scode %d ipl %d", da->da_scode, da->da_ipl);
189 1.1 thorpej return (UNCONF);
190 1.1 thorpej }
191 1.1 thorpej
192 1.1 thorpej /*
193 1.1 thorpej * Convert a select code to a system physical address.
194 1.1 thorpej */
195 1.1 thorpej void *
196 1.27 thorpej dio_scodetopa(int scode)
197 1.1 thorpej {
198 1.1 thorpej u_long rval;
199 1.1 thorpej
200 1.23 gmcgarry if (DIO_ISDIO(scode))
201 1.1 thorpej rval = DIO_BASE + (scode * DIO_DEVSIZE);
202 1.1 thorpej else if (DIO_ISDIOII(scode))
203 1.2 thorpej rval = DIOII_BASE + ((scode - DIOII_SCBASE) * DIOII_DEVSIZE);
204 1.1 thorpej else
205 1.1 thorpej rval = 0;
206 1.1 thorpej
207 1.1 thorpej return ((void *)rval);
208 1.1 thorpej }
209 1.1 thorpej
210 1.1 thorpej /*
211 1.1 thorpej * Return the select code size for this device, defaulting to 1
212 1.1 thorpej * if we don't know what kind of device we have.
213 1.1 thorpej */
214 1.23 gmcgarry static int
215 1.27 thorpej dio_scodesize(struct dio_attach_args *da)
216 1.1 thorpej {
217 1.1 thorpej int i;
218 1.1 thorpej
219 1.1 thorpej /*
220 1.1 thorpej * Find the dio_devdata matchind the primary id.
221 1.1 thorpej * If we're a framebuffer, we also check the secondary id.
222 1.1 thorpej */
223 1.1 thorpej for (i = 0; i < DIO_NDEVICES; i++) {
224 1.1 thorpej if (da->da_id == dio_devdatas[i].dd_id) {
225 1.1 thorpej if (DIO_ISFRAMEBUFFER(da->da_id)) {
226 1.1 thorpej if (da->da_secid == dio_devdatas[i].dd_secid) {
227 1.1 thorpej goto foundit;
228 1.1 thorpej }
229 1.1 thorpej } else {
230 1.1 thorpej foundit:
231 1.1 thorpej return (dio_devdatas[i].dd_nscode);
232 1.1 thorpej }
233 1.1 thorpej }
234 1.1 thorpej }
235 1.1 thorpej
236 1.1 thorpej /*
237 1.1 thorpej * Device is unknown. Print a warning and assume a default.
238 1.1 thorpej */
239 1.1 thorpej printf("WARNING: select code size unknown for id = 0x%x secid = 0x%x\n",
240 1.1 thorpej da->da_id, da->da_secid);
241 1.1 thorpej return (1);
242 1.1 thorpej }
243 1.1 thorpej
244 1.1 thorpej /*
245 1.1 thorpej * Return a reasonable description of a DIO device.
246 1.1 thorpej */
247 1.27 thorpej static const char *
248 1.27 thorpej dio_devinfo(struct dio_attach_args *da, char *buf, size_t buflen)
249 1.1 thorpej {
250 1.5 thorpej #ifdef DIOVERBOSE
251 1.1 thorpej int i;
252 1.5 thorpej #endif
253 1.1 thorpej
254 1.14 gmcgarry memset(buf, 0, buflen);
255 1.1 thorpej
256 1.1 thorpej #ifdef DIOVERBOSE
257 1.1 thorpej /*
258 1.1 thorpej * Find the description matching our primary id.
259 1.1 thorpej * If we're a framebuffer, we also check the secondary id.
260 1.1 thorpej */
261 1.1 thorpej for (i = 0; i < DIO_NDEVICES; i++) {
262 1.1 thorpej if (da->da_id == dio_devdescs[i].dd_id) {
263 1.1 thorpej if (DIO_ISFRAMEBUFFER(da->da_id)) {
264 1.1 thorpej if (da->da_secid == dio_devdescs[i].dd_secid) {
265 1.1 thorpej goto foundit;
266 1.1 thorpej }
267 1.1 thorpej } else {
268 1.1 thorpej foundit:
269 1.1 thorpej sprintf(buf, "%s", dio_devdescs[i].dd_desc);
270 1.1 thorpej return (buf);
271 1.1 thorpej }
272 1.1 thorpej }
273 1.1 thorpej }
274 1.1 thorpej #endif /* DIOVERBOSE */
275 1.1 thorpej
276 1.1 thorpej /*
277 1.1 thorpej * Device is unknown. Construct something reasonable.
278 1.1 thorpej */
279 1.1 thorpej sprintf(buf, "device id = 0x%x secid = 0x%x",
280 1.1 thorpej da->da_id, da->da_secid);
281 1.1 thorpej return (buf);
282 1.7 thorpej }
283 1.7 thorpej
284 1.7 thorpej /*
285 1.7 thorpej * Establish an interrupt handler for a DIO device.
286 1.7 thorpej */
287 1.7 thorpej void *
288 1.27 thorpej dio_intr_establish(int (*func)(void *), void *arg, int ipl, int priority)
289 1.7 thorpej {
290 1.7 thorpej void *ih;
291 1.7 thorpej
292 1.7 thorpej ih = intr_establish(func, arg, ipl, priority);
293 1.7 thorpej
294 1.7 thorpej if (priority == IPL_BIO)
295 1.7 thorpej dmacomputeipl();
296 1.7 thorpej
297 1.7 thorpej return (ih);
298 1.7 thorpej }
299 1.7 thorpej
300 1.7 thorpej /*
301 1.7 thorpej * Remove an interrupt handler for a DIO device.
302 1.7 thorpej */
303 1.7 thorpej void
304 1.27 thorpej dio_intr_disestablish(void *arg)
305 1.7 thorpej {
306 1.14 gmcgarry struct hp300_intrhand *ih = arg;
307 1.14 gmcgarry int priority = ih->ih_priority;
308 1.7 thorpej
309 1.7 thorpej intr_disestablish(arg);
310 1.7 thorpej
311 1.7 thorpej if (priority == IPL_BIO)
312 1.7 thorpej dmacomputeipl();
313 1.25 tsutsui }
314 1.25 tsutsui
315 1.25 tsutsui /*
316 1.25 tsutsui * DIO specific bus_space(9) support functions.
317 1.25 tsutsui */
318 1.27 thorpej static u_int8_t dio_bus_space_read_oddbyte_1(bus_space_tag_t,
319 1.27 thorpej bus_space_handle_t, bus_size_t);
320 1.27 thorpej static void dio_bus_space_write_oddbyte_1(bus_space_tag_t,
321 1.27 thorpej bus_space_handle_t, bus_size_t, u_int8_t);
322 1.27 thorpej
323 1.27 thorpej static void dio_bus_space_read_multi_oddbyte_1(bus_space_tag_t,
324 1.27 thorpej bus_space_handle_t, bus_size_t, u_int8_t *, bus_size_t);
325 1.27 thorpej static void dio_bus_space_write_multi_oddbyte_1(bus_space_tag_t,
326 1.27 thorpej bus_space_handle_t, bus_size_t, const u_int8_t *, bus_size_t);
327 1.27 thorpej
328 1.27 thorpej static void dio_bus_space_read_region_oddbyte_1(bus_space_tag_t,
329 1.27 thorpej bus_space_handle_t, bus_size_t, u_int8_t *, bus_size_t);
330 1.27 thorpej static void dio_bus_space_write_region_oddbyte_1(bus_space_tag_t,
331 1.27 thorpej bus_space_handle_t, bus_size_t, const u_int8_t *, bus_size_t);
332 1.25 tsutsui
333 1.27 thorpej static void dio_bus_space_set_multi_oddbyte_1(bus_space_tag_t,
334 1.27 thorpej bus_space_handle_t, bus_size_t, u_int8_t, bus_size_t);
335 1.25 tsutsui
336 1.27 thorpej static void dio_bus_space_set_region_oddbyte_1(bus_space_tag_t,
337 1.27 thorpej bus_space_handle_t, bus_size_t, u_int8_t, bus_size_t);
338 1.25 tsutsui
339 1.25 tsutsui /*
340 1.25 tsutsui * dio_set_bus_space_oddbyte():
341 1.25 tsutsui * Override bus_space functions in bus_space_tag_t
342 1.25 tsutsui * for devices which have odd byte address space.
343 1.25 tsutsui */
344 1.25 tsutsui void
345 1.27 thorpej dio_set_bus_space_oddbyte(bus_space_tag_t bst)
346 1.25 tsutsui {
347 1.25 tsutsui
348 1.25 tsutsui /* XXX only 1-byte functions for now */
349 1.25 tsutsui bst->bsr1 = dio_bus_space_read_oddbyte_1;
350 1.25 tsutsui bst->bsw1 = dio_bus_space_write_oddbyte_1;
351 1.25 tsutsui
352 1.25 tsutsui bst->bsrm1 = dio_bus_space_read_multi_oddbyte_1;
353 1.25 tsutsui bst->bswm1 = dio_bus_space_write_multi_oddbyte_1;
354 1.25 tsutsui
355 1.25 tsutsui bst->bsrr1 = dio_bus_space_read_region_oddbyte_1;
356 1.25 tsutsui bst->bswr1 = dio_bus_space_write_region_oddbyte_1;
357 1.25 tsutsui
358 1.25 tsutsui bst->bssm1 = dio_bus_space_set_multi_oddbyte_1;
359 1.25 tsutsui
360 1.25 tsutsui bst->bssr1 = dio_bus_space_set_region_oddbyte_1;
361 1.25 tsutsui }
362 1.25 tsutsui
363 1.25 tsutsui static u_int8_t
364 1.27 thorpej dio_bus_space_read_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
365 1.27 thorpej bus_size_t offset)
366 1.25 tsutsui {
367 1.25 tsutsui
368 1.25 tsutsui return *(volatile u_int8_t *)(bsh + (offset << 1) + 1);
369 1.25 tsutsui }
370 1.25 tsutsui
371 1.27 thorpej static void
372 1.27 thorpej dio_bus_space_write_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
373 1.27 thorpej bus_size_t offset, u_int8_t val)
374 1.25 tsutsui {
375 1.25 tsutsui
376 1.25 tsutsui *(volatile u_int8_t *)(bsh + (offset << 1) + 1) = val;
377 1.25 tsutsui }
378 1.25 tsutsui
379 1.25 tsutsui static void
380 1.27 thorpej dio_bus_space_read_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
381 1.27 thorpej bus_size_t offset, u_int8_t *addr, bus_size_t len)
382 1.25 tsutsui {
383 1.25 tsutsui
384 1.25 tsutsui __asm __volatile (
385 1.25 tsutsui " movl %0,%%a0 ;\n"
386 1.25 tsutsui " movl %1,%%a1 ;\n"
387 1.25 tsutsui " movl %2,%%d0 ;\n"
388 1.25 tsutsui "1: movb %%a0@,%%a1@+ ;\n"
389 1.25 tsutsui " subql #1,%%d0 ;\n"
390 1.25 tsutsui " jne 1b"
391 1.25 tsutsui :
392 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
393 1.25 tsutsui : "%a0","%a1","%d0");
394 1.25 tsutsui }
395 1.25 tsutsui
396 1.25 tsutsui static void
397 1.27 thorpej dio_bus_space_write_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
398 1.27 thorpej bus_size_t offset, const u_int8_t *addr, bus_size_t len)
399 1.25 tsutsui {
400 1.25 tsutsui
401 1.25 tsutsui __asm __volatile (
402 1.25 tsutsui " movl %0,%%a0 ;\n"
403 1.25 tsutsui " movl %1,%%a1 ;\n"
404 1.25 tsutsui " movl %2,%%d0 ;\n"
405 1.25 tsutsui "1: movb %%a1@+,%%a0@ ;\n"
406 1.25 tsutsui " subql #1,%%d0 ;\n"
407 1.25 tsutsui " jne 1b"
408 1.25 tsutsui :
409 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
410 1.25 tsutsui : "%a0","%a1","%d0");
411 1.25 tsutsui }
412 1.25 tsutsui
413 1.25 tsutsui static void
414 1.27 thorpej dio_bus_space_read_region_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
415 1.27 thorpej bus_size_t offset, u_int8_t *addr, bus_size_t len)
416 1.25 tsutsui {
417 1.25 tsutsui __asm __volatile (
418 1.25 tsutsui " movl %0,%%a0 ;\n"
419 1.25 tsutsui " movl %1,%%a1 ;\n"
420 1.25 tsutsui " movl %2,%%d0 ;\n"
421 1.25 tsutsui "1: movb %%a0@,%%a1@+ ;\n"
422 1.25 tsutsui " addql #2,%%a0 ;\n"
423 1.25 tsutsui " subql #1,%%d0 ;\n"
424 1.25 tsutsui " jne 1b"
425 1.25 tsutsui :
426 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
427 1.25 tsutsui : "%a0","%a1","%d0");
428 1.25 tsutsui }
429 1.25 tsutsui
430 1.25 tsutsui static void
431 1.27 thorpej dio_bus_space_write_region_oddbyte_1(bus_space_tag_t bst,
432 1.27 thorpej bus_space_handle_t bsh, bus_size_t offset, const u_int8_t *addr,
433 1.27 thorpej bus_size_t len)
434 1.25 tsutsui {
435 1.25 tsutsui
436 1.25 tsutsui __asm __volatile (
437 1.25 tsutsui " movl %0,%%a0 ;\n"
438 1.25 tsutsui " movl %1,%%a1 ;\n"
439 1.25 tsutsui " movl %2,%%d0 ;\n"
440 1.25 tsutsui "1: movb %%a1@+,%%a0@ ;\n"
441 1.25 tsutsui " addql #2,%%a0 ;\n"
442 1.25 tsutsui " subql #1,%%d0 ;\n"
443 1.25 tsutsui " jne 1b"
444 1.25 tsutsui :
445 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
446 1.25 tsutsui : "%a0","%a1","%d0");
447 1.25 tsutsui }
448 1.25 tsutsui
449 1.25 tsutsui static void
450 1.27 thorpej dio_bus_space_set_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
451 1.27 thorpej bus_size_t offset, u_int8_t val, bus_size_t count)
452 1.25 tsutsui {
453 1.25 tsutsui __asm __volatile (
454 1.25 tsutsui " movl %0,%%a0 ;\n"
455 1.25 tsutsui " movl %1,%%d1 ;\n"
456 1.25 tsutsui " movl %2,%%d0 ;\n"
457 1.25 tsutsui "1: movb %%d1,%%a0@ ;\n"
458 1.25 tsutsui " subql #1,%%d0 ;\n"
459 1.25 tsutsui " jne 1b"
460 1.25 tsutsui :
461 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
462 1.25 tsutsui : "%a0","%d0","%d1");
463 1.25 tsutsui }
464 1.25 tsutsui
465 1.25 tsutsui static void
466 1.27 thorpej dio_bus_space_set_region_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
467 1.27 thorpej bus_size_t offset, u_int8_t val, bus_size_t count)
468 1.25 tsutsui {
469 1.25 tsutsui
470 1.25 tsutsui __asm __volatile (
471 1.25 tsutsui " movl %0,%%a0 ;\n"
472 1.25 tsutsui " movl %1,%%d1 ;\n"
473 1.25 tsutsui " movl %2,%%d0 ;\n"
474 1.25 tsutsui "1: movb %%d1,%%a0@ ;\n"
475 1.25 tsutsui " addql #2,%%a0 ;\n"
476 1.25 tsutsui " subql #1,%%d0 ;\n"
477 1.25 tsutsui " jne 1b"
478 1.25 tsutsui :
479 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
480 1.25 tsutsui : "%a0","%d0","%d1");
481 1.1 thorpej }
482