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