Home | History | Annotate | Line # | Download | only in obs405
obs600_machdep.c revision 1.7.6.1
      1  1.7.6.1       mrg /*	$NetBSD: obs600_machdep.c,v 1.7.6.1 2012/02/18 07:31:59 mrg 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.7.6.1       mrg __KERNEL_RCSID(0, "$NetBSD: obs600_machdep.c,v 1.7.6.1 2012/02/18 07:31:59 mrg 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.7.6.1       mrg 	/*
    219  1.7.6.1       mrg 	 * Now that we have VM, malloc()s are OK in bus_space.
    220  1.7.6.1       mrg 	 */
    221  1.7.6.1       mrg 	bus_space_mallocok();
    222  1.7.6.1       mrg 
    223      1.1  kiyohara 	read_eeprom(sizeof(buf), buf);
    224      1.1  kiyohara 	macaddr = &buf[0];
    225      1.1  kiyohara 	macaddr1 = &buf[8];
    226      1.1  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.1  kiyohara /* This function assume already initialized for I2C... */
    357      1.1  kiyohara static int
    358      1.1  kiyohara read_eeprom(int len, char *buf)
    359      1.1  kiyohara {
    360      1.1  kiyohara 	bus_space_tag_t bst = opb_get_bus_space_tag();
    361      1.1  kiyohara 	bus_space_handle_t bsh;
    362      1.1  kiyohara 	uint8_t mdcntl, sts;
    363      1.1  kiyohara 	int cnt, i = 0;
    364      1.1  kiyohara 
    365      1.1  kiyohara #define I2C_EEPROM_ADDR	0x52
    366      1.1  kiyohara 
    367      1.1  kiyohara 	if (bus_space_map(bst, AMCC405EX_IIC0_BASE, IIC_NREG, 0, &bsh))
    368      1.1  kiyohara 		return ENOMEM; /* ??? */
    369      1.1  kiyohara 
    370      1.1  kiyohara 	/* Clear Stop Complete Bit */
    371      1.1  kiyohara 	bus_space_write_1(bst, bsh, IIC_STS, IIC_STS_SCMP);
    372      1.1  kiyohara 	/* Check init */
    373      1.1  kiyohara 	do {
    374      1.1  kiyohara 		/* Get status */
    375      1.1  kiyohara 		sts = bus_space_read_1(bst, bsh, IIC_STS);
    376      1.1  kiyohara 	} while ((sts & IIC_STS_PT));
    377      1.1  kiyohara 
    378      1.1  kiyohara 	mdcntl = bus_space_read_1(bst, bsh, IIC_MDCNTL);
    379      1.1  kiyohara 	bus_space_write_1(bst, bsh, IIC_MDCNTL,
    380      1.1  kiyohara 	    mdcntl | IIC_MDCNTL_FMDB | IIC_MDCNTL_FSDB);
    381      1.1  kiyohara 
    382      1.1  kiyohara 	/* 7-bit adressing */
    383      1.1  kiyohara 	bus_space_write_1(bst, bsh, IIC_HMADR, 0);
    384      1.1  kiyohara 	bus_space_write_1(bst, bsh, IIC_LMADR, I2C_EEPROM_ADDR << 1);
    385      1.1  kiyohara 
    386      1.1  kiyohara 	bus_space_write_1(bst, bsh, IIC_MDBUF, 0);
    387      1.1  kiyohara 	bus_space_write_1(bst, bsh, IIC_CNTL, IIC_CNTL_PT);
    388      1.1  kiyohara 	do {
    389      1.1  kiyohara 		/* Get status */
    390      1.1  kiyohara 		sts = bus_space_read_1(bst, bsh, IIC_STS);
    391      1.1  kiyohara 	} while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
    392      1.1  kiyohara 
    393      1.1  kiyohara 	cnt = 0;
    394      1.1  kiyohara 	while (cnt < len) {
    395      1.1  kiyohara 		/* always read 4byte */
    396      1.1  kiyohara 		bus_space_write_1(bst, bsh, IIC_CNTL,
    397      1.1  kiyohara 		    IIC_CNTL_PT | IIC_CNTL_RW | IIC_CNTL_TCT);
    398      1.1  kiyohara 		do {
    399      1.1  kiyohara 			/* Get status */
    400      1.1  kiyohara 			sts = bus_space_read_1(bst, bsh, IIC_STS);
    401      1.1  kiyohara 		} while ((sts & IIC_STS_PT) && !(sts & IIC_STS_ERR));
    402      1.1  kiyohara 
    403      1.1  kiyohara 		if ((sts & IIC_STS_PT) || (sts & IIC_STS_ERR))
    404      1.1  kiyohara 			break;
    405      1.1  kiyohara 		if (sts & IIC_STS_MDBS) {
    406      1.1  kiyohara 			delay(1);
    407      1.1  kiyohara 			/* read 4byte */
    408      1.1  kiyohara 			for (i = 0; i < 4 && cnt < len; i++, cnt++)
    409      1.1  kiyohara 				buf[cnt] =
    410      1.1  kiyohara 				    bus_space_read_1(bst, bsh, IIC_MDBUF);
    411      1.1  kiyohara 		}
    412      1.1  kiyohara 	}
    413      1.1  kiyohara 	for ( ; i < 4; i++)
    414      1.1  kiyohara 		(void) bus_space_read_1(bst, bsh, IIC_MDBUF);
    415      1.1  kiyohara 
    416  1.7.6.1       mrg #if 0	/* Ooops, can't unmap here... */
    417      1.1  kiyohara 	bus_space_unmap(bst, bsh, IIC_NREG);
    418  1.7.6.1       mrg #endif
    419      1.1  kiyohara 
    420      1.1  kiyohara 	return (cnt == len) ? 0 : EINVAL;
    421      1.1  kiyohara }
    422