Home | History | Annotate | Line # | Download | only in xscale
pxa2x0_i2c.c revision 1.5
      1  1.5    nonaka /*	$NetBSD: pxa2x0_i2c.c,v 1.5 2011/06/19 16:16:42 nonaka 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.5    nonaka __KERNEL_RCSID(0, "$NetBSD: pxa2x0_i2c.c,v 1.5 2011/06/19 16:16:42 nonaka 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.5    nonaka #include <sys/bus.h>
     27  1.1     peter 
     28  1.5    nonaka #include <dev/i2c/i2cvar.h>
     29  1.1     peter 
     30  1.1     peter #include <arm/xscale/pxa2x0reg.h>
     31  1.1     peter #include <arm/xscale/pxa2x0var.h>
     32  1.1     peter #include <arm/xscale/pxa2x0_i2c.h>
     33  1.5    nonaka 
     34  1.5    nonaka #ifdef PXAIIC_DEBUG
     35  1.5    nonaka #define	DPRINTF(s)	printf s
     36  1.5    nonaka #else
     37  1.5    nonaka #define	DPRINTF(s)	do { } while (/*CONSTCOND*/0)
     38  1.5    nonaka #endif
     39  1.1     peter 
     40  1.1     peter #define I2C_RETRY_COUNT	10
     41  1.1     peter 
     42  1.1     peter int
     43  1.1     peter pxa2x0_i2c_attach_sub(struct pxa2x0_i2c_softc *sc)
     44  1.1     peter {
     45  1.5    nonaka 	int error;
     46  1.1     peter 
     47  1.5    nonaka 	error = bus_space_map(sc->sc_iot, PXA2X0_I2C_BASE, sc->sc_size, 0,
     48  1.5    nonaka 	    &sc->sc_ioh);
     49  1.5    nonaka 	if (error) {
     50  1.5    nonaka 		aprint_error_dev(sc->sc_dev, "unable to map register\n");
     51  1.1     peter 		sc->sc_size = 0;
     52  1.5    nonaka 		return error;
     53  1.1     peter 	}
     54  1.5    nonaka 
     55  1.1     peter 	bus_space_barrier(sc->sc_iot, sc->sc_ioh, 0, sc->sc_size,
     56  1.1     peter 	    BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE);
     57  1.1     peter 
     58  1.5    nonaka 	sc->sc_icr = ICR_GCD | ICR_SCLE | ICR_IUE;
     59  1.5    nonaka #if 0
     60  1.5    nonaka 	if (ISSET(sc->sc_flags, PI2CF_ENABLE_INTR))
     61  1.5    nonaka 		sc->sc_icr |= ICR_BEIE | ICR_DRFIE | ICR_ITEIE;
     62  1.5    nonaka #endif
     63  1.5    nonaka 	if (ISSET(sc->sc_flags, PI2CF_FAST_MODE))
     64  1.5    nonaka 		sc->sc_icr |= ICR_FM;
     65  1.5    nonaka 
     66  1.1     peter 	pxa2x0_i2c_init(sc);
     67  1.1     peter 
     68  1.1     peter 	return 0;
     69  1.1     peter }
     70  1.1     peter 
     71  1.1     peter int
     72  1.1     peter pxa2x0_i2c_detach_sub(struct pxa2x0_i2c_softc *sc)
     73  1.1     peter {
     74  1.1     peter 
     75  1.5    nonaka 	if (sc->sc_size != 0) {
     76  1.1     peter 		bus_space_unmap(sc->sc_iot, sc->sc_ioh, sc->sc_size);
     77  1.1     peter 		sc->sc_size = 0;
     78  1.1     peter 	}
     79  1.1     peter 	pxa2x0_clkman_config(CKEN_I2C, 0);
     80  1.1     peter 	return 0;
     81  1.1     peter }
     82  1.1     peter 
     83  1.1     peter void
     84  1.1     peter pxa2x0_i2c_init(struct pxa2x0_i2c_softc *sc)
     85  1.1     peter {
     86  1.1     peter 
     87  1.1     peter 	pxa2x0_i2c_open(sc);
     88  1.1     peter 	pxa2x0_i2c_close(sc);
     89  1.1     peter }
     90  1.1     peter 
     91  1.1     peter void
     92  1.1     peter pxa2x0_i2c_open(struct pxa2x0_i2c_softc *sc)
     93  1.1     peter {
     94  1.1     peter 
     95  1.1     peter 	/* Enable the clock to the standard I2C unit. */
     96  1.1     peter 	pxa2x0_clkman_config(CKEN_I2C, 1);
     97  1.1     peter }
     98  1.1     peter 
     99  1.1     peter void
    100  1.1     peter pxa2x0_i2c_close(struct pxa2x0_i2c_softc *sc)
    101  1.1     peter {
    102  1.1     peter 
    103  1.1     peter 	/* Reset and disable the standard I2C unit. */
    104  1.1     peter 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, I2C_ICR, ICR_UR);
    105  1.1     peter 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, I2C_ISAR, 0);
    106  1.1     peter 	delay(1);
    107  1.1     peter 	pxa2x0_clkman_config(CKEN_I2C, 0);
    108  1.1     peter }
    109  1.1     peter 
    110  1.1     peter int
    111  1.1     peter pxa2x0_i2c_read(struct pxa2x0_i2c_softc *sc, u_char slave, u_char *valuep)
    112  1.1     peter {
    113  1.1     peter 	bus_space_tag_t iot = sc->sc_iot;
    114  1.1     peter 	bus_space_handle_t ioh = sc->sc_ioh;
    115  1.1     peter 	int timeout;
    116  1.1     peter 	int tries = I2C_RETRY_COUNT;
    117  1.1     peter 	uint32_t rv;
    118  1.1     peter 
    119  1.1     peter retry:
    120  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    121  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    122  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE | ISR_IRF);
    123  1.1     peter 	delay(1);
    124  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    125  1.1     peter 
    126  1.1     peter 	/* Write slave device address. */
    127  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1) | 0x1);
    128  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    129  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    130  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    131  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    132  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    133  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    134  1.1     peter 
    135  1.1     peter 	timeout = 10000;
    136  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    137  1.1     peter 		if (timeout-- == 0)
    138  1.1     peter 			goto err;
    139  1.1     peter 		delay(1);
    140  1.1     peter 	}
    141  1.1     peter 
    142  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    143  1.1     peter 
    144  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    145  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    146  1.1     peter 
    147  1.1     peter 	/* Read data value. */
    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 |
    150  1.1     peter 	    (ICR_STOP | ICR_ACKNAK));
    151  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    152  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    153  1.1     peter 
    154  1.1     peter 	timeout = 10000;
    155  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_IRF) == 0) {
    156  1.1     peter 		if (timeout-- == 0)
    157  1.1     peter 			goto err;
    158  1.1     peter 		delay(1);
    159  1.1     peter 	}
    160  1.1     peter 
    161  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_IRF);
    162  1.1     peter 
    163  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_IDBR);
    164  1.1     peter 	*valuep = (u_char)rv;
    165  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    166  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~(ICR_STOP | ICR_ACKNAK));
    167  1.1     peter 
    168  1.1     peter 	return 0;
    169  1.1     peter 
    170  1.1     peter err:
    171  1.1     peter 	if (tries-- >= 0)
    172  1.1     peter 		goto retry;
    173  1.1     peter 
    174  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    175  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    176  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE | ISR_IRF);
    177  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    178  1.1     peter 
    179  1.1     peter 	return EIO;
    180  1.1     peter }
    181  1.1     peter 
    182  1.1     peter int
    183  1.1     peter pxa2x0_i2c_write(struct pxa2x0_i2c_softc *sc, u_char slave, u_char value)
    184  1.1     peter {
    185  1.1     peter 	bus_space_tag_t iot = sc->sc_iot;
    186  1.1     peter 	bus_space_handle_t ioh = sc->sc_ioh;
    187  1.1     peter 	int timeout;
    188  1.1     peter 	int tries = I2C_RETRY_COUNT;
    189  1.1     peter 	uint32_t rv;
    190  1.1     peter 
    191  1.1     peter retry:
    192  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    193  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    194  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    195  1.1     peter 	delay(1);
    196  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    197  1.1     peter 
    198  1.1     peter 	/* Write slave device address. */
    199  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1));
    200  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    201  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    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_STOP);
    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_TB);
    206  1.1     peter 
    207  1.1     peter 	timeout = 10000;
    208  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    209  1.1     peter 		if (timeout-- == 0)
    210  1.1     peter 			goto err;
    211  1.1     peter 		delay(1);
    212  1.1     peter 	}
    213  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    214  1.1     peter 		goto err;
    215  1.1     peter 
    216  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    217  1.1     peter 
    218  1.1     peter 	/* Write data. */
    219  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    220  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    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 	bus_space_write_4(iot, ioh, I2C_IDBR, value);
    224  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    225  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    226  1.1     peter 
    227  1.1     peter 	timeout = 10000;
    228  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    229  1.1     peter 		if (timeout-- == 0)
    230  1.1     peter 			goto err;
    231  1.1     peter 		delay(1);
    232  1.1     peter 	}
    233  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    234  1.1     peter 		goto err;
    235  1.1     peter 
    236  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    237  1.1     peter 
    238  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    239  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    240  1.1     peter 
    241  1.1     peter 	return 0;
    242  1.1     peter 
    243  1.1     peter err:
    244  1.1     peter 	if (tries-- >= 0)
    245  1.1     peter 		goto retry;
    246  1.1     peter 
    247  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    248  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    249  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    250  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    251  1.1     peter 
    252  1.1     peter 	return EIO;
    253  1.1     peter }
    254  1.1     peter 
    255  1.4  pgoyette /*
    256  1.4  pgoyette  * XXX The quick_{read,write} opertions are untested!
    257  1.4  pgoyette  */
    258  1.4  pgoyette int
    259  1.4  pgoyette pxa2x0_i2c_quick(struct pxa2x0_i2c_softc *sc, u_char slave, u_char rw)
    260  1.4  pgoyette {
    261  1.4  pgoyette 	bus_space_tag_t iot = sc->sc_iot;
    262  1.4  pgoyette 	bus_space_handle_t ioh = sc->sc_ioh;
    263  1.4  pgoyette 	int timeout;
    264  1.4  pgoyette 	int tries = I2C_RETRY_COUNT;
    265  1.4  pgoyette 	uint32_t rv;
    266  1.4  pgoyette 
    267  1.4  pgoyette retry:
    268  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    269  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    270  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    271  1.4  pgoyette 	delay(1);
    272  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    273  1.4  pgoyette 
    274  1.4  pgoyette 	/* Write slave device address. */
    275  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1) | (rw & 1));
    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_START);
    278  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    279  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_STOP);
    280  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    281  1.4  pgoyette 
    282  1.4  pgoyette 	timeout = 10000;
    283  1.4  pgoyette 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    284  1.4  pgoyette 		if (timeout-- == 0)
    285  1.4  pgoyette 			goto err;
    286  1.4  pgoyette 		delay(1);
    287  1.4  pgoyette 	}
    288  1.4  pgoyette 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    289  1.4  pgoyette 		goto err;
    290  1.4  pgoyette 
    291  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    292  1.4  pgoyette 
    293  1.4  pgoyette 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    294  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    295  1.4  pgoyette 
    296  1.4  pgoyette 	return 0;
    297  1.4  pgoyette 
    298  1.4  pgoyette err:
    299  1.4  pgoyette 	if (tries-- >= 0)
    300  1.4  pgoyette 		goto retry;
    301  1.4  pgoyette 
    302  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    303  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    304  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    305  1.4  pgoyette 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    306  1.4  pgoyette 
    307  1.4  pgoyette 	return EIO;
    308  1.4  pgoyette }
    309  1.4  pgoyette 
    310  1.1     peter int
    311  1.1     peter pxa2x0_i2c_write_2(struct pxa2x0_i2c_softc *sc, u_char slave, u_short value)
    312  1.1     peter {
    313  1.1     peter 	bus_space_tag_t iot = sc->sc_iot;
    314  1.1     peter 	bus_space_handle_t ioh = sc->sc_ioh;
    315  1.1     peter 	int timeout;
    316  1.1     peter 	int tries = I2C_RETRY_COUNT;
    317  1.1     peter 	uint32_t rv;
    318  1.1     peter 
    319  1.1     peter retry:
    320  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    321  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    322  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    323  1.1     peter 	delay(1);
    324  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    325  1.1     peter 
    326  1.1     peter 	/* Write slave device address. */
    327  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (slave<<1));
    328  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    329  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_START);
    330  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    331  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    332  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    333  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    334  1.1     peter 
    335  1.1     peter 	timeout = 10000;
    336  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    337  1.1     peter 		if (timeout-- == 0)
    338  1.1     peter 			goto err;
    339  1.1     peter 		delay(1);
    340  1.1     peter 	}
    341  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    342  1.1     peter 		goto err;
    343  1.1     peter 
    344  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    345  1.1     peter 
    346  1.1     peter 	/* Write upper 8 bits of data. */
    347  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, (value >> 8) & 0xff);
    348  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    349  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    350  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    351  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    352  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    353  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    354  1.1     peter 
    355  1.1     peter 	timeout = 10000;
    356  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    357  1.1     peter 		if (timeout-- == 0)
    358  1.1     peter 			goto err;
    359  1.1     peter 		delay(1);
    360  1.1     peter 	}
    361  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    362  1.1     peter 		goto err;
    363  1.1     peter 
    364  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    365  1.1     peter 
    366  1.1     peter 	/* Write lower 8 bits of data. */
    367  1.1     peter 	bus_space_write_4(iot, ioh, I2C_IDBR, value & 0xff);
    368  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    369  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_START);
    370  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    371  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_STOP);
    372  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    373  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv | ICR_TB);
    374  1.1     peter 
    375  1.1     peter 	timeout = 10000;
    376  1.1     peter 	while ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ITE) == 0) {
    377  1.1     peter 		if (timeout-- == 0)
    378  1.1     peter 			goto err;
    379  1.1     peter 		delay(1);
    380  1.1     peter 	}
    381  1.1     peter 	if ((bus_space_read_4(iot, ioh, I2C_ISR) & ISR_ACKNAK) != 0)
    382  1.1     peter 		goto err;
    383  1.1     peter 
    384  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    385  1.1     peter 
    386  1.1     peter 	rv = bus_space_read_4(iot, ioh, I2C_ICR);
    387  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, rv & ~ICR_STOP);
    388  1.1     peter 
    389  1.1     peter 	return 0;
    390  1.1     peter 
    391  1.1     peter err:
    392  1.1     peter 	if (tries-- >= 0)
    393  1.1     peter 		goto retry;
    394  1.1     peter 
    395  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_UR);
    396  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISAR, 0x00);
    397  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ISR, ISR_ITE);
    398  1.1     peter 	bus_space_write_4(iot, ioh, I2C_ICR, ICR_IUE | ICR_SCLE);
    399  1.1     peter 
    400  1.1     peter 	return EIO;
    401  1.1     peter }
    402  1.5    nonaka 
    403  1.5    nonaka /* ----------------------------------------------------------------------------
    404  1.5    nonaka  * for i2c_controller
    405  1.5    nonaka  */
    406  1.5    nonaka 
    407  1.5    nonaka #define	CSR_READ_4(sc,r)	bus_space_read_4(sc->sc_iot, sc->sc_ioh, r)
    408  1.5    nonaka #define	CSR_WRITE_4(sc,r,v)	bus_space_write_4(sc->sc_iot, sc->sc_ioh, r, v)
    409  1.5    nonaka 
    410  1.5    nonaka #define	ISR_ALL			(ISR_RWM | ISR_ACKNAK | ISR_UE | ISR_IBB \
    411  1.5    nonaka 				 | ISR_SSD | ISR_ALD | ISR_ITE | ISR_IRF \
    412  1.5    nonaka 				 | ISR_GCAD | ISR_SAD | ISR_BED)
    413  1.5    nonaka 
    414  1.5    nonaka #define	I2C_TIMEOUT		100	/* protocol timeout, in uSecs */
    415  1.5    nonaka 
    416  1.5    nonaka void
    417  1.5    nonaka pxa2x0_i2c_reset(struct pxa2x0_i2c_softc *sc)
    418  1.5    nonaka {
    419  1.5    nonaka 
    420  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, ICR_UR);
    421  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ISAR, 0);
    422  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ISR, ISR_ALL);
    423  1.5    nonaka 	while (CSR_READ_4(sc, I2C_ICR) & ~ICR_UR)
    424  1.5    nonaka 		continue;
    425  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, sc->sc_icr);
    426  1.5    nonaka }
    427  1.5    nonaka 
    428  1.5    nonaka int
    429  1.5    nonaka pxa2x0_i2c_wait(struct pxa2x0_i2c_softc *sc, int bit, int flags)
    430  1.5    nonaka {
    431  1.5    nonaka 	uint32_t isr;
    432  1.5    nonaka 	int error;
    433  1.5    nonaka 	int i;
    434  1.5    nonaka 
    435  1.5    nonaka 	for (i = I2C_TIMEOUT; i >= 0; --i) {
    436  1.5    nonaka 		isr = CSR_READ_4(sc, I2C_ISR);
    437  1.5    nonaka 		if (isr & (bit | ISR_BED))
    438  1.5    nonaka 			break;
    439  1.5    nonaka 		delay(1);
    440  1.5    nonaka 	}
    441  1.5    nonaka 
    442  1.5    nonaka 	if (isr & (ISR_BED | (bit & ISR_ALD)))
    443  1.5    nonaka 		error = EIO;
    444  1.5    nonaka 	else if (isr & (bit & ~ISR_ALD))
    445  1.5    nonaka 		error = 0;
    446  1.5    nonaka 	else
    447  1.5    nonaka 		error = ETIMEDOUT;
    448  1.5    nonaka 
    449  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ISR, isr);
    450  1.5    nonaka 
    451  1.5    nonaka 	return error;
    452  1.5    nonaka }
    453  1.5    nonaka 
    454  1.5    nonaka int
    455  1.5    nonaka pxa2x0_i2c_send_start(struct pxa2x0_i2c_softc *sc, int flags)
    456  1.5    nonaka {
    457  1.5    nonaka 
    458  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, sc->sc_icr | ICR_START);
    459  1.5    nonaka 	delay(I2C_TIMEOUT);
    460  1.5    nonaka 	return 0;
    461  1.5    nonaka }
    462  1.5    nonaka 
    463  1.5    nonaka int
    464  1.5    nonaka pxa2x0_i2c_send_stop(struct pxa2x0_i2c_softc *sc, int flags)
    465  1.5    nonaka {
    466  1.5    nonaka 
    467  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, sc->sc_icr | ICR_STOP);
    468  1.5    nonaka 	delay(I2C_TIMEOUT);
    469  1.5    nonaka 	return 0;
    470  1.5    nonaka }
    471  1.5    nonaka 
    472  1.5    nonaka int
    473  1.5    nonaka pxa2x0_i2c_initiate_xfer(struct pxa2x0_i2c_softc *sc, uint16_t addr, int flags)
    474  1.5    nonaka {
    475  1.5    nonaka 	int rd_req = (flags & I2C_F_READ) ? 1 : 0;
    476  1.5    nonaka 	int error;
    477  1.5    nonaka 
    478  1.5    nonaka 	if ((addr & ~0x7f) != 0) {
    479  1.5    nonaka 		error = EINVAL;
    480  1.5    nonaka 		goto error;
    481  1.5    nonaka 	}
    482  1.5    nonaka 
    483  1.5    nonaka 	CSR_WRITE_4(sc, I2C_IDBR, (addr << 1) | rd_req);
    484  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, sc->sc_icr | ICR_START | ICR_TB);
    485  1.5    nonaka 
    486  1.5    nonaka 	error = pxa2x0_i2c_wait(sc, ISR_ITE, flags);
    487  1.5    nonaka error:
    488  1.5    nonaka 	if (error) {
    489  1.5    nonaka 		DPRINTF(("%s: failed to initiate %s xfer (error=%d)\n",
    490  1.5    nonaka 		    device_xname(sc->sc_dev),
    491  1.5    nonaka 		    rd_req ? "read" : "write", error));
    492  1.5    nonaka 		return error;
    493  1.5    nonaka 	}
    494  1.5    nonaka 	return 0;
    495  1.5    nonaka }
    496  1.5    nonaka 
    497  1.5    nonaka int
    498  1.5    nonaka pxa2x0_i2c_read_byte(struct pxa2x0_i2c_softc *sc, uint8_t *bytep, int flags)
    499  1.5    nonaka {
    500  1.5    nonaka 	int last_byte = flags & I2C_F_LAST;
    501  1.5    nonaka 	int send_stop = flags & I2C_F_STOP;
    502  1.5    nonaka 	int error;
    503  1.5    nonaka 
    504  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, sc->sc_icr | ICR_TB
    505  1.5    nonaka 	    | (last_byte ? ICR_ACKNAK : 0) | (send_stop ? ICR_STOP : 0));
    506  1.5    nonaka 	error = pxa2x0_i2c_wait(sc, ISR_IRF | ISR_ALD, flags);
    507  1.5    nonaka 	if (error) {
    508  1.5    nonaka 		DPRINTF(("%s: read byte failed\n", device_xname(sc->sc_dev)));
    509  1.5    nonaka 		return error;
    510  1.5    nonaka 	}
    511  1.5    nonaka 
    512  1.5    nonaka 	*bytep = CSR_READ_4(sc, I2C_IDBR);
    513  1.5    nonaka 	return 0;
    514  1.5    nonaka }
    515  1.5    nonaka 
    516  1.5    nonaka int
    517  1.5    nonaka pxa2x0_i2c_write_byte(struct pxa2x0_i2c_softc *sc, uint8_t byte, int flags)
    518  1.5    nonaka {
    519  1.5    nonaka 	int send_stop = flags & I2C_F_STOP;
    520  1.5    nonaka 	int error;
    521  1.5    nonaka 
    522  1.5    nonaka 	CSR_WRITE_4(sc, I2C_IDBR, byte);
    523  1.5    nonaka 	CSR_WRITE_4(sc, I2C_ICR, sc->sc_icr | ICR_TB
    524  1.5    nonaka 	    | (send_stop ? ICR_STOP : 0));
    525  1.5    nonaka 	error = pxa2x0_i2c_wait(sc, ISR_ITE | ISR_ALD, flags);
    526  1.5    nonaka 	if (error) {
    527  1.5    nonaka 		DPRINTF(("%s: write byte failed\n", device_xname(sc->sc_dev)));
    528  1.5    nonaka 		return error;
    529  1.5    nonaka 	}
    530  1.5    nonaka 	return 0;
    531  1.5    nonaka }
    532