obs600_machdep.c revision 1.9 1 1.9 kiyohara /* $NetBSD: obs600_machdep.c,v 1.9 2012/07/05 02:56:40 kiyohara 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.9 kiyohara __KERNEL_RCSID(0, "$NetBSD: obs600_machdep.c,v 1.9 2012/07/05 02:56:40 kiyohara 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_ipkdb.h"
76 1.1 kiyohara #include "opt_modular.h"
77 1.1 kiyohara
78 1.1 kiyohara #include <sys/param.h>
79 1.1 kiyohara #include <sys/bus.h>
80 1.1 kiyohara #include <sys/errno.h>
81 1.1 kiyohara #include <sys/kernel.h>
82 1.1 kiyohara #include <sys/ksyms.h>
83 1.1 kiyohara #include <sys/mount.h>
84 1.1 kiyohara #include <sys/reboot.h>
85 1.1 kiyohara #include <sys/systm.h>
86 1.1 kiyohara #include <sys/device.h>
87 1.4 mrg #include <sys/module.h>
88 1.6 matt #include <sys/bus.h>
89 1.6 matt #include <sys/cpu.h>
90 1.1 kiyohara
91 1.1 kiyohara #include <uvm/uvm_extern.h>
92 1.1 kiyohara
93 1.1 kiyohara #include <machine/obs600.h>
94 1.1 kiyohara
95 1.1 kiyohara #include <powerpc/ibm4xx/amcc405ex.h>
96 1.6 matt #include <powerpc/ibm4xx/cpu.h>
97 1.1 kiyohara #include <powerpc/ibm4xx/dcr4xx.h>
98 1.1 kiyohara #include <powerpc/ibm4xx/dev/comopbvar.h>
99 1.1 kiyohara #include <powerpc/ibm4xx/dev/gpiicreg.h>
100 1.1 kiyohara #include <powerpc/ibm4xx/dev/opbvar.h>
101 1.6 matt
102 1.6 matt #include <powerpc/spr.h>
103 1.1 kiyohara #include <powerpc/ibm4xx/spr.h>
104 1.1 kiyohara
105 1.1 kiyohara #include <dev/ic/comreg.h>
106 1.1 kiyohara
107 1.1 kiyohara #include "ksyms.h"
108 1.1 kiyohara
109 1.1 kiyohara #include "com.h"
110 1.1 kiyohara #if (NCOM > 0)
111 1.1 kiyohara #include <sys/termios.h>
112 1.1 kiyohara
113 1.1 kiyohara #ifndef CONADDR
114 1.1 kiyohara #define CONADDR AMCC405EX_UART0_BASE
115 1.1 kiyohara #endif
116 1.1 kiyohara #ifndef CONSPEED
117 1.1 kiyohara #define CONSPEED B115200
118 1.1 kiyohara #endif
119 1.1 kiyohara #ifndef CONMODE
120 1.1 kiyohara /* 8N1 */
121 1.1 kiyohara #define CONMODE ((TTYDEF_CFLAG & ~(CSIZE | CSTOPB | PARENB)) | CS8)
122 1.1 kiyohara #endif
123 1.1 kiyohara #endif /* NCOM */
124 1.1 kiyohara
125 1.1 kiyohara /*
126 1.1 kiyohara * XXXX:
127 1.1 kiyohara * It is very troublesome though we can calculate from various registers. X-<
128 1.1 kiyohara */
129 1.1 kiyohara #define OBS600_CPU_FREQ (600 * 1000 * 1000)
130 1.1 kiyohara #define OBS600_MEM_SIZE (1 * 1024 * 1024 * 1024)
131 1.1 kiyohara
132 1.1 kiyohara #define TLB_PG_SIZE (16 * 1024 * 1024)
133 1.1 kiyohara
134 1.1 kiyohara /*
135 1.1 kiyohara * Global variables used here and there
136 1.1 kiyohara */
137 1.1 kiyohara char bootpath[256];
138 1.1 kiyohara
139 1.1 kiyohara extern paddr_t msgbuf_paddr;
140 1.1 kiyohara
141 1.7 matt void initppc(vaddr_t, vaddr_t, int, char *[], char *);
142 1.1 kiyohara static int read_eeprom(int, char *);
143 1.1 kiyohara
144 1.1 kiyohara
145 1.1 kiyohara void
146 1.7 matt initppc(vaddr_t startkernel, vaddr_t endkernel, int argc, char *argv[],
147 1.1 kiyohara char *argstr)
148 1.1 kiyohara {
149 1.1 kiyohara vaddr_t va;
150 1.1 kiyohara u_int memsize;
151 1.1 kiyohara
152 1.1 kiyohara memsize = OBS600_MEM_SIZE;
153 1.1 kiyohara
154 1.1 kiyohara /* Linear map kernel memory */
155 1.1 kiyohara for (va = 0; va < endkernel; va += TLB_PG_SIZE)
156 1.1 kiyohara ppc4xx_tlb_reserve(va, va, TLB_PG_SIZE, TLB_EX);
157 1.1 kiyohara
158 1.1 kiyohara /*
159 1.1 kiyohara * Map console and I2C after RAM. (see pmap_tlbmiss())
160 1.1 kiyohara * All peripherals mapped on a page.
161 1.1 kiyohara */
162 1.1 kiyohara ppc4xx_tlb_reserve(AMCC405EX_OPB_BASE, roundup(memsize, TLB_PG_SIZE),
163 1.1 kiyohara TLB_PG_SIZE, TLB_I | TLB_G);
164 1.1 kiyohara
165 1.1 kiyohara /* Initialize AMCC 405EX CPU */
166 1.1 kiyohara ibm40x_memsize_init(memsize, startkernel);
167 1.7 matt ibm4xx_init(startkernel, endkernel, pic_ext_intr);
168 1.1 kiyohara
169 1.1 kiyohara #ifdef DDB
170 1.1 kiyohara if (boothowto & RB_KDB)
171 1.1 kiyohara Debugger();
172 1.1 kiyohara #endif
173 1.1 kiyohara #ifdef IPKDB
174 1.1 kiyohara /*
175 1.1 kiyohara * Now trap to IPKDB
176 1.1 kiyohara */
177 1.1 kiyohara ipkdb_init();
178 1.1 kiyohara if (boothowto & RB_KDB)
179 1.1 kiyohara ipkdb_connect(0);
180 1.1 kiyohara #endif
181 1.4 mrg
182 1.4 mrg /*
183 1.4 mrg * Look for the ibm4xx modules in the right place.
184 1.4 mrg */
185 1.4 mrg module_machine = module_machine_ibm4xx;
186 1.1 kiyohara }
187 1.1 kiyohara
188 1.1 kiyohara void
189 1.1 kiyohara consinit(void)
190 1.1 kiyohara {
191 1.1 kiyohara
192 1.1 kiyohara #if (NCOM > 0)
193 1.1 kiyohara com_opb_cnattach(OBS600_COM_FREQ, CONADDR, CONSPEED, CONMODE);
194 1.1 kiyohara #endif /* NCOM */
195 1.1 kiyohara }
196 1.1 kiyohara
197 1.1 kiyohara /*
198 1.1 kiyohara * Machine dependent startup code.
199 1.1 kiyohara */
200 1.1 kiyohara void
201 1.1 kiyohara cpu_startup(void)
202 1.1 kiyohara {
203 1.1 kiyohara prop_number_t pn;
204 1.1 kiyohara prop_data_t pd;
205 1.1 kiyohara u_char *macaddr, *macaddr1;
206 1.1 kiyohara static u_char buf[16]; /* MAC address x2 buffer */
207 1.1 kiyohara
208 1.1 kiyohara /*
209 1.1 kiyohara * cpu common startup
210 1.1 kiyohara */
211 1.1 kiyohara ibm4xx_cpu_startup("OpenBlockS600 AMCC PowerPC 405EX Board");
212 1.1 kiyohara
213 1.1 kiyohara /*
214 1.1 kiyohara * Set up the board properties database.
215 1.1 kiyohara */
216 1.1 kiyohara board_info_init();
217 1.1 kiyohara
218 1.9 kiyohara read_eeprom(sizeof(buf), buf);
219 1.9 kiyohara macaddr = &buf[0];
220 1.9 kiyohara macaddr1 = &buf[8];
221 1.9 kiyohara
222 1.8 kiyohara /*
223 1.8 kiyohara * Now that we have VM, malloc()s are OK in bus_space.
224 1.8 kiyohara */
225 1.8 kiyohara bus_space_mallocok();
226 1.8 kiyohara
227 1.1 kiyohara pn = prop_number_create_integer(OBS600_CPU_FREQ);
228 1.1 kiyohara KASSERT(pn != NULL);
229 1.1 kiyohara if (prop_dictionary_set(board_properties, "processor-frequency", pn) ==
230 1.1 kiyohara false)
231 1.1 kiyohara panic("setting processor-frequency");
232 1.1 kiyohara prop_object_release(pn);
233 1.1 kiyohara
234 1.1 kiyohara pn = prop_number_create_integer(OBS600_MEM_SIZE);
235 1.1 kiyohara KASSERT(pn != NULL);
236 1.1 kiyohara if (prop_dictionary_set(board_properties, "mem-size", pn) == false)
237 1.1 kiyohara panic("setting mem-size");
238 1.1 kiyohara prop_object_release(pn);
239 1.1 kiyohara
240 1.1 kiyohara #define ETHER_ADDR_LEN 6
241 1.1 kiyohara
242 1.1 kiyohara pd = prop_data_create_data_nocopy(macaddr, ETHER_ADDR_LEN);
243 1.1 kiyohara KASSERT(pd != NULL);
244 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac0-mac-addr", pd) ==
245 1.1 kiyohara false)
246 1.1 kiyohara panic("setting emac0-mac-addr");
247 1.1 kiyohara prop_object_release(pd);
248 1.1 kiyohara pd = prop_data_create_data_nocopy(macaddr1, ETHER_ADDR_LEN);
249 1.1 kiyohara KASSERT(pd != NULL);
250 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac1-mac-addr", pd) ==
251 1.1 kiyohara false)
252 1.1 kiyohara panic("setting emac1-mac-addr");
253 1.1 kiyohara prop_object_release(pd);
254 1.1 kiyohara
255 1.1 kiyohara /* emac0 connects to phy 2 and emac1 to phy 3 via RGMII. */
256 1.1 kiyohara pn = prop_number_create_integer(2);
257 1.1 kiyohara KASSERT(pn != NULL);
258 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac0-mii-phy", pn) == false)
259 1.1 kiyohara panic("setting emac0-mii-phy");
260 1.1 kiyohara prop_object_release(pn);
261 1.1 kiyohara pn = prop_number_create_integer(3);
262 1.1 kiyohara KASSERT(pn != NULL);
263 1.1 kiyohara if (prop_dictionary_set(board_properties, "emac1-mii-phy", pn) == false)
264 1.1 kiyohara panic("setting emac1-mii-phy");
265 1.1 kiyohara prop_object_release(pn);
266 1.1 kiyohara
267 1.1 kiyohara /*
268 1.1 kiyohara * no fake mapiodev
269 1.1 kiyohara */
270 1.1 kiyohara fake_mapiodev = 0;
271 1.3 kiyohara
272 1.3 kiyohara splraise(-1);
273 1.1 kiyohara }
274 1.1 kiyohara
275 1.1 kiyohara /*
276 1.1 kiyohara * Halt or reboot the machine after syncing/dumping according to howto.
277 1.1 kiyohara */
278 1.1 kiyohara void
279 1.1 kiyohara cpu_reboot(int howto, char *what)
280 1.1 kiyohara {
281 1.1 kiyohara static int syncing;
282 1.1 kiyohara static char str[256];
283 1.1 kiyohara char *ap = str, *ap1 = ap;
284 1.1 kiyohara
285 1.1 kiyohara boothowto = howto;
286 1.1 kiyohara if (!cold && !(howto & RB_NOSYNC) && !syncing) {
287 1.1 kiyohara syncing = 1;
288 1.1 kiyohara vfs_shutdown(); /* sync */
289 1.1 kiyohara resettodr(); /* set wall clock */
290 1.1 kiyohara }
291 1.1 kiyohara
292 1.1 kiyohara splhigh();
293 1.1 kiyohara
294 1.1 kiyohara if (!cold && (howto & RB_DUMP))
295 1.1 kiyohara ibm4xx_dumpsys();
296 1.1 kiyohara
297 1.1 kiyohara doshutdownhooks();
298 1.1 kiyohara
299 1.1 kiyohara pmf_system_shutdown(boothowto);
300 1.1 kiyohara
301 1.1 kiyohara if ((howto & RB_POWERDOWN) == RB_POWERDOWN) {
302 1.1 kiyohara /* Power off here if we know how...*/
303 1.1 kiyohara }
304 1.1 kiyohara
305 1.1 kiyohara if (howto & RB_HALT) {
306 1.1 kiyohara printf("halted\n\n");
307 1.1 kiyohara
308 1.1 kiyohara #if 0
309 1.1 kiyohara goto reboot; /* XXX for now... */
310 1.1 kiyohara #endif
311 1.1 kiyohara
312 1.1 kiyohara #ifdef DDB
313 1.1 kiyohara printf("dropping to debugger\n");
314 1.1 kiyohara while(1)
315 1.1 kiyohara Debugger();
316 1.1 kiyohara #endif
317 1.1 kiyohara }
318 1.1 kiyohara
319 1.1 kiyohara printf("rebooting\n\n");
320 1.1 kiyohara if (what && *what) {
321 1.1 kiyohara if (strlen(what) > sizeof str - 5)
322 1.1 kiyohara printf("boot string too large, ignored\n");
323 1.1 kiyohara else {
324 1.1 kiyohara strcpy(str, what);
325 1.1 kiyohara ap1 = ap = str + strlen(str);
326 1.1 kiyohara *ap++ = ' ';
327 1.1 kiyohara }
328 1.1 kiyohara }
329 1.1 kiyohara *ap++ = '-';
330 1.1 kiyohara if (howto & RB_SINGLE)
331 1.1 kiyohara *ap++ = 's';
332 1.1 kiyohara if (howto & RB_KDB)
333 1.1 kiyohara *ap++ = 'd';
334 1.1 kiyohara *ap++ = 0;
335 1.1 kiyohara if (ap[-2] == '-')
336 1.1 kiyohara *ap1 = 0;
337 1.1 kiyohara
338 1.1 kiyohara /* flush cache for msgbuf */
339 1.1 kiyohara __syncicache((void *)msgbuf_paddr, round_page(MSGBUFSIZE));
340 1.1 kiyohara
341 1.1 kiyohara #if 0
342 1.1 kiyohara reboot:
343 1.1 kiyohara #endif
344 1.1 kiyohara ppc4xx_reset();
345 1.1 kiyohara
346 1.1 kiyohara printf("ppc4xx_reset() failed!\n");
347 1.1 kiyohara #ifdef DDB
348 1.1 kiyohara while(1)
349 1.1 kiyohara Debugger();
350 1.1 kiyohara #else
351 1.1 kiyohara while (1)
352 1.1 kiyohara /* nothing */;
353 1.1 kiyohara #endif
354 1.1 kiyohara }
355 1.1 kiyohara
356 1.9 kiyohara /*
357 1.9 kiyohara * Read EEPROM via I2C. We don't use bus_space(9) here. This is MD-part and,
358 1.9 kiyohara * don't support bus_space_unmap() to a space on reserved space? X-<
359 1.9 kiyohara *
360 1.9 kiyohara * XXXX: Also this function assume already initialized for I2C...
361 1.9 kiyohara */
362 1.1 kiyohara static int
363 1.1 kiyohara read_eeprom(int len, char *buf)
364 1.1 kiyohara {
365 1.9 kiyohara volatile uint8_t *iic0;
366 1.9 kiyohara #define IIC0_READ(r) (*(iic0 + (r)))
367 1.9 kiyohara #define IIC0_WRITE(r, v) (*(iic0 + (r)) = (v))
368 1.9 kiyohara uint8_t sts;
369 1.1 kiyohara int cnt, i = 0;
370 1.1 kiyohara
371 1.1 kiyohara #define I2C_EEPROM_ADDR 0x52
372 1.1 kiyohara
373 1.9 kiyohara if ((iic0 = ppc4xx_tlb_mapiodev(AMCC405EX_IIC0_BASE, IIC_NREG)) == NULL)
374 1.1 kiyohara return ENOMEM; /* ??? */
375 1.1 kiyohara
376 1.1 kiyohara /* Clear Stop Complete Bit */
377 1.9 kiyohara IIC0_WRITE(IIC_STS, IIC_STS_SCMP);
378 1.1 kiyohara /* Check init */
379 1.1 kiyohara do {
380 1.1 kiyohara /* Get status */
381 1.9 kiyohara sts = IIC0_READ(IIC_STS);
382 1.1 kiyohara } while ((sts & IIC_STS_PT));
383 1.1 kiyohara
384 1.9 kiyohara IIC0_WRITE(IIC_MDCNTL,
385 1.9 kiyohara IIC0_READ(IIC_MDCNTL) | IIC_MDCNTL_FMDB | IIC_MDCNTL_FSDB);
386 1.1 kiyohara
387 1.1 kiyohara /* 7-bit adressing */
388 1.9 kiyohara IIC0_WRITE(IIC_HMADR, 0);
389 1.9 kiyohara IIC0_WRITE(IIC_LMADR, I2C_EEPROM_ADDR << 1);
390 1.1 kiyohara
391 1.9 kiyohara IIC0_WRITE(IIC_MDBUF, 0);
392 1.9 kiyohara IIC0_WRITE(IIC_CNTL, IIC_CNTL_PT);
393 1.1 kiyohara do {
394 1.1 kiyohara /* Get status */
395 1.9 kiyohara sts = IIC0_READ(IIC_STS);
396 1.1 kiyohara } while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
397 1.1 kiyohara
398 1.1 kiyohara cnt = 0;
399 1.1 kiyohara while (cnt < len) {
400 1.1 kiyohara /* always read 4byte */
401 1.9 kiyohara IIC0_WRITE(IIC_CNTL,
402 1.9 kiyohara IIC_CNTL_PT |
403 1.9 kiyohara IIC_CNTL_RW |
404 1.9 kiyohara ((cnt == 0) ? IIC_CNTL_RPST : 0) |
405 1.9 kiyohara IIC_CNTL_TCT);
406 1.1 kiyohara do {
407 1.1 kiyohara /* Get status */
408 1.9 kiyohara sts = IIC0_READ(IIC_STS);
409 1.1 kiyohara } while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
410 1.1 kiyohara
411 1.1 kiyohara if ((sts & IIC_STS_PT) || (sts & IIC_STS_ERR))
412 1.1 kiyohara break;
413 1.1 kiyohara if (sts & IIC_STS_MDBS) {
414 1.1 kiyohara delay(1);
415 1.1 kiyohara /* read 4byte */
416 1.1 kiyohara for (i = 0; i < 4 && cnt < len; i++, cnt++)
417 1.9 kiyohara buf[cnt] = IIC0_READ(IIC_MDBUF);
418 1.1 kiyohara }
419 1.1 kiyohara }
420 1.1 kiyohara for ( ; i < 4; i++)
421 1.9 kiyohara (void) IIC0_READ(IIC_MDBUF);
422 1.1 kiyohara
423 1.1 kiyohara return (cnt == len) ? 0 : EINVAL;
424 1.1 kiyohara }
425