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