Home | History | Annotate | Line # | Download | only in obs405
obs600_machdep.c revision 1.9.40.1
      1  1.9.40.1  christos /*	$NetBSD: obs600_machdep.c,v 1.9.40.1 2019/06/10 22:06:14 christos 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.40.1  christos __KERNEL_RCSID(0, "$NetBSD: obs600_machdep.c,v 1.9.40.1 2019/06/10 22:06:14 christos 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.9  kiyohara 	read_eeprom(sizeof(buf), buf);
    210       1.9  kiyohara 	macaddr = &buf[0];
    211       1.9  kiyohara 	macaddr1 = &buf[8];
    212       1.9  kiyohara 
    213       1.8  kiyohara 	/*
    214       1.8  kiyohara 	 * Now that we have VM, malloc()s are OK in bus_space.
    215       1.8  kiyohara 	 */
    216       1.8  kiyohara 	bus_space_mallocok();
    217       1.8  kiyohara 
    218       1.1  kiyohara 	pn = prop_number_create_integer(OBS600_CPU_FREQ);
    219       1.1  kiyohara 	KASSERT(pn != NULL);
    220       1.1  kiyohara 	if (prop_dictionary_set(board_properties, "processor-frequency", pn) ==
    221       1.1  kiyohara 	    false)
    222       1.1  kiyohara 		panic("setting processor-frequency");
    223       1.1  kiyohara 	prop_object_release(pn);
    224       1.1  kiyohara 
    225       1.1  kiyohara 	pn = prop_number_create_integer(OBS600_MEM_SIZE);
    226       1.1  kiyohara 	KASSERT(pn != NULL);
    227       1.1  kiyohara 	if (prop_dictionary_set(board_properties, "mem-size", pn) == false)
    228       1.1  kiyohara 		panic("setting mem-size");
    229       1.1  kiyohara 	prop_object_release(pn);
    230       1.1  kiyohara 
    231       1.1  kiyohara #define ETHER_ADDR_LEN	6
    232       1.1  kiyohara 
    233       1.1  kiyohara 	pd = prop_data_create_data_nocopy(macaddr, ETHER_ADDR_LEN);
    234       1.1  kiyohara 	KASSERT(pd != NULL);
    235       1.1  kiyohara 	if (prop_dictionary_set(board_properties, "emac0-mac-addr", pd) ==
    236       1.1  kiyohara 	    false)
    237       1.1  kiyohara 		panic("setting emac0-mac-addr");
    238       1.1  kiyohara 	prop_object_release(pd);
    239       1.1  kiyohara 	pd = prop_data_create_data_nocopy(macaddr1, ETHER_ADDR_LEN);
    240       1.1  kiyohara 	KASSERT(pd != NULL);
    241       1.1  kiyohara 	if (prop_dictionary_set(board_properties, "emac1-mac-addr", pd) ==
    242       1.1  kiyohara 	    false)
    243       1.1  kiyohara 		panic("setting emac1-mac-addr");
    244       1.1  kiyohara 	prop_object_release(pd);
    245       1.1  kiyohara 
    246       1.1  kiyohara 	/* emac0 connects to phy 2 and emac1 to phy 3 via RGMII. */
    247       1.1  kiyohara 	pn = prop_number_create_integer(2);
    248       1.1  kiyohara 	KASSERT(pn != NULL);
    249       1.1  kiyohara 	if (prop_dictionary_set(board_properties, "emac0-mii-phy", pn) == false)
    250       1.1  kiyohara 		panic("setting emac0-mii-phy");
    251       1.1  kiyohara 	prop_object_release(pn);
    252       1.1  kiyohara 	pn = prop_number_create_integer(3);
    253       1.1  kiyohara 	KASSERT(pn != NULL);
    254       1.1  kiyohara 	if (prop_dictionary_set(board_properties, "emac1-mii-phy", pn) == false)
    255       1.1  kiyohara 		panic("setting emac1-mii-phy");
    256       1.1  kiyohara 	prop_object_release(pn);
    257       1.1  kiyohara 
    258       1.1  kiyohara 	/*
    259       1.1  kiyohara 	 * no fake mapiodev
    260       1.1  kiyohara 	 */
    261       1.1  kiyohara 	fake_mapiodev = 0;
    262       1.3  kiyohara 
    263       1.3  kiyohara 	splraise(-1);
    264       1.1  kiyohara }
    265       1.1  kiyohara 
    266       1.1  kiyohara /*
    267       1.1  kiyohara  * Halt or reboot the machine after syncing/dumping according to howto.
    268       1.1  kiyohara  */
    269       1.1  kiyohara void
    270       1.1  kiyohara cpu_reboot(int howto, char *what)
    271       1.1  kiyohara {
    272       1.1  kiyohara 	static int syncing;
    273       1.1  kiyohara 	static char str[256];
    274       1.1  kiyohara 	char *ap = str, *ap1 = ap;
    275       1.1  kiyohara 
    276       1.1  kiyohara 	boothowto = howto;
    277       1.1  kiyohara 	if (!cold && !(howto & RB_NOSYNC) && !syncing) {
    278       1.1  kiyohara 		syncing = 1;
    279       1.1  kiyohara 		vfs_shutdown();		/* sync */
    280       1.1  kiyohara 		resettodr();		/* set wall clock */
    281       1.1  kiyohara 	}
    282       1.1  kiyohara 
    283       1.1  kiyohara 	splhigh();
    284       1.1  kiyohara 
    285       1.1  kiyohara 	if (!cold && (howto & RB_DUMP))
    286       1.1  kiyohara 		ibm4xx_dumpsys();
    287       1.1  kiyohara 
    288       1.1  kiyohara 	doshutdownhooks();
    289       1.1  kiyohara 
    290       1.1  kiyohara 	pmf_system_shutdown(boothowto);
    291       1.1  kiyohara 
    292       1.1  kiyohara 	if ((howto & RB_POWERDOWN) == RB_POWERDOWN) {
    293       1.1  kiyohara 	  /* Power off here if we know how...*/
    294       1.1  kiyohara 	}
    295       1.1  kiyohara 
    296       1.1  kiyohara 	if (howto & RB_HALT) {
    297       1.1  kiyohara 		printf("halted\n\n");
    298       1.1  kiyohara 
    299       1.1  kiyohara #if 0
    300       1.1  kiyohara 		goto reboot;	/* XXX for now... */
    301       1.1  kiyohara #endif
    302       1.1  kiyohara 
    303       1.1  kiyohara #ifdef DDB
    304       1.1  kiyohara 		printf("dropping to debugger\n");
    305       1.1  kiyohara 		while(1)
    306       1.1  kiyohara 			Debugger();
    307       1.1  kiyohara #endif
    308       1.1  kiyohara 	}
    309       1.1  kiyohara 
    310       1.1  kiyohara 	printf("rebooting\n\n");
    311       1.1  kiyohara 	if (what && *what) {
    312       1.1  kiyohara 		if (strlen(what) > sizeof str - 5)
    313       1.1  kiyohara 			printf("boot string too large, ignored\n");
    314       1.1  kiyohara 		else {
    315       1.1  kiyohara 			strcpy(str, what);
    316       1.1  kiyohara 			ap1 = ap = str + strlen(str);
    317       1.1  kiyohara 			*ap++ = ' ';
    318       1.1  kiyohara 		}
    319       1.1  kiyohara 	}
    320       1.1  kiyohara 	*ap++ = '-';
    321       1.1  kiyohara 	if (howto & RB_SINGLE)
    322       1.1  kiyohara 		*ap++ = 's';
    323       1.1  kiyohara 	if (howto & RB_KDB)
    324       1.1  kiyohara 		*ap++ = 'd';
    325       1.1  kiyohara 	*ap++ = 0;
    326       1.1  kiyohara 	if (ap[-2] == '-')
    327       1.1  kiyohara 		*ap1 = 0;
    328       1.1  kiyohara 
    329       1.1  kiyohara 	/* flush cache for msgbuf */
    330       1.1  kiyohara 	__syncicache((void *)msgbuf_paddr, round_page(MSGBUFSIZE));
    331       1.1  kiyohara 
    332       1.1  kiyohara #if 0
    333       1.1  kiyohara  reboot:
    334       1.1  kiyohara #endif
    335       1.1  kiyohara 	ppc4xx_reset();
    336       1.1  kiyohara 
    337       1.1  kiyohara 	printf("ppc4xx_reset() failed!\n");
    338       1.1  kiyohara #ifdef DDB
    339       1.1  kiyohara 	while(1)
    340       1.1  kiyohara 		Debugger();
    341       1.1  kiyohara #else
    342       1.1  kiyohara 	while (1)
    343       1.1  kiyohara 		/* nothing */;
    344       1.1  kiyohara #endif
    345       1.1  kiyohara }
    346       1.1  kiyohara 
    347       1.9  kiyohara /*
    348       1.9  kiyohara  * Read EEPROM via I2C.  We don't use bus_space(9) here.  This is MD-part and,
    349       1.9  kiyohara  * don't support bus_space_unmap() to a space on reserved space? X-<
    350       1.9  kiyohara  *
    351       1.9  kiyohara  * XXXX: Also this function assume already initialized for I2C...
    352       1.9  kiyohara  */
    353       1.1  kiyohara static int
    354       1.1  kiyohara read_eeprom(int len, char *buf)
    355       1.1  kiyohara {
    356       1.9  kiyohara 	volatile uint8_t *iic0;
    357       1.9  kiyohara #define IIC0_READ(r)		(*(iic0 + (r)))
    358       1.9  kiyohara #define IIC0_WRITE(r, v)	(*(iic0 + (r)) = (v))
    359       1.9  kiyohara 	uint8_t sts;
    360       1.1  kiyohara 	int cnt, i = 0;
    361       1.1  kiyohara 
    362       1.1  kiyohara #define I2C_EEPROM_ADDR	0x52
    363       1.1  kiyohara 
    364       1.9  kiyohara 	if ((iic0 = ppc4xx_tlb_mapiodev(AMCC405EX_IIC0_BASE, IIC_NREG)) == NULL)
    365       1.1  kiyohara 		return ENOMEM; /* ??? */
    366       1.1  kiyohara 
    367       1.1  kiyohara 	/* Clear Stop Complete Bit */
    368       1.9  kiyohara 	IIC0_WRITE(IIC_STS, IIC_STS_SCMP);
    369       1.1  kiyohara 	/* Check init */
    370       1.1  kiyohara 	do {
    371       1.1  kiyohara 		/* Get status */
    372       1.9  kiyohara 		sts = IIC0_READ(IIC_STS);
    373       1.1  kiyohara 	} while ((sts & IIC_STS_PT));
    374       1.1  kiyohara 
    375       1.9  kiyohara 	IIC0_WRITE(IIC_MDCNTL,
    376       1.9  kiyohara 	    IIC0_READ(IIC_MDCNTL) | IIC_MDCNTL_FMDB | IIC_MDCNTL_FSDB);
    377       1.1  kiyohara 
    378       1.1  kiyohara 	/* 7-bit adressing */
    379       1.9  kiyohara 	IIC0_WRITE(IIC_HMADR, 0);
    380       1.9  kiyohara 	IIC0_WRITE(IIC_LMADR, I2C_EEPROM_ADDR << 1);
    381       1.1  kiyohara 
    382       1.9  kiyohara 	IIC0_WRITE(IIC_MDBUF, 0);
    383       1.9  kiyohara 	IIC0_WRITE(IIC_CNTL, IIC_CNTL_PT);
    384       1.1  kiyohara 	do {
    385       1.1  kiyohara 		/* Get status */
    386       1.9  kiyohara 		sts = IIC0_READ(IIC_STS);
    387       1.1  kiyohara 	} while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
    388       1.1  kiyohara 
    389       1.1  kiyohara 	cnt = 0;
    390       1.1  kiyohara 	while (cnt < len) {
    391       1.1  kiyohara 		/* always read 4byte */
    392       1.9  kiyohara 		IIC0_WRITE(IIC_CNTL,
    393       1.9  kiyohara 		    IIC_CNTL_PT				|
    394       1.9  kiyohara 		    IIC_CNTL_RW				|
    395       1.9  kiyohara 		    ((cnt == 0) ? IIC_CNTL_RPST : 0)	|
    396       1.9  kiyohara 		    IIC_CNTL_TCT);
    397       1.1  kiyohara 		do {
    398       1.1  kiyohara 			/* Get status */
    399       1.9  kiyohara 			sts = IIC0_READ(IIC_STS);
    400       1.1  kiyohara 		} while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
    401       1.1  kiyohara 
    402       1.1  kiyohara 		if ((sts & IIC_STS_PT) || (sts & IIC_STS_ERR))
    403       1.1  kiyohara 			break;
    404       1.1  kiyohara 		if (sts & IIC_STS_MDBS) {
    405       1.1  kiyohara 			delay(1);
    406       1.1  kiyohara 			/* read 4byte */
    407       1.1  kiyohara 			for (i = 0; i < 4 && cnt < len; i++, cnt++)
    408       1.9  kiyohara 				buf[cnt] = IIC0_READ(IIC_MDBUF);
    409       1.1  kiyohara 		}
    410       1.1  kiyohara 	}
    411       1.1  kiyohara 	for ( ; i < 4; i++)
    412       1.9  kiyohara 		(void) IIC0_READ(IIC_MDBUF);
    413       1.1  kiyohara 
    414       1.1  kiyohara 	return (cnt == len) ? 0 : EINVAL;
    415       1.1  kiyohara }
    416