obs600_machdep.c revision 1.12 1 1.12 rin /* $NetBSD: obs600_machdep.c,v 1.12 2021/03/06 08:29:19 rin Exp $ */
2 1.1 kiyohara /* Original: md_machdep.c,v 1.3 2005/01/24 18:47:37 shige Exp $ */
3 1.1 kiyohara
4 1.1 kiyohara /*
5 1.1 kiyohara * Copyright 2001, 2002 Wasabi Systems, Inc.
6 1.1 kiyohara * All rights reserved.
7 1.1 kiyohara *
8 1.1 kiyohara * Written by Eduardo Horvath and Simon Burge for Wasabi Systems, Inc.
9 1.1 kiyohara *
10 1.1 kiyohara * Redistribution and use in source and binary forms, with or without
11 1.1 kiyohara * modification, are permitted provided that the following conditions
12 1.1 kiyohara * are met:
13 1.1 kiyohara * 1. Redistributions of source code must retain the above copyright
14 1.1 kiyohara * notice, this list of conditions and the following disclaimer.
15 1.1 kiyohara * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 kiyohara * notice, this list of conditions and the following disclaimer in the
17 1.1 kiyohara * documentation and/or other materials provided with the distribution.
18 1.1 kiyohara * 3. All advertising materials mentioning features or use of this software
19 1.1 kiyohara * must display the following acknowledgement:
20 1.1 kiyohara * This product includes software developed for the NetBSD Project by
21 1.1 kiyohara * Wasabi Systems, Inc.
22 1.1 kiyohara * 4. The name of Wasabi Systems, Inc. may not be used to endorse
23 1.1 kiyohara * or promote products derived from this software without specific prior
24 1.1 kiyohara * written permission.
25 1.1 kiyohara *
26 1.1 kiyohara * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
27 1.1 kiyohara * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 kiyohara * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 kiyohara * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
30 1.1 kiyohara * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 kiyohara * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 kiyohara * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 kiyohara * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 kiyohara * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 kiyohara * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 kiyohara * POSSIBILITY OF SUCH DAMAGE.
37 1.1 kiyohara */
38 1.1 kiyohara
39 1.1 kiyohara /*
40 1.1 kiyohara * Copyright (C) 1995, 1996 Wolfgang Solfrank.
41 1.1 kiyohara * Copyright (C) 1995, 1996 TooLs GmbH.
42 1.1 kiyohara * All rights reserved.
43 1.1 kiyohara *
44 1.1 kiyohara * Redistribution and use in source and binary forms, with or without
45 1.1 kiyohara * modification, are permitted provided that the following conditions
46 1.1 kiyohara * are met:
47 1.1 kiyohara * 1. Redistributions of source code must retain the above copyright
48 1.1 kiyohara * notice, this list of conditions and the following disclaimer.
49 1.1 kiyohara * 2. Redistributions in binary form must reproduce the above copyright
50 1.1 kiyohara * notice, this list of conditions and the following disclaimer in the
51 1.1 kiyohara * documentation and/or other materials provided with the distribution.
52 1.1 kiyohara * 3. All advertising materials mentioning features or use of this software
53 1.1 kiyohara * must display the following acknowledgement:
54 1.1 kiyohara * This product includes software developed by TooLs GmbH.
55 1.1 kiyohara * 4. The name of TooLs GmbH may not be used to endorse or promote products
56 1.1 kiyohara * derived from this software without specific prior written permission.
57 1.1 kiyohara *
58 1.1 kiyohara * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
59 1.1 kiyohara * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
60 1.1 kiyohara * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
61 1.1 kiyohara * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
62 1.1 kiyohara * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
63 1.1 kiyohara * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
64 1.1 kiyohara * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
65 1.1 kiyohara * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
66 1.1 kiyohara * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
67 1.1 kiyohara * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
68 1.1 kiyohara */
69 1.1 kiyohara
70 1.1 kiyohara #include <sys/cdefs.h>
71 1.12 rin __KERNEL_RCSID(0, "$NetBSD: obs600_machdep.c,v 1.12 2021/03/06 08:29:19 rin Exp $");
72 1.1 kiyohara
73 1.1 kiyohara #include "opt_compat_netbsd.h"
74 1.1 kiyohara #include "opt_ddb.h"
75 1.1 kiyohara #include "opt_modular.h"
76 1.1 kiyohara
77 1.1 kiyohara #include <sys/param.h>
78 1.1 kiyohara #include <sys/bus.h>
79 1.1 kiyohara #include <sys/errno.h>
80 1.1 kiyohara #include <sys/kernel.h>
81 1.1 kiyohara #include <sys/ksyms.h>
82 1.1 kiyohara #include <sys/mount.h>
83 1.1 kiyohara #include <sys/reboot.h>
84 1.1 kiyohara #include <sys/systm.h>
85 1.1 kiyohara #include <sys/device.h>
86 1.4 mrg #include <sys/module.h>
87 1.6 matt #include <sys/bus.h>
88 1.6 matt #include <sys/cpu.h>
89 1.1 kiyohara
90 1.1 kiyohara #include <uvm/uvm_extern.h>
91 1.1 kiyohara
92 1.1 kiyohara #include <machine/obs600.h>
93 1.1 kiyohara
94 1.1 kiyohara #include <powerpc/ibm4xx/amcc405ex.h>
95 1.6 matt #include <powerpc/ibm4xx/cpu.h>
96 1.1 kiyohara #include <powerpc/ibm4xx/dcr4xx.h>
97 1.1 kiyohara #include <powerpc/ibm4xx/dev/comopbvar.h>
98 1.1 kiyohara #include <powerpc/ibm4xx/dev/gpiicreg.h>
99 1.1 kiyohara #include <powerpc/ibm4xx/dev/opbvar.h>
100 1.6 matt
101 1.6 matt #include <powerpc/spr.h>
102 1.1 kiyohara #include <powerpc/ibm4xx/spr.h>
103 1.1 kiyohara
104 1.1 kiyohara #include <dev/ic/comreg.h>
105 1.1 kiyohara
106 1.1 kiyohara #include "ksyms.h"
107 1.1 kiyohara
108 1.1 kiyohara #include "com.h"
109 1.1 kiyohara #if (NCOM > 0)
110 1.1 kiyohara #include <sys/termios.h>
111 1.1 kiyohara
112 1.1 kiyohara #ifndef CONADDR
113 1.1 kiyohara #define CONADDR AMCC405EX_UART0_BASE
114 1.1 kiyohara #endif
115 1.1 kiyohara #ifndef CONSPEED
116 1.1 kiyohara #define CONSPEED B115200
117 1.1 kiyohara #endif
118 1.1 kiyohara #ifndef CONMODE
119 1.1 kiyohara /* 8N1 */
120 1.1 kiyohara #define CONMODE ((TTYDEF_CFLAG & ~(CSIZE | CSTOPB | PARENB)) | CS8)
121 1.1 kiyohara #endif
122 1.1 kiyohara #endif /* NCOM */
123 1.1 kiyohara
124 1.1 kiyohara /*
125 1.1 kiyohara * XXXX:
126 1.1 kiyohara * It is very troublesome though we can calculate from various registers. X-<
127 1.1 kiyohara */
128 1.1 kiyohara #define OBS600_CPU_FREQ (600 * 1000 * 1000)
129 1.1 kiyohara #define OBS600_MEM_SIZE (1 * 1024 * 1024 * 1024)
130 1.1 kiyohara
131 1.1 kiyohara #define TLB_PG_SIZE (16 * 1024 * 1024)
132 1.1 kiyohara
133 1.1 kiyohara /*
134 1.1 kiyohara * Global variables used here and there
135 1.1 kiyohara */
136 1.1 kiyohara char bootpath[256];
137 1.1 kiyohara
138 1.1 kiyohara extern paddr_t msgbuf_paddr;
139 1.1 kiyohara
140 1.7 matt void initppc(vaddr_t, vaddr_t, int, char *[], char *);
141 1.1 kiyohara static int read_eeprom(int, char *);
142 1.1 kiyohara
143 1.1 kiyohara
144 1.1 kiyohara void
145 1.7 matt initppc(vaddr_t startkernel, vaddr_t endkernel, int argc, char *argv[],
146 1.1 kiyohara char *argstr)
147 1.1 kiyohara {
148 1.1 kiyohara vaddr_t va;
149 1.1 kiyohara u_int memsize;
150 1.1 kiyohara
151 1.1 kiyohara memsize = OBS600_MEM_SIZE;
152 1.1 kiyohara
153 1.1 kiyohara /* Linear map kernel memory */
154 1.1 kiyohara for (va = 0; va < endkernel; va += TLB_PG_SIZE)
155 1.1 kiyohara ppc4xx_tlb_reserve(va, va, TLB_PG_SIZE, TLB_EX);
156 1.1 kiyohara
157 1.1 kiyohara /*
158 1.1 kiyohara * Map console and I2C after RAM. (see pmap_tlbmiss())
159 1.1 kiyohara * All peripherals mapped on a page.
160 1.1 kiyohara */
161 1.1 kiyohara ppc4xx_tlb_reserve(AMCC405EX_OPB_BASE, roundup(memsize, TLB_PG_SIZE),
162 1.1 kiyohara TLB_PG_SIZE, TLB_I | TLB_G);
163 1.1 kiyohara
164 1.1 kiyohara /* Initialize AMCC 405EX CPU */
165 1.1 kiyohara ibm40x_memsize_init(memsize, startkernel);
166 1.7 matt ibm4xx_init(startkernel, endkernel, pic_ext_intr);
167 1.1 kiyohara
168 1.1 kiyohara #ifdef DDB
169 1.1 kiyohara if (boothowto & RB_KDB)
170 1.1 kiyohara Debugger();
171 1.1 kiyohara #endif
172 1.4 mrg
173 1.4 mrg /*
174 1.4 mrg * Look for the ibm4xx modules in the right place.
175 1.4 mrg */
176 1.4 mrg module_machine = module_machine_ibm4xx;
177 1.1 kiyohara }
178 1.1 kiyohara
179 1.1 kiyohara void
180 1.1 kiyohara consinit(void)
181 1.1 kiyohara {
182 1.1 kiyohara
183 1.1 kiyohara #if (NCOM > 0)
184 1.1 kiyohara com_opb_cnattach(OBS600_COM_FREQ, CONADDR, CONSPEED, CONMODE);
185 1.1 kiyohara #endif /* NCOM */
186 1.1 kiyohara }
187 1.1 kiyohara
188 1.1 kiyohara /*
189 1.1 kiyohara * Machine dependent startup code.
190 1.1 kiyohara */
191 1.1 kiyohara void
192 1.1 kiyohara cpu_startup(void)
193 1.1 kiyohara {
194 1.1 kiyohara prop_number_t pn;
195 1.1 kiyohara prop_data_t pd;
196 1.1 kiyohara u_char *macaddr, *macaddr1;
197 1.1 kiyohara static u_char buf[16]; /* MAC address x2 buffer */
198 1.1 kiyohara
199 1.1 kiyohara /*
200 1.1 kiyohara * cpu common startup
201 1.1 kiyohara */
202 1.1 kiyohara ibm4xx_cpu_startup("OpenBlockS600 AMCC PowerPC 405EX Board");
203 1.1 kiyohara
204 1.1 kiyohara /*
205 1.1 kiyohara * Set up the board properties database.
206 1.1 kiyohara */
207 1.1 kiyohara board_info_init();
208 1.1 kiyohara
209 1.1 kiyohara pn = prop_number_create_integer(OBS600_CPU_FREQ);
210 1.1 kiyohara KASSERT(pn != NULL);
211 1.1 kiyohara if (prop_dictionary_set(board_properties, "processor-frequency", pn) ==
212 1.1 kiyohara false)
213 1.1 kiyohara panic("setting processor-frequency");
214 1.1 kiyohara prop_object_release(pn);
215 1.1 kiyohara
216 1.1 kiyohara pn = prop_number_create_integer(OBS600_MEM_SIZE);
217 1.1 kiyohara KASSERT(pn != NULL);
218 1.1 kiyohara if (prop_dictionary_set(board_properties, "mem-size", pn) == false)
219 1.1 kiyohara panic("setting mem-size");
220 1.1 kiyohara prop_object_release(pn);
221 1.1 kiyohara
222 1.11 rin calc_delayconst(); /* required by read_eeprom() */
223 1.11 rin
224 1.1 kiyohara #define ETHER_ADDR_LEN 6
225 1.1 kiyohara
226 1.11 rin read_eeprom(sizeof(buf), buf);
227 1.11 rin macaddr = &buf[0];
228 1.11 rin macaddr1 = &buf[8];
229 1.11 rin
230 1.1 kiyohara pd = prop_data_create_data_nocopy(macaddr, ETHER_ADDR_LEN);
231 1.1 kiyohara KASSERT(pd != NULL);
232 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac0-mac-addr", pd) ==
233 1.1 kiyohara false)
234 1.1 kiyohara panic("setting emac0-mac-addr");
235 1.1 kiyohara prop_object_release(pd);
236 1.1 kiyohara pd = prop_data_create_data_nocopy(macaddr1, ETHER_ADDR_LEN);
237 1.1 kiyohara KASSERT(pd != NULL);
238 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac1-mac-addr", pd) ==
239 1.1 kiyohara false)
240 1.1 kiyohara panic("setting emac1-mac-addr");
241 1.1 kiyohara prop_object_release(pd);
242 1.1 kiyohara
243 1.1 kiyohara /* emac0 connects to phy 2 and emac1 to phy 3 via RGMII. */
244 1.1 kiyohara pn = prop_number_create_integer(2);
245 1.1 kiyohara KASSERT(pn != NULL);
246 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac0-mii-phy", pn) == false)
247 1.1 kiyohara panic("setting emac0-mii-phy");
248 1.1 kiyohara prop_object_release(pn);
249 1.1 kiyohara pn = prop_number_create_integer(3);
250 1.1 kiyohara KASSERT(pn != NULL);
251 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac1-mii-phy", pn) == false)
252 1.1 kiyohara panic("setting emac1-mii-phy");
253 1.1 kiyohara prop_object_release(pn);
254 1.1 kiyohara
255 1.1 kiyohara /*
256 1.12 rin * Now that we have VM, malloc()s are OK in bus_space.
257 1.12 rin */
258 1.12 rin bus_space_mallocok();
259 1.12 rin
260 1.12 rin /*
261 1.1 kiyohara * no fake mapiodev
262 1.1 kiyohara */
263 1.1 kiyohara fake_mapiodev = 0;
264 1.3 kiyohara
265 1.3 kiyohara splraise(-1);
266 1.1 kiyohara }
267 1.1 kiyohara
268 1.1 kiyohara /*
269 1.1 kiyohara * Halt or reboot the machine after syncing/dumping according to howto.
270 1.1 kiyohara */
271 1.1 kiyohara void
272 1.1 kiyohara cpu_reboot(int howto, char *what)
273 1.1 kiyohara {
274 1.1 kiyohara static int syncing;
275 1.1 kiyohara static char str[256];
276 1.1 kiyohara char *ap = str, *ap1 = ap;
277 1.1 kiyohara
278 1.1 kiyohara boothowto = howto;
279 1.1 kiyohara if (!cold && !(howto & RB_NOSYNC) && !syncing) {
280 1.1 kiyohara syncing = 1;
281 1.1 kiyohara vfs_shutdown(); /* sync */
282 1.1 kiyohara resettodr(); /* set wall clock */
283 1.1 kiyohara }
284 1.1 kiyohara
285 1.1 kiyohara splhigh();
286 1.1 kiyohara
287 1.1 kiyohara if (!cold && (howto & RB_DUMP))
288 1.1 kiyohara ibm4xx_dumpsys();
289 1.1 kiyohara
290 1.1 kiyohara doshutdownhooks();
291 1.1 kiyohara
292 1.1 kiyohara pmf_system_shutdown(boothowto);
293 1.1 kiyohara
294 1.1 kiyohara if ((howto & RB_POWERDOWN) == RB_POWERDOWN) {
295 1.1 kiyohara /* Power off here if we know how...*/
296 1.1 kiyohara }
297 1.1 kiyohara
298 1.1 kiyohara if (howto & RB_HALT) {
299 1.1 kiyohara printf("halted\n\n");
300 1.1 kiyohara
301 1.1 kiyohara #if 0
302 1.1 kiyohara goto reboot; /* XXX for now... */
303 1.1 kiyohara #endif
304 1.1 kiyohara
305 1.1 kiyohara #ifdef DDB
306 1.1 kiyohara printf("dropping to debugger\n");
307 1.1 kiyohara while(1)
308 1.1 kiyohara Debugger();
309 1.1 kiyohara #endif
310 1.1 kiyohara }
311 1.1 kiyohara
312 1.1 kiyohara printf("rebooting\n\n");
313 1.1 kiyohara if (what && *what) {
314 1.1 kiyohara if (strlen(what) > sizeof str - 5)
315 1.1 kiyohara printf("boot string too large, ignored\n");
316 1.1 kiyohara else {
317 1.1 kiyohara strcpy(str, what);
318 1.1 kiyohara ap1 = ap = str + strlen(str);
319 1.1 kiyohara *ap++ = ' ';
320 1.1 kiyohara }
321 1.1 kiyohara }
322 1.1 kiyohara *ap++ = '-';
323 1.1 kiyohara if (howto & RB_SINGLE)
324 1.1 kiyohara *ap++ = 's';
325 1.1 kiyohara if (howto & RB_KDB)
326 1.1 kiyohara *ap++ = 'd';
327 1.1 kiyohara *ap++ = 0;
328 1.1 kiyohara if (ap[-2] == '-')
329 1.1 kiyohara *ap1 = 0;
330 1.1 kiyohara
331 1.1 kiyohara /* flush cache for msgbuf */
332 1.1 kiyohara __syncicache((void *)msgbuf_paddr, round_page(MSGBUFSIZE));
333 1.1 kiyohara
334 1.1 kiyohara #if 0
335 1.1 kiyohara reboot:
336 1.1 kiyohara #endif
337 1.1 kiyohara ppc4xx_reset();
338 1.1 kiyohara
339 1.1 kiyohara printf("ppc4xx_reset() failed!\n");
340 1.1 kiyohara #ifdef DDB
341 1.1 kiyohara while(1)
342 1.1 kiyohara Debugger();
343 1.1 kiyohara #else
344 1.1 kiyohara while (1)
345 1.1 kiyohara /* nothing */;
346 1.1 kiyohara #endif
347 1.1 kiyohara }
348 1.1 kiyohara
349 1.9 kiyohara /*
350 1.9 kiyohara * Read EEPROM via I2C. We don't use bus_space(9) here. This is MD-part and,
351 1.9 kiyohara * don't support bus_space_unmap() to a space on reserved space? X-<
352 1.9 kiyohara *
353 1.9 kiyohara * XXXX: Also this function assume already initialized for I2C...
354 1.9 kiyohara */
355 1.1 kiyohara static int
356 1.1 kiyohara read_eeprom(int len, char *buf)
357 1.1 kiyohara {
358 1.9 kiyohara volatile uint8_t *iic0;
359 1.9 kiyohara #define IIC0_READ(r) (*(iic0 + (r)))
360 1.9 kiyohara #define IIC0_WRITE(r, v) (*(iic0 + (r)) = (v))
361 1.9 kiyohara uint8_t sts;
362 1.1 kiyohara int cnt, i = 0;
363 1.1 kiyohara
364 1.1 kiyohara #define I2C_EEPROM_ADDR 0x52
365 1.1 kiyohara
366 1.9 kiyohara if ((iic0 = ppc4xx_tlb_mapiodev(AMCC405EX_IIC0_BASE, IIC_NREG)) == NULL)
367 1.1 kiyohara return ENOMEM; /* ??? */
368 1.1 kiyohara
369 1.1 kiyohara /* Clear Stop Complete Bit */
370 1.9 kiyohara IIC0_WRITE(IIC_STS, IIC_STS_SCMP);
371 1.1 kiyohara /* Check init */
372 1.1 kiyohara do {
373 1.1 kiyohara /* Get status */
374 1.9 kiyohara sts = IIC0_READ(IIC_STS);
375 1.1 kiyohara } while ((sts & IIC_STS_PT));
376 1.1 kiyohara
377 1.9 kiyohara IIC0_WRITE(IIC_MDCNTL,
378 1.9 kiyohara IIC0_READ(IIC_MDCNTL) | IIC_MDCNTL_FMDB | IIC_MDCNTL_FSDB);
379 1.1 kiyohara
380 1.1 kiyohara /* 7-bit adressing */
381 1.9 kiyohara IIC0_WRITE(IIC_HMADR, 0);
382 1.9 kiyohara IIC0_WRITE(IIC_LMADR, I2C_EEPROM_ADDR << 1);
383 1.1 kiyohara
384 1.9 kiyohara IIC0_WRITE(IIC_MDBUF, 0);
385 1.9 kiyohara IIC0_WRITE(IIC_CNTL, IIC_CNTL_PT);
386 1.1 kiyohara do {
387 1.1 kiyohara /* Get status */
388 1.9 kiyohara sts = IIC0_READ(IIC_STS);
389 1.1 kiyohara } while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
390 1.1 kiyohara
391 1.1 kiyohara cnt = 0;
392 1.1 kiyohara while (cnt < len) {
393 1.1 kiyohara /* always read 4byte */
394 1.9 kiyohara IIC0_WRITE(IIC_CNTL,
395 1.9 kiyohara IIC_CNTL_PT |
396 1.9 kiyohara IIC_CNTL_RW |
397 1.9 kiyohara ((cnt == 0) ? IIC_CNTL_RPST : 0) |
398 1.9 kiyohara IIC_CNTL_TCT);
399 1.1 kiyohara do {
400 1.1 kiyohara /* Get status */
401 1.9 kiyohara sts = IIC0_READ(IIC_STS);
402 1.1 kiyohara } while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
403 1.1 kiyohara
404 1.1 kiyohara if ((sts & IIC_STS_PT) || (sts & IIC_STS_ERR))
405 1.1 kiyohara break;
406 1.1 kiyohara if (sts & IIC_STS_MDBS) {
407 1.1 kiyohara delay(1);
408 1.1 kiyohara /* read 4byte */
409 1.1 kiyohara for (i = 0; i < 4 && cnt < len; i++, cnt++)
410 1.9 kiyohara buf[cnt] = IIC0_READ(IIC_MDBUF);
411 1.1 kiyohara }
412 1.1 kiyohara }
413 1.1 kiyohara for ( ; i < 4; i++)
414 1.9 kiyohara (void) IIC0_READ(IIC_MDBUF);
415 1.1 kiyohara
416 1.1 kiyohara return (cnt == len) ? 0 : EINVAL;
417 1.1 kiyohara }
418