xref: /netbsd-src/sys/arch/mips/rmi/rmixl_nand.c (revision d702511000114b76d34ff807058b279d2515a935)
1*d7025110Sriastradh /*	$NetBSD: rmixl_nand.c,v 1.8 2023/05/10 00:07:58 riastradh Exp $	*/
2420e2584Scliff 
3420e2584Scliff /*-
4420e2584Scliff  * Copyright (c) 2010 Department of Software Engineering,
5420e2584Scliff  *		      University of Szeged, Hungary
6420e2584Scliff  * Copyright (c) 2010 Adam Hoka <ahoka@NetBSD.org>
7420e2584Scliff  * All rights reserved.
8420e2584Scliff  *
9420e2584Scliff  * This code is derived from software contributed to The NetBSD Foundation
10420e2584Scliff  * by the Department of Software Engineering, University of Szeged, Hungary
11420e2584Scliff  *
12420e2584Scliff  * Redistribution and use in source and binary forms, with or without
13420e2584Scliff  * modification, are permitted provided that the following conditions
14420e2584Scliff  * are met:
15420e2584Scliff  * 1. Redistributions of source code must retain the above copyright
16420e2584Scliff  *    notice, this list of conditions and the following disclaimer.
17420e2584Scliff  * 2. Redistributions in binary form must reproduce the above copyright
18420e2584Scliff  *    notice, this list of conditions and the following disclaimer in the
19420e2584Scliff  *    documentation and/or other materials provided with the distribution.
20420e2584Scliff  *
21420e2584Scliff  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22420e2584Scliff  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23420e2584Scliff  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24420e2584Scliff  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25420e2584Scliff  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
26420e2584Scliff  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27420e2584Scliff  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
28420e2584Scliff  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
29420e2584Scliff  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30420e2584Scliff  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31420e2584Scliff  * SUCH DAMAGE.
32420e2584Scliff  */
33420e2584Scliff 
34420e2584Scliff /*
35420e2584Scliff  * Device driver for the RMI XLS NAND controller
36420e2584Scliff  */
37420e2584Scliff 
38420e2584Scliff #include <sys/cdefs.h>
39*d7025110Sriastradh __KERNEL_RCSID(0, "$NetBSD: rmixl_nand.c,v 1.8 2023/05/10 00:07:58 riastradh Exp $");
40420e2584Scliff 
41420e2584Scliff #include "opt_flash.h"
42420e2584Scliff 
43420e2584Scliff #include <sys/param.h>
44420e2584Scliff #include <sys/systm.h>
45420e2584Scliff #include <sys/cdefs.h>
46420e2584Scliff #include <sys/device.h>
47420e2584Scliff #include <sys/endian.h>
48420e2584Scliff 
49cf10107dSdyoung #include <sys/bus.h>
50420e2584Scliff 
51420e2584Scliff #include <mips/rmi/rmixlreg.h>
52420e2584Scliff #include <mips/rmi/rmixlvar.h>
53420e2584Scliff #include <mips/rmi/rmixl_iobusvar.h>
54420e2584Scliff #include <mips/rmi/rmixl_intr.h>
55420e2584Scliff 
56420e2584Scliff #include <dev/nand/nand.h>
57420e2584Scliff #include <dev/nand/onfi.h>
58420e2584Scliff 
59420e2584Scliff 
60df950be7Scliff static int  rmixl_nand_match(device_t, cfdata_t, void *);
61df950be7Scliff static void rmixl_nand_attach(device_t, device_t, void *);
62420e2584Scliff static int  rmixl_nand_detach(device_t, int);
63420e2584Scliff static void rmixl_nand_command(device_t, uint8_t);
64420e2584Scliff static void rmixl_nand_address(device_t, uint8_t);
65420e2584Scliff static void rmixl_nand_busy(device_t);
66feeeb205Sahoka static void rmixl_nand_read_1(device_t, uint8_t *);
67feeeb205Sahoka static void rmixl_nand_write_1(device_t, uint8_t);
68feeeb205Sahoka static void rmixl_nand_read_2(device_t, uint16_t *);
69feeeb205Sahoka static void rmixl_nand_write_2(device_t, uint16_t);
70420e2584Scliff static void rmixl_nand_read_buf(device_t, void *, size_t);
71420e2584Scliff static void rmixl_nand_write_buf(device_t, const void *, size_t);
72420e2584Scliff 
73420e2584Scliff 
74420e2584Scliff struct rmixl_nand_softc {
75420e2584Scliff 	device_t sc_dev;
76420e2584Scliff 	device_t sc_nanddev;
77420e2584Scliff 	struct iobus_softc *sc_iobus_sc;
78420e2584Scliff 
79420e2584Scliff 	int			sc_cs;		/* chip select index */
80420e2584Scliff 	int			sc_buswidth;	/* in bytes */
81420e2584Scliff 
82420e2584Scliff 	struct nand_interface	sc_nand_if;
83420e2584Scliff 
84420e2584Scliff 	bus_space_tag_t		sc_obio_bst;
85420e2584Scliff 	bus_space_handle_t	sc_obio_bsh;
86420e2584Scliff 	u_long			sc_cmd_reg;
87420e2584Scliff 	u_long			sc_addr_reg;
88420e2584Scliff 
89420e2584Scliff 	bus_addr_t		sc_iobus_addr;
90420e2584Scliff 	bus_size_t		sc_iobus_size;
91420e2584Scliff 	bus_space_tag_t		sc_iobus_bst;
92420e2584Scliff 	bus_space_handle_t	sc_iobus_bsh;
93420e2584Scliff 	u_long			sc_data_reg;
94420e2584Scliff 
95420e2584Scliff };
96420e2584Scliff 
97420e2584Scliff CFATTACH_DECL_NEW(rmixl_nand, sizeof(struct rmixl_nand_softc), rmixl_nand_match,
98420e2584Scliff     rmixl_nand_attach, rmixl_nand_detach, NULL);
99420e2584Scliff 
100420e2584Scliff static int
rmixl_nand_match(device_t parent,cfdata_t match,void * aux)101df950be7Scliff rmixl_nand_match(device_t parent, cfdata_t match, void *aux)
102420e2584Scliff {
103420e2584Scliff 	struct rmixl_iobus_attach_args *ia = aux;
104420e2584Scliff 	bus_space_handle_t bsh;
105420e2584Scliff 	volatile uint32_t *vaddr;
106420e2584Scliff 	int err;
1078a8c6da9Scliff 	int rv;
108420e2584Scliff 
109420e2584Scliff 	if ((ia->ia_dev_parm & RMIXL_FLASH_CSDEV_NANDEN) == 0)
1108a8c6da9Scliff 		return 0;	/* not NAND */
111420e2584Scliff 
112420e2584Scliff 	if (cpu_rmixlp(mips_options.mips_cpu)) {
113420e2584Scliff 		aprint_error("%s: NAND not yet supported on XLP", __func__);
1148a8c6da9Scliff 		return 0;
115420e2584Scliff 	}
116420e2584Scliff 
117420e2584Scliff 	if (! cpu_rmixls(mips_options.mips_cpu)) {
118420e2584Scliff 		aprint_error("%s: NAND not supported on this processor",
119420e2584Scliff 			__func__);
1208a8c6da9Scliff 		return 0;
121420e2584Scliff 	}
122420e2584Scliff 
123420e2584Scliff 	/*
124420e2584Scliff 	 * probe for NAND -- this may be redundant
125420e2584Scliff 	 * if the device isn't there, the NANDEN test (above)
126420e2584Scliff 	 * should have failed
127420e2584Scliff 	 */
128420e2584Scliff 	err = bus_space_map(ia->ia_iobus_bst, ia->ia_iobus_addr,
129420e2584Scliff 		sizeof(uint32_t), 0, &bsh);
130420e2584Scliff 	if (err != 0) {
131420e2584Scliff 		aprint_debug("%s: bus_space_map err %d, "
132420e2584Scliff 			"iobus space addr %#" PRIxBUSADDR "\n",
133420e2584Scliff 			__func__, err, ia->ia_iobus_addr);
1348a8c6da9Scliff 		return 0;
135420e2584Scliff 	}
136420e2584Scliff 
137420e2584Scliff 	vaddr = bus_space_vaddr(ia->ia_iobus_bst, bsh);
138420e2584Scliff 	rv = rmixl_probe_4(vaddr);
139420e2584Scliff 	if (rv == 0)
140420e2584Scliff 		aprint_debug("%s: rmixl_probe_4 failed, vaddr %p\n",
141420e2584Scliff 			__func__, vaddr);
142420e2584Scliff 
143420e2584Scliff 	bus_space_unmap(ia->ia_iobus_bst, bsh, sizeof(uint32_t));
144420e2584Scliff 
145420e2584Scliff 	return rv;
146420e2584Scliff }
147420e2584Scliff 
148420e2584Scliff static void
rmixl_nand_attach(device_t parent,device_t self,void * aux)149420e2584Scliff rmixl_nand_attach(device_t parent, device_t self, void *aux)
150420e2584Scliff {
151420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
152420e2584Scliff 	sc->sc_iobus_sc = device_private(parent);
153420e2584Scliff 	struct rmixl_iobus_attach_args *ia = aux;
154420e2584Scliff 	uint32_t val;
155420e2584Scliff 	int err;
156420e2584Scliff 
157420e2584Scliff 	aprint_normal("\n");
158420e2584Scliff 
159420e2584Scliff 	sc->sc_dev = self;
160420e2584Scliff 	sc->sc_obio_bst = ia->ia_obio_bst;
161420e2584Scliff 	sc->sc_obio_bsh = ia->ia_obio_bsh;
162420e2584Scliff 	sc->sc_iobus_bst = ia->ia_iobus_bst;
163420e2584Scliff 	sc->sc_iobus_addr = ia->ia_iobus_addr;
164420e2584Scliff 	sc->sc_iobus_size = sizeof(uint32_t);
165420e2584Scliff 	sc->sc_cs = ia->ia_cs;
166420e2584Scliff 
167420e2584Scliff         sc->sc_cmd_reg = RMIXL_NAND_CLEn(ia->ia_cs);
168420e2584Scliff 	sc->sc_addr_reg = RMIXL_NAND_ALEn(ia->ia_cs);
169420e2584Scliff 
170420e2584Scliff 	aprint_debug_dev(self, "CS#%d cstime_parma %#x, cstime_parmb %#x\n",
171420e2584Scliff 		ia->ia_cs,
172420e2584Scliff 		bus_space_read_4(sc->sc_obio_bst, sc->sc_obio_bsh,
173420e2584Scliff 			RMIXL_FLASH_CSTIME_PARMAn(ia->ia_cs)),
174420e2584Scliff 		bus_space_read_4(sc->sc_obio_bst, sc->sc_obio_bsh,
175420e2584Scliff 			RMIXL_FLASH_CSTIME_PARMBn(ia->ia_cs)));
176420e2584Scliff 
177420e2584Scliff 	err = bus_space_map(sc->sc_iobus_bst, sc->sc_iobus_addr,
178420e2584Scliff 		sc->sc_iobus_size, 0, &sc->sc_iobus_bsh);
179420e2584Scliff 	if (err != 0) {
180420e2584Scliff 		aprint_error_dev(self,
181420e2584Scliff 			"bus space map err %d, iobus space\n", err);
182420e2584Scliff 		return;
183420e2584Scliff 	}
184420e2584Scliff 
185420e2584Scliff 	/*
186420e2584Scliff 	 * determine buswidth
187420e2584Scliff 	 */
188420e2584Scliff 	val = ia->ia_dev_parm;
189420e2584Scliff 	val &= RMIXL_FLASH_CSDEV_DWIDTH;
190420e2584Scliff 	val >>= RMIXL_FLASH_CSDEV_DWIDTH_SHFT;
191420e2584Scliff 	switch(val) {
192420e2584Scliff 	case 0:	/* FALLTHROUGH */
193420e2584Scliff 	case 3:
194420e2584Scliff 		sc->sc_buswidth = 1;	/* 8 bit */
195420e2584Scliff 		break;
196420e2584Scliff 	case 1:
197420e2584Scliff 		sc->sc_buswidth = 2;	/* 16 bit */
198420e2584Scliff 		break;
199420e2584Scliff 	case 2:
200420e2584Scliff 		sc->sc_buswidth = 4;	/* 32 bit */
201420e2584Scliff 		break;
202420e2584Scliff 	}
2038a8c6da9Scliff 	aprint_debug_dev(self, "bus width %d bits\n", 8 * sc->sc_buswidth);
204420e2584Scliff 
2059e1e81e9Sahoka 	nand_init_interface(&sc->sc_nand_if);
2069e1e81e9Sahoka 
207df950be7Scliff 	sc->sc_nand_if.command = rmixl_nand_command;
208df950be7Scliff 	sc->sc_nand_if.address = rmixl_nand_address;
209feeeb205Sahoka 	sc->sc_nand_if.read_buf_1 = rmixl_nand_read_buf;
210feeeb205Sahoka 	sc->sc_nand_if.read_buf_2 = rmixl_nand_read_buf;
211feeeb205Sahoka 	sc->sc_nand_if.read_1 = rmixl_nand_read_1;
212feeeb205Sahoka 	sc->sc_nand_if.read_2 = rmixl_nand_read_2;
213feeeb205Sahoka 	sc->sc_nand_if.write_buf_1 = rmixl_nand_write_buf;
214feeeb205Sahoka 	sc->sc_nand_if.write_buf_2 = rmixl_nand_write_buf;
215feeeb205Sahoka 	sc->sc_nand_if.write_1 = rmixl_nand_write_1;
216feeeb205Sahoka 	sc->sc_nand_if.write_2 = rmixl_nand_write_2;
217df950be7Scliff 	sc->sc_nand_if.busy = rmixl_nand_busy;
218420e2584Scliff 
219420e2584Scliff 	sc->sc_nand_if.ecc.necc_code_size = 3;
220420e2584Scliff 	sc->sc_nand_if.ecc.necc_block_size = 256;
221420e2584Scliff 
222420e2584Scliff 	/*
223420e2584Scliff 	 * reset to get NAND into known state
224420e2584Scliff 	 */
225420e2584Scliff 	rmixl_nand_command(self, ONFI_RESET);
226420e2584Scliff 	rmixl_nand_busy(self);
227420e2584Scliff 
228420e2584Scliff 	if (! pmf_device_register1(self, NULL, NULL, NULL))
229420e2584Scliff 		aprint_error_dev(self, "couldn't establish power handler\n");
230420e2584Scliff 
231420e2584Scliff 	sc->sc_nanddev = nand_attach_mi(&sc->sc_nand_if, self);
232420e2584Scliff }
233420e2584Scliff 
234420e2584Scliff static int
rmixl_nand_detach(device_t self,int flags)235420e2584Scliff rmixl_nand_detach(device_t self, int flags)
236420e2584Scliff {
237420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
238*d7025110Sriastradh 	int error;
239*d7025110Sriastradh 
240*d7025110Sriastradh 	error = config_detach_children(self, flags);
241*d7025110Sriastradh 	if (error)
242*d7025110Sriastradh 		return error;
243420e2584Scliff 
244420e2584Scliff 	pmf_device_deregister(self);
245420e2584Scliff 
2468a8c6da9Scliff 	bus_space_unmap(sc->sc_iobus_bst, sc->sc_iobus_bsh, sc->sc_iobus_size);
247420e2584Scliff 
248*d7025110Sriastradh 	return 0;
249420e2584Scliff }
250420e2584Scliff 
251420e2584Scliff static void
rmixl_nand_command(device_t self,uint8_t command)252420e2584Scliff rmixl_nand_command(device_t self, uint8_t command)
253420e2584Scliff {
254420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
255420e2584Scliff 
256420e2584Scliff 	bus_space_write_4(sc->sc_obio_bst, sc->sc_obio_bsh,
257420e2584Scliff 		sc->sc_cmd_reg, command);
258420e2584Scliff }
259420e2584Scliff 
260420e2584Scliff static void
rmixl_nand_address(device_t self,uint8_t address)261420e2584Scliff rmixl_nand_address(device_t self, uint8_t address)
262420e2584Scliff {
263420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
264420e2584Scliff 
265420e2584Scliff 	bus_space_write_4(sc->sc_obio_bst, sc->sc_obio_bsh,
266420e2584Scliff 		sc->sc_addr_reg, address);
267420e2584Scliff }
268420e2584Scliff 
269420e2584Scliff static void
rmixl_nand_busy(device_t self)270420e2584Scliff rmixl_nand_busy(device_t self)
271420e2584Scliff {
272420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
273420e2584Scliff 	uint32_t istatus;
274420e2584Scliff 
275420e2584Scliff 	for(u_int count=100000; count--;) {
276420e2584Scliff 		istatus = bus_space_read_4(sc->sc_obio_bst, sc->sc_obio_bsh,
277420e2584Scliff 			RMIXL_FLASH_INT_STATUS);
278420e2584Scliff 		if ((istatus & __BIT(8)) != 0)
279420e2584Scliff 			return;
280420e2584Scliff 		DELAY(1);
281420e2584Scliff 	}
282420e2584Scliff #ifdef DEBUG
283420e2584Scliff 	printf("%s: timed out, istatus=%#x\n", __func__, istatus);
284420e2584Scliff #ifdef DDB
285420e2584Scliff 	Debugger();
286420e2584Scliff #endif
287420e2584Scliff #endif
288420e2584Scliff }
289420e2584Scliff 
290420e2584Scliff static void
rmixl_nand_read_1(device_t self,uint8_t * data)291feeeb205Sahoka rmixl_nand_read_1(device_t self, uint8_t *data)
292420e2584Scliff {
293420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
294420e2584Scliff 
295420e2584Scliff 	*data = bus_space_read_1(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0);
296420e2584Scliff }
297420e2584Scliff 
298420e2584Scliff static void
rmixl_nand_write_1(device_t self,uint8_t data)299feeeb205Sahoka rmixl_nand_write_1(device_t self, uint8_t data)
300420e2584Scliff {
301420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
302420e2584Scliff 
303420e2584Scliff 	bus_space_write_1(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0, data);
304420e2584Scliff }
305420e2584Scliff 
306420e2584Scliff static void
rmixl_nand_read_2(device_t self,uint16_t * data)307feeeb205Sahoka rmixl_nand_read_2(device_t self, uint16_t *data)
308420e2584Scliff {
309420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
310420e2584Scliff 
3118a8c6da9Scliff 	*data = bus_space_read_2(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0);
312420e2584Scliff }
313420e2584Scliff 
314420e2584Scliff static void
rmixl_nand_write_2(device_t self,uint16_t data)315feeeb205Sahoka rmixl_nand_write_2(device_t self, uint16_t data)
316420e2584Scliff {
317420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
318420e2584Scliff 
319420e2584Scliff 	bus_space_write_2(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0, data);
320420e2584Scliff }
321420e2584Scliff 
322420e2584Scliff static void
rmixl_nand_read_buf(device_t self,void * buf,size_t len)323420e2584Scliff rmixl_nand_read_buf(device_t self, void *buf, size_t len)
324420e2584Scliff {
325420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
326420e2584Scliff 	uintptr_t addr = (uintptr_t)buf;
327420e2584Scliff 	size_t sz;
328420e2584Scliff 
329420e2584Scliff 	/* leading byte alignment */
330420e2584Scliff 	if ((len >= 1) && ((addr & 1) != 0)) {
331420e2584Scliff 		*((uint8_t *)addr) = bus_space_read_1(sc->sc_iobus_bst,
332420e2584Scliff 			sc->sc_iobus_bsh, 0);
333420e2584Scliff 		addr += 1;
334420e2584Scliff 		len -= 1;
335420e2584Scliff 	}
336420e2584Scliff 
337420e2584Scliff 	/* leading short alignment */
338420e2584Scliff 	if ((len >= 2) && ((addr & 2) != 0)) {
339420e2584Scliff 		*((uint16_t *)addr) = bus_space_read_2(sc->sc_iobus_bst,
340420e2584Scliff 			sc->sc_iobus_bsh, 0);
341420e2584Scliff 		addr += 2;
342420e2584Scliff 		len -= 2;
343420e2584Scliff 	}
344420e2584Scliff 
345420e2584Scliff 	/* word alignment */
346420e2584Scliff 	sz = len >> 2;
347420e2584Scliff 	if (sz != 0) {
348420e2584Scliff 		bus_space_read_multi_4(sc->sc_iobus_bst, sc->sc_iobus_bsh,
349420e2584Scliff 			0, (uint32_t *)addr, sz);
350420e2584Scliff 		sz <<= 2;
351420e2584Scliff 		addr += sz;
352420e2584Scliff 		len  -= sz;
353420e2584Scliff 	}
354420e2584Scliff 
355420e2584Scliff 	/* trailing short alignment */
356420e2584Scliff 	if (len >= 2) {
357420e2584Scliff 		*((uint16_t *)addr) = bus_space_read_2(sc->sc_iobus_bst,
358420e2584Scliff 			sc->sc_iobus_bsh, 0);
359420e2584Scliff 		addr += 2;
360420e2584Scliff 		len -= 2;
361420e2584Scliff 	}
362420e2584Scliff 
363420e2584Scliff 	/* trailing byte alignment */
364420e2584Scliff 	if (len != 0)
365420e2584Scliff 		*((uint8_t *)addr) = bus_space_read_1(sc->sc_iobus_bst,
366420e2584Scliff 			sc->sc_iobus_bsh, 0);
367420e2584Scliff }
368420e2584Scliff 
369420e2584Scliff static void
rmixl_nand_write_buf(device_t self,const void * buf,size_t len)370420e2584Scliff rmixl_nand_write_buf(device_t self, const void *buf, size_t len)
371420e2584Scliff {
372420e2584Scliff 	struct rmixl_nand_softc *sc = device_private(self);
373420e2584Scliff 	uintptr_t addr = (uintptr_t)buf;
374420e2584Scliff 	size_t sz;
375420e2584Scliff 
376420e2584Scliff 	/* leading byte alignment */
377420e2584Scliff 	if ((len >= 1) && ((addr & 1) != 0)) {
378420e2584Scliff 		bus_space_write_1(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0,
379420e2584Scliff 			*((uint8_t *)addr));
380420e2584Scliff 		addr += 1;
381420e2584Scliff 		len -= 1;
382420e2584Scliff 	}
383420e2584Scliff 
384420e2584Scliff 	/* leading short alignment */
385420e2584Scliff 	if ((len >= 2) && ((addr & 2) != 0)) {
386420e2584Scliff 		bus_space_write_2(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0,
387420e2584Scliff 			*((uint16_t *)addr));
388420e2584Scliff 		addr += 2;
389420e2584Scliff 		len -= 2;
390420e2584Scliff 	}
391420e2584Scliff 
392420e2584Scliff 	/* word alignment */
393420e2584Scliff 	sz = len >> 2;
394420e2584Scliff 	if (sz != 0) {
395420e2584Scliff 		bus_space_write_multi_4(sc->sc_iobus_bst, sc->sc_iobus_bsh,
396420e2584Scliff 			0, (uint32_t *)addr, sz);
397420e2584Scliff 		sz <<= 2;
398420e2584Scliff 		addr += sz;
399420e2584Scliff 		len  -= sz;
400420e2584Scliff 	}
401420e2584Scliff 
402420e2584Scliff 	/* trailing short alignment */
403420e2584Scliff 	if (len >= 2) {
404420e2584Scliff 		bus_space_write_2(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0,
405420e2584Scliff 			*((uint16_t *)addr));
406420e2584Scliff 		addr += 2;
407420e2584Scliff 		len -= 2;
408420e2584Scliff 	}
409420e2584Scliff 
410420e2584Scliff 	/* trailing byte alignment */
411420e2584Scliff 	if (len != 0)
412420e2584Scliff 		bus_space_write_1(sc->sc_iobus_bst, sc->sc_iobus_bsh, 0,
413420e2584Scliff 			*((uint8_t *)addr));
414420e2584Scliff }
415