Home | History | Annotate | Line # | Download | only in obs405
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