Home | History | Annotate | Line # | Download | only in xscale
pxa2x0_i2c.c revision 1.3.34.1
      1  1.3.34.1    jym /*	$NetBSD: pxa2x0_i2c.c,v 1.3.34.1 2009/05/13 17:16:18 jym 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.3.34.1    jym __KERNEL_RCSID(0, "$NetBSD: pxa2x0_i2c.c,v 1.3.34.1 2009/05/13 17:16:18 jym 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.3.34.1    jym /*
    239  1.3.34.1    jym  * XXX The quick_{read,write} opertions are untested!
    240  1.3.34.1    jym  */
    241  1.3.34.1    jym int
    242  1.3.34.1    jym pxa2x0_i2c_quick(struct pxa2x0_i2c_softc *sc, u_char slave, u_char rw)
    243  1.3.34.1    jym {
    244  1.3.34.1    jym 	bus_space_tag_t iot = sc->sc_iot;
    245  1.3.34.1    jym 	bus_space_handle_t ioh = sc->sc_ioh;
    246  1.3.34.1    jym 	int timeout;
    247  1.3.34.1    jym 	int tries = I2C_RETRY_COUNT;
    248  1.3.34.1    jym 	uint32_t rv;
    249  1.3.34.1    jym 
    250  1.3.34.1    jym retry:
    251  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    252  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    253  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    254  1.3.34.1    jym 	delay(1);
    255  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    256  1.3.34.1    jym 
    257  1.3.34.1    jym 	/* Write slave device address. */
    258  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1) | (rw & 1));
    259  1.3.34.1    jym 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    260  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    261  1.3.34.1    jym 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    262  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_STOP);
    263  1.3.34.1    jym 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    264  1.3.34.1    jym 
    265  1.3.34.1    jym 	timeout = 10000;
    266  1.3.34.1    jym 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    267  1.3.34.1    jym 		if (timeout-- == 0)
    268  1.3.34.1    jym 			goto err;
    269  1.3.34.1    jym 		delay(1);
    270  1.3.34.1    jym 	}
    271  1.3.34.1    jym 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    272  1.3.34.1    jym 		goto err;
    273  1.3.34.1    jym 
    274  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    275  1.3.34.1    jym 
    276  1.3.34.1    jym 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    277  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    278  1.3.34.1    jym 
    279  1.3.34.1    jym 	return 0;
    280  1.3.34.1    jym 
    281  1.3.34.1    jym err:
    282  1.3.34.1    jym 	if (tries-- >= 0)
    283  1.3.34.1    jym 		goto retry;
    284  1.3.34.1    jym 
    285  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    286  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    287  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    288  1.3.34.1    jym 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    289  1.3.34.1    jym 
    290  1.3.34.1    jym 	return EIO;
    291  1.3.34.1    jym }
    292  1.3.34.1    jym 
    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