dio.c revision 1.40 1 1.40 thorpej /* $NetBSD: dio.c,v 1.40 2021/04/24 23:36:37 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.40 thorpej __KERNEL_RCSID(0, "$NetBSD: dio.c,v 1.40 2021/04/24 23:36:37 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.40 thorpej CFARG_SUBMATCH, diosubmatch,
159 1.40 thorpej CFARG_EOL);
160 1.1 thorpej scode += scodesize;
161 1.1 thorpej }
162 1.1 thorpej }
163 1.1 thorpej
164 1.27 thorpej static int
165 1.36 tsutsui diosubmatch(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
166 1.1 thorpej {
167 1.1 thorpej struct dio_attach_args *da = aux;
168 1.1 thorpej
169 1.8 jtk if (cf->diocf_scode != DIOCF_SCODE_DEFAULT &&
170 1.1 thorpej cf->diocf_scode != da->da_scode)
171 1.33 tsutsui return 0;
172 1.1 thorpej
173 1.33 tsutsui return config_match(parent, cf, aux);
174 1.1 thorpej }
175 1.1 thorpej
176 1.27 thorpej static int
177 1.27 thorpej dioprint(void *aux, const char *pnp)
178 1.1 thorpej {
179 1.1 thorpej struct dio_attach_args *da = aux;
180 1.1 thorpej char buf[128];
181 1.1 thorpej
182 1.1 thorpej if (pnp)
183 1.21 thorpej aprint_normal("%s at %s",
184 1.21 thorpej dio_devinfo(da, buf, sizeof(buf)), pnp);
185 1.23 gmcgarry aprint_normal(" scode %d ipl %d", da->da_scode, da->da_ipl);
186 1.33 tsutsui return UNCONF;
187 1.1 thorpej }
188 1.1 thorpej
189 1.1 thorpej /*
190 1.1 thorpej * Convert a select code to a system physical address.
191 1.1 thorpej */
192 1.1 thorpej void *
193 1.27 thorpej dio_scodetopa(int scode)
194 1.1 thorpej {
195 1.1 thorpej u_long rval;
196 1.1 thorpej
197 1.23 gmcgarry if (DIO_ISDIO(scode))
198 1.1 thorpej rval = DIO_BASE + (scode * DIO_DEVSIZE);
199 1.1 thorpej else if (DIO_ISDIOII(scode))
200 1.2 thorpej rval = DIOII_BASE + ((scode - DIOII_SCBASE) * DIOII_DEVSIZE);
201 1.1 thorpej else
202 1.1 thorpej rval = 0;
203 1.1 thorpej
204 1.33 tsutsui return (void *)rval;
205 1.1 thorpej }
206 1.1 thorpej
207 1.1 thorpej /*
208 1.1 thorpej * Return the select code size for this device, defaulting to 1
209 1.1 thorpej * if we don't know what kind of device we have.
210 1.1 thorpej */
211 1.23 gmcgarry static int
212 1.27 thorpej dio_scodesize(struct dio_attach_args *da)
213 1.1 thorpej {
214 1.1 thorpej int i;
215 1.1 thorpej
216 1.1 thorpej /*
217 1.1 thorpej * Find the dio_devdata matchind the primary id.
218 1.1 thorpej * If we're a framebuffer, we also check the secondary id.
219 1.1 thorpej */
220 1.1 thorpej for (i = 0; i < DIO_NDEVICES; i++) {
221 1.1 thorpej if (da->da_id == dio_devdatas[i].dd_id) {
222 1.1 thorpej if (DIO_ISFRAMEBUFFER(da->da_id)) {
223 1.1 thorpej if (da->da_secid == dio_devdatas[i].dd_secid) {
224 1.1 thorpej goto foundit;
225 1.1 thorpej }
226 1.1 thorpej } else {
227 1.36 tsutsui foundit:
228 1.33 tsutsui return dio_devdatas[i].dd_nscode;
229 1.1 thorpej }
230 1.1 thorpej }
231 1.1 thorpej }
232 1.1 thorpej
233 1.1 thorpej /*
234 1.1 thorpej * Device is unknown. Print a warning and assume a default.
235 1.1 thorpej */
236 1.36 tsutsui aprint_error("WARNING: select code size unknown "
237 1.36 tsutsui "for id = 0x%x secid = 0x%x\n",
238 1.1 thorpej da->da_id, da->da_secid);
239 1.33 tsutsui return 1;
240 1.1 thorpej }
241 1.1 thorpej
242 1.1 thorpej /*
243 1.1 thorpej * Return a reasonable description of a DIO device.
244 1.1 thorpej */
245 1.27 thorpej static const char *
246 1.27 thorpej dio_devinfo(struct dio_attach_args *da, char *buf, size_t buflen)
247 1.1 thorpej {
248 1.5 thorpej #ifdef DIOVERBOSE
249 1.1 thorpej int i;
250 1.5 thorpej #endif
251 1.1 thorpej
252 1.14 gmcgarry memset(buf, 0, buflen);
253 1.1 thorpej
254 1.1 thorpej #ifdef DIOVERBOSE
255 1.1 thorpej /*
256 1.1 thorpej * Find the description matching our primary id.
257 1.1 thorpej * If we're a framebuffer, we also check the secondary id.
258 1.1 thorpej */
259 1.1 thorpej for (i = 0; i < DIO_NDEVICES; i++) {
260 1.1 thorpej if (da->da_id == dio_devdescs[i].dd_id) {
261 1.1 thorpej if (DIO_ISFRAMEBUFFER(da->da_id)) {
262 1.1 thorpej if (da->da_secid == dio_devdescs[i].dd_secid) {
263 1.1 thorpej goto foundit;
264 1.1 thorpej }
265 1.1 thorpej } else {
266 1.1 thorpej foundit:
267 1.39 christos snprintf(buf, buflen, "%s",
268 1.39 christos dio_devdescs[i].dd_desc);
269 1.33 tsutsui return buf;
270 1.1 thorpej }
271 1.1 thorpej }
272 1.1 thorpej }
273 1.1 thorpej #endif /* DIOVERBOSE */
274 1.1 thorpej
275 1.1 thorpej /*
276 1.1 thorpej * Device is unknown. Construct something reasonable.
277 1.1 thorpej */
278 1.39 christos snprintf(buf, buflen, "device id = 0x%x secid = 0x%x",
279 1.1 thorpej da->da_id, da->da_secid);
280 1.33 tsutsui return buf;
281 1.7 thorpej }
282 1.7 thorpej
283 1.7 thorpej /*
284 1.7 thorpej * Establish an interrupt handler for a DIO device.
285 1.7 thorpej */
286 1.7 thorpej void *
287 1.27 thorpej dio_intr_establish(int (*func)(void *), void *arg, int ipl, int priority)
288 1.7 thorpej {
289 1.7 thorpej void *ih;
290 1.7 thorpej
291 1.7 thorpej ih = intr_establish(func, arg, ipl, priority);
292 1.7 thorpej
293 1.7 thorpej if (priority == IPL_BIO)
294 1.7 thorpej dmacomputeipl();
295 1.7 thorpej
296 1.33 tsutsui return ih;
297 1.7 thorpej }
298 1.7 thorpej
299 1.7 thorpej /*
300 1.7 thorpej * Remove an interrupt handler for a DIO device.
301 1.7 thorpej */
302 1.7 thorpej void
303 1.27 thorpej dio_intr_disestablish(void *arg)
304 1.7 thorpej {
305 1.14 gmcgarry struct hp300_intrhand *ih = arg;
306 1.14 gmcgarry int priority = ih->ih_priority;
307 1.7 thorpej
308 1.7 thorpej intr_disestablish(arg);
309 1.7 thorpej
310 1.7 thorpej if (priority == IPL_BIO)
311 1.7 thorpej dmacomputeipl();
312 1.25 tsutsui }
313 1.25 tsutsui
314 1.25 tsutsui /*
315 1.25 tsutsui * DIO specific bus_space(9) support functions.
316 1.25 tsutsui */
317 1.28 tsutsui static uint8_t dio_bus_space_read_oddbyte_1(bus_space_tag_t,
318 1.27 thorpej bus_space_handle_t, bus_size_t);
319 1.27 thorpej static void dio_bus_space_write_oddbyte_1(bus_space_tag_t,
320 1.28 tsutsui bus_space_handle_t, bus_size_t, uint8_t);
321 1.27 thorpej
322 1.27 thorpej static void dio_bus_space_read_multi_oddbyte_1(bus_space_tag_t,
323 1.28 tsutsui bus_space_handle_t, bus_size_t, uint8_t *, bus_size_t);
324 1.27 thorpej static void dio_bus_space_write_multi_oddbyte_1(bus_space_tag_t,
325 1.28 tsutsui bus_space_handle_t, bus_size_t, const uint8_t *, bus_size_t);
326 1.27 thorpej
327 1.27 thorpej static void dio_bus_space_read_region_oddbyte_1(bus_space_tag_t,
328 1.28 tsutsui bus_space_handle_t, bus_size_t, uint8_t *, bus_size_t);
329 1.27 thorpej static void dio_bus_space_write_region_oddbyte_1(bus_space_tag_t,
330 1.28 tsutsui bus_space_handle_t, bus_size_t, const uint8_t *, bus_size_t);
331 1.25 tsutsui
332 1.27 thorpej static void dio_bus_space_set_multi_oddbyte_1(bus_space_tag_t,
333 1.28 tsutsui bus_space_handle_t, bus_size_t, uint8_t, bus_size_t);
334 1.25 tsutsui
335 1.27 thorpej static void dio_bus_space_set_region_oddbyte_1(bus_space_tag_t,
336 1.28 tsutsui bus_space_handle_t, bus_size_t, uint8_t, bus_size_t);
337 1.25 tsutsui
338 1.25 tsutsui /*
339 1.25 tsutsui * dio_set_bus_space_oddbyte():
340 1.25 tsutsui * Override bus_space functions in bus_space_tag_t
341 1.25 tsutsui * for devices which have odd byte address space.
342 1.25 tsutsui */
343 1.25 tsutsui void
344 1.27 thorpej dio_set_bus_space_oddbyte(bus_space_tag_t bst)
345 1.25 tsutsui {
346 1.25 tsutsui
347 1.25 tsutsui /* XXX only 1-byte functions for now */
348 1.25 tsutsui bst->bsr1 = dio_bus_space_read_oddbyte_1;
349 1.25 tsutsui bst->bsw1 = dio_bus_space_write_oddbyte_1;
350 1.25 tsutsui
351 1.25 tsutsui bst->bsrm1 = dio_bus_space_read_multi_oddbyte_1;
352 1.25 tsutsui bst->bswm1 = dio_bus_space_write_multi_oddbyte_1;
353 1.25 tsutsui
354 1.25 tsutsui bst->bsrr1 = dio_bus_space_read_region_oddbyte_1;
355 1.25 tsutsui bst->bswr1 = dio_bus_space_write_region_oddbyte_1;
356 1.25 tsutsui
357 1.25 tsutsui bst->bssm1 = dio_bus_space_set_multi_oddbyte_1;
358 1.25 tsutsui
359 1.25 tsutsui bst->bssr1 = dio_bus_space_set_region_oddbyte_1;
360 1.25 tsutsui }
361 1.25 tsutsui
362 1.28 tsutsui static uint8_t
363 1.27 thorpej dio_bus_space_read_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
364 1.27 thorpej bus_size_t offset)
365 1.25 tsutsui {
366 1.25 tsutsui
367 1.28 tsutsui return *(volatile uint8_t *)(bsh + (offset << 1) + 1);
368 1.25 tsutsui }
369 1.25 tsutsui
370 1.38 tsutsui static void
371 1.27 thorpej dio_bus_space_write_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
372 1.28 tsutsui bus_size_t offset, uint8_t val)
373 1.25 tsutsui {
374 1.25 tsutsui
375 1.28 tsutsui *(volatile uint8_t *)(bsh + (offset << 1) + 1) = val;
376 1.25 tsutsui }
377 1.25 tsutsui
378 1.25 tsutsui static void
379 1.27 thorpej dio_bus_space_read_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
380 1.28 tsutsui bus_size_t offset, uint8_t *addr, bus_size_t len)
381 1.25 tsutsui {
382 1.25 tsutsui
383 1.32 perry __asm volatile (
384 1.25 tsutsui " movl %0,%%a0 ;\n"
385 1.25 tsutsui " movl %1,%%a1 ;\n"
386 1.25 tsutsui " movl %2,%%d0 ;\n"
387 1.25 tsutsui "1: movb %%a0@,%%a1@+ ;\n"
388 1.25 tsutsui " subql #1,%%d0 ;\n"
389 1.25 tsutsui " jne 1b"
390 1.25 tsutsui :
391 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
392 1.25 tsutsui : "%a0","%a1","%d0");
393 1.25 tsutsui }
394 1.25 tsutsui
395 1.25 tsutsui static void
396 1.27 thorpej dio_bus_space_write_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
397 1.28 tsutsui bus_size_t offset, const uint8_t *addr, bus_size_t len)
398 1.25 tsutsui {
399 1.25 tsutsui
400 1.32 perry __asm volatile (
401 1.25 tsutsui " movl %0,%%a0 ;\n"
402 1.25 tsutsui " movl %1,%%a1 ;\n"
403 1.25 tsutsui " movl %2,%%d0 ;\n"
404 1.25 tsutsui "1: movb %%a1@+,%%a0@ ;\n"
405 1.25 tsutsui " subql #1,%%d0 ;\n"
406 1.25 tsutsui " jne 1b"
407 1.25 tsutsui :
408 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
409 1.25 tsutsui : "%a0","%a1","%d0");
410 1.25 tsutsui }
411 1.25 tsutsui
412 1.25 tsutsui static void
413 1.27 thorpej dio_bus_space_read_region_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
414 1.28 tsutsui bus_size_t offset, uint8_t *addr, bus_size_t len)
415 1.25 tsutsui {
416 1.32 perry __asm volatile (
417 1.25 tsutsui " movl %0,%%a0 ;\n"
418 1.25 tsutsui " movl %1,%%a1 ;\n"
419 1.25 tsutsui " movl %2,%%d0 ;\n"
420 1.25 tsutsui "1: movb %%a0@,%%a1@+ ;\n"
421 1.25 tsutsui " addql #2,%%a0 ;\n"
422 1.25 tsutsui " subql #1,%%d0 ;\n"
423 1.25 tsutsui " jne 1b"
424 1.25 tsutsui :
425 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
426 1.25 tsutsui : "%a0","%a1","%d0");
427 1.25 tsutsui }
428 1.25 tsutsui
429 1.25 tsutsui static void
430 1.27 thorpej dio_bus_space_write_region_oddbyte_1(bus_space_tag_t bst,
431 1.28 tsutsui bus_space_handle_t bsh, bus_size_t offset, const uint8_t *addr,
432 1.27 thorpej bus_size_t len)
433 1.25 tsutsui {
434 1.25 tsutsui
435 1.32 perry __asm volatile (
436 1.25 tsutsui " movl %0,%%a0 ;\n"
437 1.25 tsutsui " movl %1,%%a1 ;\n"
438 1.25 tsutsui " movl %2,%%d0 ;\n"
439 1.25 tsutsui "1: movb %%a1@+,%%a0@ ;\n"
440 1.25 tsutsui " addql #2,%%a0 ;\n"
441 1.25 tsutsui " subql #1,%%d0 ;\n"
442 1.25 tsutsui " jne 1b"
443 1.25 tsutsui :
444 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
445 1.25 tsutsui : "%a0","%a1","%d0");
446 1.25 tsutsui }
447 1.25 tsutsui
448 1.25 tsutsui static void
449 1.27 thorpej dio_bus_space_set_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
450 1.28 tsutsui bus_size_t offset, uint8_t val, bus_size_t count)
451 1.25 tsutsui {
452 1.32 perry __asm volatile (
453 1.25 tsutsui " movl %0,%%a0 ;\n"
454 1.25 tsutsui " movl %1,%%d1 ;\n"
455 1.25 tsutsui " movl %2,%%d0 ;\n"
456 1.25 tsutsui "1: movb %%d1,%%a0@ ;\n"
457 1.25 tsutsui " subql #1,%%d0 ;\n"
458 1.25 tsutsui " jne 1b"
459 1.25 tsutsui :
460 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
461 1.25 tsutsui : "%a0","%d0","%d1");
462 1.25 tsutsui }
463 1.25 tsutsui
464 1.25 tsutsui static void
465 1.27 thorpej dio_bus_space_set_region_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
466 1.28 tsutsui bus_size_t offset, uint8_t val, bus_size_t count)
467 1.25 tsutsui {
468 1.25 tsutsui
469 1.32 perry __asm volatile (
470 1.25 tsutsui " movl %0,%%a0 ;\n"
471 1.25 tsutsui " movl %1,%%d1 ;\n"
472 1.25 tsutsui " movl %2,%%d0 ;\n"
473 1.25 tsutsui "1: movb %%d1,%%a0@ ;\n"
474 1.25 tsutsui " addql #2,%%a0 ;\n"
475 1.25 tsutsui " subql #1,%%d0 ;\n"
476 1.25 tsutsui " jne 1b"
477 1.25 tsutsui :
478 1.25 tsutsui : "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
479 1.25 tsutsui : "%a0","%d0","%d1");
480 1.1 thorpej }
481