Home | History | Annotate | Line # | Download | only in xscale
pxa2x0_i2c.c revision 1.4
      1  1.4  pgoyette /*	$NetBSD: pxa2x0_i2c.c,v 1.4 2009/04/20 12:55:02 pgoyette Exp $	*/
      2  1.1     peter /*	$OpenBSD: pxa2x0_i2c.c,v 1.2 2005/05/26 03:52:07 pascoe Exp $	*/
      3  1.1     peter 
      4  1.1     peter /*
      5  1.1     peter  * Copyright (c) 2005 Christopher Pascoe <pascoe (at) openbsd.org>
      6  1.1     peter  *
      7  1.1     peter  * Permission to use, copy, modify, and distribute this software for any
      8  1.1     peter  * purpose with or without fee is hereby granted, provided that the above
      9  1.1     peter  * copyright notice and this permission notice appear in all copies.
     10  1.1     peter  *
     11  1.1     peter  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     12  1.1     peter  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     13  1.1     peter  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     14  1.1     peter  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     15  1.1     peter  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     16  1.1     peter  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     17  1.1     peter  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     18  1.1     peter  */
     19  1.1     peter 
     20  1.1     peter #include <sys/cdefs.h>
     21  1.4  pgoyette __KERNEL_RCSID(0, "$NetBSD: pxa2x0_i2c.c,v 1.4 2009/04/20 12:55:02 pgoyette Exp $");
     22  1.1     peter 
     23  1.1     peter #include <sys/param.h>
     24  1.1     peter #include <sys/systm.h>
     25  1.1     peter #include <sys/device.h>
     26  1.1     peter 
     27  1.1     peter #include <machine/bus.h>
     28  1.1     peter 
     29  1.1     peter #include <arm/xscale/pxa2x0reg.h>
     30  1.1     peter #include <arm/xscale/pxa2x0var.h>
     31  1.1     peter #include <arm/xscale/pxa2x0_i2c.h>
     32  1.1     peter #include <arm/xscale/pxa2x0_gpio.h>
     33  1.1     peter 
     34  1.1     peter #define I2C_RETRY_COUNT	10
     35  1.1     peter 
     36  1.1     peter int
     37  1.1     peter pxa2x0_i2c_attach_sub(struct pxa2x0_i2c_softc *sc)
     38  1.1     peter {
     39  1.1     peter 
     40  1.1     peter 	if (bus_space_map(sc->sc_iot, PXA2X0_I2C_BASE,
     41  1.1     peter 	    PXA2X0_I2C_SIZE, 0, &sc->sc_ioh)) {
     42  1.1     peter 		sc->sc_size = 0;
     43  1.1     peter 		return EIO;
     44  1.1     peter 	}
     45  1.1     peter 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, 0, sc->sc_size,
     46  1.1     peter 	    BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE);
     47  1.1     peter 
     48  1.1     peter 	pxa2x0_i2c_init(sc);
     49  1.1     peter 
     50  1.1     peter 	return 0;
     51  1.1     peter }
     52  1.1     peter 
     53  1.1     peter int
     54  1.1     peter pxa2x0_i2c_detach_sub(struct pxa2x0_i2c_softc *sc)
     55  1.1     peter {
     56  1.1     peter 
     57  1.1     peter 	if (sc->sc_size) {
     58  1.1     peter 		bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_size);
     59  1.1     peter 		sc->sc_size = 0;
     60  1.1     peter 	}
     61  1.1     peter 	pxa2x0_clkman_config(CKEN_I2C, 0);
     62  1.1     peter 
     63  1.1     peter 	return 0;
     64  1.1     peter }
     65  1.1     peter 
     66  1.1     peter void
     67  1.1     peter pxa2x0_i2c_init(struct pxa2x0_i2c_softc *sc)
     68  1.1     peter {
     69  1.1     peter 
     70  1.1     peter 	pxa2x0_i2c_open(sc);
     71  1.1     peter 	pxa2x0_i2c_close(sc);
     72  1.1     peter }
     73  1.1     peter 
     74  1.1     peter void
     75  1.1     peter pxa2x0_i2c_open(struct pxa2x0_i2c_softc *sc)
     76  1.1     peter {
     77  1.1     peter 
     78  1.1     peter 	/* Enable the clock to the standard I2C unit. */
     79  1.1     peter 	pxa2x0_clkman_config(CKEN_I2C, 1);
     80  1.1     peter }
     81  1.1     peter 
     82  1.1     peter void
     83  1.1     peter pxa2x0_i2c_close(struct pxa2x0_i2c_softc *sc)
     84  1.1     peter {
     85  1.1     peter 
     86  1.1     peter 	/* Reset and disable the standard I2C unit. */
     87  1.1     peter 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, I2C_ICR, ICR_UR);
     88  1.1     peter 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, I2C_ISAR, 0);
     89  1.1     peter 	delay(1);
     90  1.1     peter 	pxa2x0_clkman_config(CKEN_I2C, 0);
     91  1.1     peter }
     92  1.1     peter 
     93  1.1     peter int
     94  1.1     peter pxa2x0_i2c_read(struct pxa2x0_i2c_softc *sc, u_char slave, u_char *valuep)
     95  1.1     peter {
     96  1.1     peter 	bus_space_tag_t iot = sc->sc_iot;
     97  1.1     peter 	bus_space_handle_t ioh = sc->sc_ioh;
     98  1.1     peter 	int timeout;
     99  1.1     peter 	int tries = I2C_RETRY_COUNT;
    100  1.1     peter 	uint32_t rv;
    101  1.1     peter 
    102  1.1     peter retry:
    103  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    104  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    105  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE | ISR_IRF);
    106  1.1     peter 	delay(1);
    107  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    108  1.1     peter 
    109  1.1     peter 	/* Write slave device address. */
    110  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1) | 0x1);
    111  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    112  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    113  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    114  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    115  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    116  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    117  1.1     peter 
    118  1.1     peter 	timeout = 10000;
    119  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    120  1.1     peter 		if (timeout-- == 0)
    121  1.1     peter 			goto err;
    122  1.1     peter 		delay(1);
    123  1.1     peter 	}
    124  1.1     peter 
    125  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    126  1.1     peter 
    127  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    128  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    129  1.1     peter 
    130  1.1     peter 	/* Read data value. */
    131  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    132  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv |
    133  1.1     peter 	    (ICR_STOP | ICR_ACKNAK));
    134  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    135  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    136  1.1     peter 
    137  1.1     peter 	timeout = 10000;
    138  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_IRF) == 0) {
    139  1.1     peter 		if (timeout-- == 0)
    140  1.1     peter 			goto err;
    141  1.1     peter 		delay(1);
    142  1.1     peter 	}
    143  1.1     peter 
    144  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_IRF);
    145  1.1     peter 
    146  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_IDBR);
    147  1.1     peter 	*valuep = (u_char)rv;
    148  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    149  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~(ICR_STOP | ICR_ACKNAK));
    150  1.1     peter 
    151  1.1     peter 	return 0;
    152  1.1     peter 
    153  1.1     peter err:
    154  1.1     peter 	if (tries-- >= 0)
    155  1.1     peter 		goto retry;
    156  1.1     peter 
    157  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    158  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    159  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE | ISR_IRF);
    160  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    161  1.1     peter 
    162  1.1     peter 	return EIO;
    163  1.1     peter }
    164  1.1     peter 
    165  1.1     peter int
    166  1.1     peter pxa2x0_i2c_write(struct pxa2x0_i2c_softc *sc, u_char slave, u_char value)
    167  1.1     peter {
    168  1.1     peter 	bus_space_tag_t iot = sc->sc_iot;
    169  1.1     peter 	bus_space_handle_t ioh = sc->sc_ioh;
    170  1.1     peter 	int timeout;
    171  1.1     peter 	int tries = I2C_RETRY_COUNT;
    172  1.1     peter 	uint32_t rv;
    173  1.1     peter 
    174  1.1     peter retry:
    175  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    176  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    177  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    178  1.1     peter 	delay(1);
    179  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    180  1.1     peter 
    181  1.1     peter 	/* Write slave device address. */
    182  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1));
    183  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    184  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    185  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    186  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    187  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    188  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    189  1.1     peter 
    190  1.1     peter 	timeout = 10000;
    191  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    192  1.1     peter 		if (timeout-- == 0)
    193  1.1     peter 			goto err;
    194  1.1     peter 		delay(1);
    195  1.1     peter 	}
    196  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    197  1.1     peter 		goto err;
    198  1.1     peter 
    199  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    200  1.1     peter 
    201  1.1     peter 	/* Write data. */
    202  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    203  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    204  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    205  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_STOP);
    206  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, value);
    207  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    208  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    209  1.1     peter 
    210  1.1     peter 	timeout = 10000;
    211  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    212  1.1     peter 		if (timeout-- == 0)
    213  1.1     peter 			goto err;
    214  1.1     peter 		delay(1);
    215  1.1     peter 	}
    216  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    217  1.1     peter 		goto err;
    218  1.1     peter 
    219  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    220  1.1     peter 
    221  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    222  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    223  1.1     peter 
    224  1.1     peter 	return 0;
    225  1.1     peter 
    226  1.1     peter err:
    227  1.1     peter 	if (tries-- >= 0)
    228  1.1     peter 		goto retry;
    229  1.1     peter 
    230  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    231  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    232  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    233  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    234  1.1     peter 
    235  1.1     peter 	return EIO;
    236  1.1     peter }
    237  1.1     peter 
    238  1.4  pgoyette /*
    239  1.4  pgoyette  * XXX The quick_{read,write} opertions are untested!
    240  1.4  pgoyette  */
    241  1.4  pgoyette int
    242  1.4  pgoyette pxa2x0_i2c_quick(struct pxa2x0_i2c_softc *sc, u_char slave, u_char rw)
    243  1.4  pgoyette {
    244  1.4  pgoyette 	bus_space_tag_t iot = sc->sc_iot;
    245  1.4  pgoyette 	bus_space_handle_t ioh = sc->sc_ioh;
    246  1.4  pgoyette 	int timeout;
    247  1.4  pgoyette 	int tries = I2C_RETRY_COUNT;
    248  1.4  pgoyette 	uint32_t rv;
    249  1.4  pgoyette 
    250  1.4  pgoyette retry:
    251  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    252  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    253  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    254  1.4  pgoyette 	delay(1);
    255  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    256  1.4  pgoyette 
    257  1.4  pgoyette 	/* Write slave device address. */
    258  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1) | (rw & 1));
    259  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    260  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    261  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    262  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_STOP);
    263  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    264  1.4  pgoyette 
    265  1.4  pgoyette 	timeout = 10000;
    266  1.4  pgoyette 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    267  1.4  pgoyette 		if (timeout-- == 0)
    268  1.4  pgoyette 			goto err;
    269  1.4  pgoyette 		delay(1);
    270  1.4  pgoyette 	}
    271  1.4  pgoyette 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    272  1.4  pgoyette 		goto err;
    273  1.4  pgoyette 
    274  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    275  1.4  pgoyette 
    276  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    277  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    278  1.4  pgoyette 
    279  1.4  pgoyette 	return 0;
    280  1.4  pgoyette 
    281  1.4  pgoyette err:
    282  1.4  pgoyette 	if (tries-- >= 0)
    283  1.4  pgoyette 		goto retry;
    284  1.4  pgoyette 
    285  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    286  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    287  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    288  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    289  1.4  pgoyette 
    290  1.4  pgoyette 	return EIO;
    291  1.4  pgoyette }
    292  1.4  pgoyette 
    293  1.1     peter int
    294  1.1     peter pxa2x0_i2c_write_2(struct pxa2x0_i2c_softc *sc, u_char slave, u_short value)
    295  1.1     peter {
    296  1.1     peter 	bus_space_tag_t iot = sc->sc_iot;
    297  1.1     peter 	bus_space_handle_t ioh = sc->sc_ioh;
    298  1.1     peter 	int timeout;
    299  1.1     peter 	int tries = I2C_RETRY_COUNT;
    300  1.1     peter 	uint32_t rv;
    301  1.1     peter 
    302  1.1     peter retry:
    303  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    304  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    305  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    306  1.1     peter 	delay(1);
    307  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    308  1.1     peter 
    309  1.1     peter 	/* Write slave device address. */
    310  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1));
    311  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    312  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    313  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    314  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    315  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    316  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    317  1.1     peter 
    318  1.1     peter 	timeout = 10000;
    319  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    320  1.1     peter 		if (timeout-- == 0)
    321  1.1     peter 			goto err;
    322  1.1     peter 		delay(1);
    323  1.1     peter 	}
    324  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    325  1.1     peter 		goto err;
    326  1.1     peter 
    327  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    328  1.1     peter 
    329  1.1     peter 	/* Write upper 8 bits of data. */
    330  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (value >> 8) & 0xff);
    331  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    332  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    333  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    334  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    335  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    336  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    337  1.1     peter 
    338  1.1     peter 	timeout = 10000;
    339  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    340  1.1     peter 		if (timeout-- == 0)
    341  1.1     peter 			goto err;
    342  1.1     peter 		delay(1);
    343  1.1     peter 	}
    344  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    345  1.1     peter 		goto err;
    346  1.1     peter 
    347  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    348  1.1     peter 
    349  1.1     peter 	/* Write lower 8 bits of data. */
    350  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, value & 0xff);
    351  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    352  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    353  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    354  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_STOP);
    355  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    356  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    357  1.1     peter 
    358  1.1     peter 	timeout = 10000;
    359  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    360  1.1     peter 		if (timeout-- == 0)
    361  1.1     peter 			goto err;
    362  1.1     peter 		delay(1);
    363  1.1     peter 	}
    364  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    365  1.1     peter 		goto err;
    366  1.1     peter 
    367  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    368  1.1     peter 
    369  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    370  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    371  1.1     peter 
    372  1.1     peter 	return 0;
    373  1.1     peter 
    374  1.1     peter err:
    375  1.1     peter 	if (tries-- >= 0)
    376  1.1     peter 		goto retry;
    377  1.1     peter 
    378  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    379  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    380  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    381  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    382  1.1     peter 
    383  1.1     peter 	return EIO;
    384  1.1     peter }
    385