Home | History | Annotate | Line # | Download | only in ti
ti_iic.c revision 1.2
      1  1.2  jmcneill /* $NetBSD: ti_iic.c,v 1.2 2019/10/29 22:19:13 jmcneill Exp $ */
      2  1.1  jmcneill 
      3  1.1  jmcneill /*
      4  1.1  jmcneill  * Copyright (c) 2013 Manuel Bouyer.  All rights reserved.
      5  1.1  jmcneill  *
      6  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      7  1.1  jmcneill  * modification, are permitted provided that the following conditions
      8  1.1  jmcneill  * are met:
      9  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     10  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     11  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     14  1.1  jmcneill  *
     15  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     17  1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     18  1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     19  1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     20  1.1  jmcneill  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     21  1.1  jmcneill  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     22  1.1  jmcneill  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     23  1.1  jmcneill  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     24  1.1  jmcneill  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     25  1.1  jmcneill  */
     26  1.1  jmcneill 
     27  1.1  jmcneill /*-
     28  1.1  jmcneill  * Copyright (c) 2012 Jared D. McNeill <jmcneill (at) invisible.ca>
     29  1.1  jmcneill  * All rights reserved.
     30  1.1  jmcneill  *
     31  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
     32  1.1  jmcneill  * modification, are permitted provided that the following conditions
     33  1.1  jmcneill  * are met:
     34  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     35  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     36  1.1  jmcneill  * 2. The name of the author may not be used to endorse or promote products
     37  1.1  jmcneill  *    derived from this software without specific prior written permission.
     38  1.1  jmcneill  *
     39  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     40  1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     41  1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     42  1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     43  1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     44  1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     45  1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     46  1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     47  1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     48  1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     49  1.1  jmcneill  * SUCH DAMAGE.
     50  1.1  jmcneill  */
     51  1.1  jmcneill 
     52  1.1  jmcneill #include <sys/cdefs.h>
     53  1.2  jmcneill __KERNEL_RCSID(0, "$NetBSD: ti_iic.c,v 1.2 2019/10/29 22:19:13 jmcneill Exp $");
     54  1.1  jmcneill 
     55  1.1  jmcneill #include <sys/param.h>
     56  1.1  jmcneill #include <sys/systm.h>
     57  1.1  jmcneill #include <sys/device.h>
     58  1.1  jmcneill #include <sys/conf.h>
     59  1.1  jmcneill #include <sys/bus.h>
     60  1.1  jmcneill #include <sys/proc.h>
     61  1.1  jmcneill #include <sys/kernel.h>
     62  1.1  jmcneill #include <sys/mutex.h>
     63  1.1  jmcneill #include <sys/condvar.h>
     64  1.1  jmcneill 
     65  1.1  jmcneill #include <dev/i2c/i2cvar.h>
     66  1.1  jmcneill 
     67  1.1  jmcneill #include <dev/fdt/fdtvar.h>
     68  1.1  jmcneill 
     69  1.1  jmcneill #include <arm/ti/ti_prcm.h>
     70  1.1  jmcneill #include <arm/ti/ti_iicreg.h>
     71  1.1  jmcneill 
     72  1.1  jmcneill #ifndef OMAP2_I2C_SLAVE_ADDR
     73  1.1  jmcneill #define OMAP2_I2C_SLAVE_ADDR	0x01
     74  1.1  jmcneill #endif
     75  1.1  jmcneill 
     76  1.1  jmcneill #define OMAP2_I2C_FIFOBYTES(fd)	(8 << (fd))
     77  1.1  jmcneill 
     78  1.1  jmcneill #ifdef I2CDEBUG
     79  1.1  jmcneill #define DPRINTF(args)	printf args
     80  1.1  jmcneill #else
     81  1.1  jmcneill #define DPRINTF(args)
     82  1.1  jmcneill #endif
     83  1.1  jmcneill 
     84  1.2  jmcneill static const struct of_compat_data compat_data[] = {
     85  1.2  jmcneill 	/* compatible		reg shift */
     86  1.2  jmcneill 	{ "ti,omap3-i2c",	2 },
     87  1.2  jmcneill 	{ "ti,omap4-i2c",	0 },
     88  1.2  jmcneill 	{ NULL }
     89  1.1  jmcneill };
     90  1.1  jmcneill 
     91  1.1  jmcneill /* operation in progress */
     92  1.1  jmcneill typedef enum {
     93  1.1  jmcneill 	TI_I2CREAD,
     94  1.1  jmcneill 	TI_I2CWRITE,
     95  1.1  jmcneill 	TI_I2CDONE,
     96  1.1  jmcneill 	TI_I2CERROR
     97  1.1  jmcneill } ti_i2cop_t;
     98  1.1  jmcneill 
     99  1.1  jmcneill struct ti_iic_softc {
    100  1.1  jmcneill 	device_t		sc_dev;
    101  1.1  jmcneill 	struct i2c_controller	sc_ic;
    102  1.1  jmcneill 	kmutex_t		sc_lock;
    103  1.1  jmcneill 	device_t		sc_i2cdev;
    104  1.1  jmcneill 
    105  1.1  jmcneill 	bus_space_tag_t		sc_iot;
    106  1.1  jmcneill 	bus_space_handle_t	sc_ioh;
    107  1.1  jmcneill 
    108  1.2  jmcneill 	u_int			sc_reg_shift;
    109  1.2  jmcneill 
    110  1.1  jmcneill 	void			*sc_ih;
    111  1.1  jmcneill 	kmutex_t		sc_mtx;
    112  1.1  jmcneill 	kcondvar_t		sc_cv;
    113  1.1  jmcneill 	ti_i2cop_t		sc_op;
    114  1.1  jmcneill 	int			sc_buflen;
    115  1.1  jmcneill 	int			sc_bufidx;
    116  1.1  jmcneill 	char			*sc_buf;
    117  1.1  jmcneill 
    118  1.1  jmcneill 	bool			sc_busy;
    119  1.1  jmcneill 
    120  1.1  jmcneill 	int			sc_rxthres;
    121  1.1  jmcneill 	int			sc_txthres;
    122  1.1  jmcneill };
    123  1.1  jmcneill 
    124  1.1  jmcneill #define I2C_READ_REG(sc, reg)		\
    125  1.2  jmcneill 	bus_space_read_2((sc)->sc_iot, (sc)->sc_ioh, (reg) << (sc)->sc_reg_shift)
    126  1.1  jmcneill #define I2C_READ_DATA(sc)		\
    127  1.2  jmcneill 	bus_space_read_1((sc)->sc_iot, (sc)->sc_ioh, OMAP2_I2C_DATA << (sc)->sc_reg_shift);
    128  1.1  jmcneill #define I2C_WRITE_REG(sc, reg, val)	\
    129  1.2  jmcneill 	bus_space_write_2((sc)->sc_iot, (sc)->sc_ioh, (reg) << (sc)->sc_reg_shift, (val))
    130  1.1  jmcneill #define I2C_WRITE_DATA(sc, val)		\
    131  1.2  jmcneill 	bus_space_write_1((sc)->sc_iot, (sc)->sc_ioh, OMAP2_I2C_DATA << (sc)->sc_reg_shift, (val))
    132  1.1  jmcneill 
    133  1.1  jmcneill static int	ti_iic_match(device_t, cfdata_t, void *);
    134  1.1  jmcneill static void	ti_iic_attach(device_t, device_t, void *);
    135  1.1  jmcneill 
    136  1.1  jmcneill static int	ti_iic_intr(void *);
    137  1.1  jmcneill 
    138  1.1  jmcneill static int	ti_iic_acquire_bus(void *, int);
    139  1.1  jmcneill static void	ti_iic_release_bus(void *, int);
    140  1.1  jmcneill static int	ti_iic_exec(void *, i2c_op_t, i2c_addr_t, const void *,
    141  1.1  jmcneill 			       size_t, void *, size_t, int);
    142  1.1  jmcneill 
    143  1.1  jmcneill static int	ti_iic_reset(struct ti_iic_softc *);
    144  1.1  jmcneill static int	ti_iic_op(struct ti_iic_softc *, i2c_addr_t, ti_i2cop_t,
    145  1.1  jmcneill 			       uint8_t *, size_t, int);
    146  1.1  jmcneill static void	ti_iic_handle_intr(struct ti_iic_softc *, uint32_t);
    147  1.1  jmcneill static void	ti_iic_do_read(struct ti_iic_softc *, uint32_t);
    148  1.1  jmcneill static void	ti_iic_do_write(struct ti_iic_softc *, uint32_t);
    149  1.1  jmcneill 
    150  1.1  jmcneill static int	ti_iic_wait(struct ti_iic_softc *, uint16_t, uint16_t, int);
    151  1.1  jmcneill static uint32_t	ti_iic_stat(struct ti_iic_softc *, uint32_t);
    152  1.1  jmcneill static int	ti_iic_flush(struct ti_iic_softc *);
    153  1.1  jmcneill 
    154  1.1  jmcneill static i2c_tag_t ti_iic_get_tag(device_t);
    155  1.1  jmcneill 
    156  1.1  jmcneill static const struct fdtbus_i2c_controller_func ti_iic_funcs = {
    157  1.1  jmcneill 	.get_tag = ti_iic_get_tag,
    158  1.1  jmcneill };
    159  1.1  jmcneill 
    160  1.1  jmcneill CFATTACH_DECL_NEW(ti_iic, sizeof(struct ti_iic_softc),
    161  1.1  jmcneill     ti_iic_match, ti_iic_attach, NULL, NULL);
    162  1.1  jmcneill 
    163  1.1  jmcneill static int
    164  1.1  jmcneill ti_iic_match(device_t parent, cfdata_t match, void *opaque)
    165  1.1  jmcneill {
    166  1.1  jmcneill 	struct fdt_attach_args * const faa = opaque;
    167  1.1  jmcneill 
    168  1.2  jmcneill 	return of_match_compat_data(faa->faa_phandle, compat_data);
    169  1.1  jmcneill }
    170  1.1  jmcneill 
    171  1.1  jmcneill static void
    172  1.1  jmcneill ti_iic_attach(device_t parent, device_t self, void *opaque)
    173  1.1  jmcneill {
    174  1.1  jmcneill 	struct ti_iic_softc *sc = device_private(self);
    175  1.1  jmcneill 	struct fdt_attach_args * const faa = opaque;
    176  1.1  jmcneill 	const int phandle = faa->faa_phandle;
    177  1.1  jmcneill 	int scheme, major, minor, fifodepth, fifo;
    178  1.1  jmcneill 	char intrstr[128];
    179  1.1  jmcneill 	bus_addr_t addr;
    180  1.1  jmcneill 	bus_size_t size;
    181  1.1  jmcneill 	uint16_t rev;
    182  1.1  jmcneill 
    183  1.1  jmcneill 	if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
    184  1.1  jmcneill 		aprint_error(": couldn't get registers\n");
    185  1.1  jmcneill 		return;
    186  1.1  jmcneill 	}
    187  1.1  jmcneill 	if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
    188  1.1  jmcneill 		aprint_error(": couldn't decode interrupt\n");
    189  1.1  jmcneill 		return;
    190  1.1  jmcneill 	}
    191  1.1  jmcneill 
    192  1.2  jmcneill 	if (ti_prcm_enable_hwmod(phandle, 0) != 0) {
    193  1.1  jmcneill 		aprint_error(": couldn't enable module\n");
    194  1.1  jmcneill 		return;
    195  1.1  jmcneill 	}
    196  1.1  jmcneill 
    197  1.1  jmcneill 	sc->sc_dev = self;
    198  1.1  jmcneill 	sc->sc_iot = faa->faa_bst;
    199  1.1  jmcneill 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
    200  1.1  jmcneill 	mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_NET);
    201  1.1  jmcneill 	cv_init(&sc->sc_cv, "tiiic");
    202  1.1  jmcneill 	sc->sc_ic.ic_cookie = sc;
    203  1.1  jmcneill 	sc->sc_ic.ic_acquire_bus = ti_iic_acquire_bus;
    204  1.1  jmcneill 	sc->sc_ic.ic_release_bus = ti_iic_release_bus;
    205  1.1  jmcneill 	sc->sc_ic.ic_exec = ti_iic_exec;
    206  1.1  jmcneill 
    207  1.1  jmcneill 	if (bus_space_map(sc->sc_iot, addr, size, 0, &sc->sc_ioh) != 0) {
    208  1.1  jmcneill 		aprint_error(": couldn't map registers\n");
    209  1.1  jmcneill 		return;
    210  1.1  jmcneill 	}
    211  1.2  jmcneill 	sc->sc_reg_shift = of_search_compatible(phandle, compat_data)->data;
    212  1.1  jmcneill 
    213  1.1  jmcneill 	sc->sc_ih = fdtbus_intr_establish(phandle, 0, IPL_NET, 0,
    214  1.1  jmcneill 	    ti_iic_intr, sc);
    215  1.1  jmcneill 	if (sc->sc_ih == NULL) {
    216  1.1  jmcneill 		aprint_error(": couldn't establish interrupt\n");
    217  1.1  jmcneill 		return;
    218  1.1  jmcneill 	}
    219  1.1  jmcneill 
    220  1.1  jmcneill 	scheme = I2C_REVNB_HI_SCHEME(I2C_READ_REG(sc, OMAP2_I2C_REVNB_HI));
    221  1.1  jmcneill 	rev = I2C_READ_REG(sc, OMAP2_I2C_REVNB_LO);
    222  1.1  jmcneill 	if (scheme == 0) {
    223  1.1  jmcneill 		major = I2C_REV_SCHEME_0_MAJOR(rev);
    224  1.1  jmcneill 		minor = I2C_REV_SCHEME_0_MINOR(rev);
    225  1.1  jmcneill 	} else {
    226  1.1  jmcneill 		major = I2C_REVNB_LO_MAJOR(rev);
    227  1.1  jmcneill 		minor = I2C_REVNB_LO_MINOR(rev);
    228  1.1  jmcneill 	}
    229  1.1  jmcneill 	aprint_normal(": rev %d.%d, scheme %d\n", major, minor, scheme);
    230  1.1  jmcneill 	aprint_naive("\n");
    231  1.1  jmcneill 
    232  1.1  jmcneill 	fifodepth = I2C_BUFSTAT_FIFODEPTH(I2C_READ_REG(sc, OMAP2_I2C_BUFSTAT));
    233  1.1  jmcneill 	fifo = OMAP2_I2C_FIFOBYTES(fifodepth);
    234  1.1  jmcneill 	aprint_normal_dev(self, "%d-bytes FIFO\n", fifo);
    235  1.1  jmcneill 	sc->sc_rxthres = sc->sc_txthres = fifo >> 1;
    236  1.1  jmcneill 
    237  1.1  jmcneill 	ti_iic_reset(sc);
    238  1.1  jmcneill 	ti_iic_flush(sc);
    239  1.1  jmcneill 
    240  1.1  jmcneill 	fdtbus_register_i2c_controller(self, phandle, &ti_iic_funcs);
    241  1.1  jmcneill 
    242  1.1  jmcneill 	fdtbus_attach_i2cbus(self, phandle, &sc->sc_ic, iicbus_print);
    243  1.1  jmcneill }
    244  1.1  jmcneill 
    245  1.1  jmcneill static int
    246  1.1  jmcneill ti_iic_intr(void *arg)
    247  1.1  jmcneill {
    248  1.1  jmcneill 	struct ti_iic_softc *sc = arg;
    249  1.1  jmcneill 	uint32_t stat;
    250  1.1  jmcneill 
    251  1.1  jmcneill 	mutex_enter(&sc->sc_mtx);
    252  1.1  jmcneill 	DPRINTF(("ti_iic_intr\n"));
    253  1.1  jmcneill 	stat = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS);
    254  1.1  jmcneill 	DPRINTF(("ti_iic_intr pre handle sc->sc_op eq %#x\n", sc->sc_op));
    255  1.1  jmcneill 	ti_iic_handle_intr(sc, stat);
    256  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_IRQSTATUS, stat);
    257  1.1  jmcneill 	if (sc->sc_op == TI_I2CERROR || sc->sc_op == TI_I2CDONE) {
    258  1.1  jmcneill 		DPRINTF(("ti_iic_intr post handle sc->sc_op %#x\n", sc->sc_op));
    259  1.1  jmcneill 		cv_broadcast(&sc->sc_cv);
    260  1.1  jmcneill 	}
    261  1.1  jmcneill 	mutex_exit(&sc->sc_mtx);
    262  1.1  jmcneill 	DPRINTF(("ti_iic_intr status 0x%x\n", stat));
    263  1.1  jmcneill 	return 1;
    264  1.1  jmcneill }
    265  1.1  jmcneill 
    266  1.1  jmcneill static int
    267  1.1  jmcneill ti_iic_acquire_bus(void *opaque, int flags)
    268  1.1  jmcneill {
    269  1.1  jmcneill 	struct ti_iic_softc *sc = opaque;
    270  1.1  jmcneill 
    271  1.1  jmcneill 	mutex_enter(&sc->sc_lock);
    272  1.1  jmcneill 	while (sc->sc_busy)
    273  1.1  jmcneill 		cv_wait(&sc->sc_cv, &sc->sc_lock);
    274  1.1  jmcneill 	sc->sc_busy = true;
    275  1.1  jmcneill 	mutex_exit(&sc->sc_lock);
    276  1.1  jmcneill 
    277  1.1  jmcneill 	return 0;
    278  1.1  jmcneill }
    279  1.1  jmcneill 
    280  1.1  jmcneill static void
    281  1.1  jmcneill ti_iic_release_bus(void *opaque, int flags)
    282  1.1  jmcneill {
    283  1.1  jmcneill 	struct ti_iic_softc *sc = opaque;
    284  1.1  jmcneill 
    285  1.1  jmcneill 	mutex_enter(&sc->sc_lock);
    286  1.1  jmcneill 	sc->sc_busy = false;
    287  1.1  jmcneill 	cv_broadcast(&sc->sc_cv);
    288  1.1  jmcneill 	mutex_exit(&sc->sc_lock);
    289  1.1  jmcneill }
    290  1.1  jmcneill 
    291  1.1  jmcneill static int
    292  1.1  jmcneill ti_iic_exec(void *opaque, i2c_op_t op, i2c_addr_t addr,
    293  1.1  jmcneill     const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
    294  1.1  jmcneill {
    295  1.1  jmcneill 	struct ti_iic_softc *sc = opaque;
    296  1.1  jmcneill 	int err;
    297  1.1  jmcneill 
    298  1.1  jmcneill 	DPRINTF(("ti_iic_exec: op 0x%x cmdlen %zd len %zd flags 0x%x\n",
    299  1.1  jmcneill 	    op, cmdlen, len, flags));
    300  1.1  jmcneill 
    301  1.1  jmcneill 	if (cmdlen > 0) {
    302  1.1  jmcneill 		err = ti_iic_op(sc, addr, TI_I2CWRITE,
    303  1.1  jmcneill 		    __UNCONST(cmdbuf), cmdlen,
    304  1.1  jmcneill 		    (I2C_OP_READ_P(op) ? 0 : I2C_F_STOP) | flags);
    305  1.1  jmcneill 		if (err)
    306  1.1  jmcneill 			goto done;
    307  1.1  jmcneill 	}
    308  1.1  jmcneill 
    309  1.1  jmcneill 	if (I2C_OP_STOP_P(op))
    310  1.1  jmcneill 		flags |= I2C_F_STOP;
    311  1.1  jmcneill 
    312  1.1  jmcneill 	/*
    313  1.1  jmcneill 	 * I2C controller doesn't allow for zero-byte transfers.
    314  1.1  jmcneill 	 */
    315  1.1  jmcneill 	if (len == 0) {
    316  1.1  jmcneill 		err = EINVAL;
    317  1.1  jmcneill 		goto done;
    318  1.1  jmcneill 	}
    319  1.1  jmcneill 
    320  1.1  jmcneill 	if (I2C_OP_READ_P(op)) {
    321  1.1  jmcneill 		err = ti_iic_op(sc, addr, TI_I2CREAD, buf, len, flags);
    322  1.1  jmcneill 	} else {
    323  1.1  jmcneill 		err = ti_iic_op(sc, addr, TI_I2CWRITE, buf, len, flags);
    324  1.1  jmcneill 	}
    325  1.1  jmcneill 
    326  1.1  jmcneill done:
    327  1.1  jmcneill 	if (err)
    328  1.1  jmcneill 		ti_iic_reset(sc);
    329  1.1  jmcneill 
    330  1.1  jmcneill 	ti_iic_flush(sc);
    331  1.1  jmcneill 
    332  1.1  jmcneill 	DPRINTF(("ti_iic_exec: done %d\n", err));
    333  1.1  jmcneill 	return err;
    334  1.1  jmcneill }
    335  1.1  jmcneill 
    336  1.1  jmcneill static int
    337  1.1  jmcneill ti_iic_reset(struct ti_iic_softc *sc)
    338  1.1  jmcneill {
    339  1.1  jmcneill 	uint32_t psc, scll, sclh;
    340  1.1  jmcneill 	int i;
    341  1.1  jmcneill 
    342  1.1  jmcneill 	DPRINTF(("ti_iic_reset\n"));
    343  1.1  jmcneill 
    344  1.1  jmcneill 	/* Disable */
    345  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, 0);
    346  1.1  jmcneill 	/* Soft reset */
    347  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_SYSC, I2C_SYSC_SRST);
    348  1.1  jmcneill 	delay(1000);
    349  1.1  jmcneill 	/* enable so that we can check for reset complete */
    350  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, I2C_CON_EN);
    351  1.1  jmcneill 	delay(1000);
    352  1.1  jmcneill 	for (i = 0; i < 1000; i++) { /* 1s delay for reset */
    353  1.1  jmcneill 		if (I2C_READ_REG(sc, OMAP2_I2C_SYSS) & I2C_SYSS_RDONE)
    354  1.1  jmcneill 			break;
    355  1.1  jmcneill 	}
    356  1.1  jmcneill 	/* Disable again */
    357  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, 0);
    358  1.1  jmcneill 	delay(50000);
    359  1.1  jmcneill 
    360  1.1  jmcneill 	if (i >= 1000) {
    361  1.1  jmcneill 		aprint_error_dev(sc->sc_dev, ": couldn't reset module\n");
    362  1.1  jmcneill 		return 1;
    363  1.1  jmcneill 	}
    364  1.1  jmcneill 
    365  1.1  jmcneill 
    366  1.1  jmcneill 	/* XXX standard speed only */
    367  1.1  jmcneill 	psc = 3;
    368  1.1  jmcneill 	scll = 53;
    369  1.1  jmcneill 	sclh = 55;
    370  1.1  jmcneill 
    371  1.1  jmcneill 	/* Clocks */
    372  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_PSC, psc);
    373  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_SCLL, scll);
    374  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_SCLH, sclh);
    375  1.1  jmcneill 
    376  1.1  jmcneill 	/* Own I2C address */
    377  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_OA, OMAP2_I2C_SLAVE_ADDR);
    378  1.1  jmcneill 
    379  1.1  jmcneill 	/* 5 bytes fifo */
    380  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_BUF,
    381  1.1  jmcneill 	    I2C_BUF_RXTRSH(sc->sc_rxthres) | I2C_BUF_TXTRSH(sc->sc_txthres));
    382  1.1  jmcneill 
    383  1.1  jmcneill 	/* Enable */
    384  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, I2C_CON_EN);
    385  1.1  jmcneill 
    386  1.1  jmcneill 	return 0;
    387  1.1  jmcneill }
    388  1.1  jmcneill 
    389  1.1  jmcneill static int
    390  1.1  jmcneill ti_iic_op(struct ti_iic_softc *sc, i2c_addr_t addr, ti_i2cop_t op,
    391  1.1  jmcneill     uint8_t *buf, size_t buflen, int flags)
    392  1.1  jmcneill {
    393  1.1  jmcneill 	uint16_t con, stat, mask;
    394  1.1  jmcneill 	int err, retry;
    395  1.1  jmcneill 
    396  1.1  jmcneill 	KASSERT(op == TI_I2CREAD || op == TI_I2CWRITE);
    397  1.1  jmcneill 	DPRINTF(("ti_iic_op: addr %#x op %#x buf %p buflen %#x flags %#x\n",
    398  1.1  jmcneill 	    addr, op, buf, (unsigned int) buflen, flags));
    399  1.1  jmcneill 
    400  1.1  jmcneill 	mask = I2C_IRQSTATUS_ARDY | I2C_IRQSTATUS_NACK | I2C_IRQSTATUS_AL;
    401  1.1  jmcneill 	if (op == TI_I2CREAD) {
    402  1.1  jmcneill 		mask |= I2C_IRQSTATUS_RDR | I2C_IRQSTATUS_RRDY;
    403  1.1  jmcneill 	} else {
    404  1.1  jmcneill 		mask |= I2C_IRQSTATUS_XDR | I2C_IRQSTATUS_XRDY;
    405  1.1  jmcneill 	}
    406  1.1  jmcneill 
    407  1.1  jmcneill 	err = ti_iic_wait(sc, I2C_IRQSTATUS_BB, 0, flags);
    408  1.1  jmcneill 	if (err) {
    409  1.1  jmcneill 		DPRINTF(("ti_iic_op: wait error %d\n", err));
    410  1.1  jmcneill 		return err;
    411  1.1  jmcneill 	}
    412  1.1  jmcneill 
    413  1.1  jmcneill 	con = I2C_CON_EN;
    414  1.1  jmcneill 	con |= I2C_CON_MST;
    415  1.1  jmcneill 	con |= I2C_CON_STT;;
    416  1.1  jmcneill 	if (flags & I2C_F_STOP)
    417  1.1  jmcneill 		con |= I2C_CON_STP;
    418  1.1  jmcneill 	if (addr & ~0x7f)
    419  1.1  jmcneill 		con |= I2C_CON_XSA;
    420  1.1  jmcneill 	if (op == TI_I2CWRITE)
    421  1.1  jmcneill 		con |= I2C_CON_TRX;
    422  1.1  jmcneill 
    423  1.1  jmcneill 	mutex_enter(&sc->sc_mtx);
    424  1.1  jmcneill 	sc->sc_op = op;
    425  1.1  jmcneill 	sc->sc_buf = buf;
    426  1.1  jmcneill 	sc->sc_buflen = buflen;
    427  1.1  jmcneill 	sc->sc_bufidx = 0;
    428  1.1  jmcneill 
    429  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, I2C_CON_EN | I2C_CON_MST | I2C_CON_STP);
    430  1.1  jmcneill 	DPRINTF(("ti_iic_op: op %d con 0x%x ", op, con));
    431  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CNT, buflen);
    432  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_SA, (addr & I2C_SA_MASK));
    433  1.1  jmcneill 	DPRINTF(("SA 0x%x len %d\n", I2C_READ_REG(sc, OMAP2_I2C_SA), I2C_READ_REG(sc, OMAP2_I2C_CNT)));
    434  1.1  jmcneill 
    435  1.1  jmcneill 	if ((flags & I2C_F_POLL) == 0) {
    436  1.1  jmcneill 		/* clear any pending interrupt */
    437  1.1  jmcneill 		I2C_WRITE_REG(sc, OMAP2_I2C_IRQSTATUS,
    438  1.1  jmcneill 		    I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS));
    439  1.1  jmcneill 		/* and enable */
    440  1.1  jmcneill 		I2C_WRITE_REG(sc, OMAP2_I2C_IRQENABLE_SET, mask);
    441  1.1  jmcneill 	}
    442  1.1  jmcneill 	/* start transfer */
    443  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, con);
    444  1.1  jmcneill 
    445  1.1  jmcneill 	if ((flags & I2C_F_POLL) == 0) {
    446  1.1  jmcneill 		/* and wait for completion */
    447  1.1  jmcneill 		DPRINTF(("ti_iic_op waiting, op %#x\n", sc->sc_op));
    448  1.1  jmcneill 		while (sc->sc_op == op) {
    449  1.1  jmcneill 			if (cv_timedwait(&sc->sc_cv, &sc->sc_mtx,
    450  1.1  jmcneill 			    mstohz(5000)) == EWOULDBLOCK) {
    451  1.1  jmcneill 				/* timeout */
    452  1.1  jmcneill 				op = TI_I2CERROR;
    453  1.1  jmcneill 			}
    454  1.1  jmcneill 		}
    455  1.1  jmcneill 		DPRINTF(("ti_iic_op waiting done, op %#x\n", sc->sc_op));
    456  1.1  jmcneill 
    457  1.1  jmcneill 		/* disable interrupts */
    458  1.1  jmcneill 		I2C_WRITE_REG(sc, OMAP2_I2C_IRQENABLE_CLR, 0xffff);
    459  1.1  jmcneill 	} else {
    460  1.1  jmcneill 		/* poll for completion */
    461  1.1  jmcneill 		DPRINTF(("ti_iic_op polling, op %x\n", sc->sc_op));
    462  1.1  jmcneill 		while (sc->sc_op == op) {
    463  1.1  jmcneill 			stat = ti_iic_stat(sc, mask);
    464  1.1  jmcneill 			DPRINTF(("ti_iic_op stat 0x%x\n", stat));
    465  1.1  jmcneill 			if (stat == 0) {
    466  1.1  jmcneill 				/* timeout */
    467  1.1  jmcneill 				sc->sc_op = TI_I2CERROR;
    468  1.1  jmcneill 			} else {
    469  1.1  jmcneill 				ti_iic_handle_intr(sc, stat);
    470  1.1  jmcneill 			}
    471  1.1  jmcneill 			I2C_WRITE_REG(sc, OMAP2_I2C_IRQSTATUS, stat);
    472  1.1  jmcneill 		}
    473  1.1  jmcneill 		DPRINTF(("ti_iic_op polling done, op now %x\n", sc->sc_op));
    474  1.1  jmcneill 	}
    475  1.1  jmcneill 	mutex_exit(&sc->sc_mtx);
    476  1.1  jmcneill 	retry = 10000;
    477  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CON, 0);
    478  1.1  jmcneill 	while (I2C_READ_REG(sc, OMAP2_I2C_CON) & I2C_CON_MST) {
    479  1.1  jmcneill 		delay(100);
    480  1.1  jmcneill 		if (--retry == 0)
    481  1.1  jmcneill 			break;
    482  1.1  jmcneill 	}
    483  1.1  jmcneill 	return (sc->sc_op == TI_I2CDONE) ? 0 : EIO;
    484  1.1  jmcneill }
    485  1.1  jmcneill 
    486  1.1  jmcneill static void
    487  1.1  jmcneill ti_iic_handle_intr(struct ti_iic_softc *sc, uint32_t stat)
    488  1.1  jmcneill {
    489  1.1  jmcneill 	KASSERT(mutex_owned(&sc->sc_mtx));
    490  1.1  jmcneill 	KASSERT(stat != 0);
    491  1.1  jmcneill 	DPRINTF(("ti_iic_handle_intr stat %#x\n", stat));
    492  1.1  jmcneill 
    493  1.1  jmcneill 	if (stat &
    494  1.1  jmcneill 	    (I2C_IRQSTATUS_NACK|I2C_IRQSTATUS_AL)) {
    495  1.1  jmcneill 		sc->sc_op = TI_I2CERROR;
    496  1.1  jmcneill 		return;
    497  1.1  jmcneill 	}
    498  1.1  jmcneill 	if (stat & I2C_IRQSTATUS_ARDY) {
    499  1.1  jmcneill 		sc->sc_op = TI_I2CDONE;
    500  1.1  jmcneill 		return;
    501  1.1  jmcneill 	}
    502  1.1  jmcneill 	if (sc->sc_op == TI_I2CREAD)
    503  1.1  jmcneill 		ti_iic_do_read(sc, stat);
    504  1.1  jmcneill 	else if (sc->sc_op == TI_I2CWRITE)
    505  1.1  jmcneill 		ti_iic_do_write(sc, stat);
    506  1.1  jmcneill 	else
    507  1.1  jmcneill 		return;
    508  1.1  jmcneill }
    509  1.1  jmcneill void
    510  1.1  jmcneill ti_iic_do_read(struct ti_iic_softc *sc, uint32_t stat)
    511  1.1  jmcneill {
    512  1.1  jmcneill 	int len = 0;
    513  1.1  jmcneill 
    514  1.1  jmcneill 	KASSERT(mutex_owned(&sc->sc_mtx));
    515  1.1  jmcneill 	DPRINTF(("ti_iic_do_read stat %#x\n", stat));
    516  1.1  jmcneill 	if (stat & I2C_IRQSTATUS_RDR) {
    517  1.1  jmcneill 		len = I2C_READ_REG(sc, OMAP2_I2C_BUFSTAT);
    518  1.1  jmcneill 		len = I2C_BUFSTAT_RXSTAT(len);
    519  1.1  jmcneill 		DPRINTF(("ti_iic_do_read receive drain len %d left %d\n",
    520  1.1  jmcneill 		    len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
    521  1.1  jmcneill 	} else if (stat & I2C_IRQSTATUS_RRDY) {
    522  1.1  jmcneill 		len = sc->sc_rxthres + 1;
    523  1.1  jmcneill 		DPRINTF(("ti_iic_do_read receive len %d left %d\n",
    524  1.1  jmcneill 		    len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
    525  1.1  jmcneill 	}
    526  1.1  jmcneill 	for (;
    527  1.1  jmcneill 	    sc->sc_bufidx < sc->sc_buflen && len > 0;
    528  1.1  jmcneill 	    sc->sc_bufidx++, len--) {
    529  1.1  jmcneill 		sc->sc_buf[sc->sc_bufidx] = I2C_READ_DATA(sc);
    530  1.1  jmcneill 		DPRINTF(("ti_iic_do_read got b[%d]=0x%x\n", sc->sc_bufidx,
    531  1.1  jmcneill 		    sc->sc_buf[sc->sc_bufidx]));
    532  1.1  jmcneill 	}
    533  1.1  jmcneill 	DPRINTF(("ti_iic_do_read done\n"));
    534  1.1  jmcneill }
    535  1.1  jmcneill 
    536  1.1  jmcneill void
    537  1.1  jmcneill ti_iic_do_write(struct ti_iic_softc *sc, uint32_t stat)
    538  1.1  jmcneill {
    539  1.1  jmcneill 	int len = 0;
    540  1.1  jmcneill 
    541  1.1  jmcneill 	DPRINTF(("ti_iic_do_write stat %#x\n", stat));
    542  1.1  jmcneill 	KASSERT(mutex_owned(&sc->sc_mtx));
    543  1.1  jmcneill 	if (stat & I2C_IRQSTATUS_XDR) {
    544  1.1  jmcneill 		len = I2C_READ_REG(sc, OMAP2_I2C_BUFSTAT);
    545  1.1  jmcneill 		len = I2C_BUFSTAT_TXSTAT(len);
    546  1.1  jmcneill 		DPRINTF(("ti_iic_do_write xmit drain len %d left %d\n",
    547  1.1  jmcneill 		    len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
    548  1.1  jmcneill 	} else if (stat & I2C_IRQSTATUS_XRDY) {
    549  1.1  jmcneill 		len = sc->sc_txthres + 1;
    550  1.1  jmcneill 		DPRINTF(("ti_iic_do_write xmit len %d left %d\n",
    551  1.1  jmcneill 		    len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
    552  1.1  jmcneill 	}
    553  1.1  jmcneill 	for (;
    554  1.1  jmcneill 	    sc->sc_bufidx < sc->sc_buflen && len > 0;
    555  1.1  jmcneill 	    sc->sc_bufidx++, len--) {
    556  1.1  jmcneill 		DPRINTF(("ti_iic_do_write send b[%d]=0x%x\n",
    557  1.1  jmcneill 		    sc->sc_bufidx, sc->sc_buf[sc->sc_bufidx]));
    558  1.1  jmcneill 		I2C_WRITE_DATA(sc, sc->sc_buf[sc->sc_bufidx]);
    559  1.1  jmcneill 	}
    560  1.1  jmcneill 	DPRINTF(("ti_iic_do_write done\n"));
    561  1.1  jmcneill }
    562  1.1  jmcneill 
    563  1.1  jmcneill static int
    564  1.1  jmcneill ti_iic_wait(struct ti_iic_softc *sc, uint16_t mask, uint16_t val, int flags)
    565  1.1  jmcneill {
    566  1.1  jmcneill 	int retry = 10;
    567  1.1  jmcneill 	uint16_t v;
    568  1.1  jmcneill 	DPRINTF(("ti_iic_wait mask %#x val %#x flags %#x\n", mask, val, flags));
    569  1.1  jmcneill 
    570  1.1  jmcneill 	while (((v = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS_RAW)) & mask) != val) {
    571  1.1  jmcneill 		--retry;
    572  1.1  jmcneill 		if (retry == 0) {
    573  1.1  jmcneill 			aprint_error_dev(sc->sc_dev, ": wait timeout, "
    574  1.1  jmcneill 			    "mask = %#x val = %#x stat = %#x\n",
    575  1.1  jmcneill 			    mask, val, v);
    576  1.1  jmcneill 			return EBUSY;
    577  1.1  jmcneill 		}
    578  1.1  jmcneill 		if (flags & I2C_F_POLL) {
    579  1.1  jmcneill 			delay(50000);
    580  1.1  jmcneill 		} else {
    581  1.1  jmcneill 			kpause("tiiic", false, mstohz(50), NULL);
    582  1.1  jmcneill 		}
    583  1.1  jmcneill 	}
    584  1.1  jmcneill 	DPRINTF(("ti_iic_wait done retry %#x\n", retry));
    585  1.1  jmcneill 
    586  1.1  jmcneill 	return 0;
    587  1.1  jmcneill }
    588  1.1  jmcneill 
    589  1.1  jmcneill static uint32_t
    590  1.1  jmcneill ti_iic_stat(struct ti_iic_softc *sc, uint32_t mask)
    591  1.1  jmcneill {
    592  1.1  jmcneill 	uint32_t v;
    593  1.1  jmcneill 	int retry = 500;
    594  1.1  jmcneill 	DPRINTF(("ti_iic_wait mask %#x\n", mask));
    595  1.1  jmcneill 	while (--retry > 0) {
    596  1.1  jmcneill 		v = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS_RAW) & mask;
    597  1.1  jmcneill 		if (v != 0)
    598  1.1  jmcneill 			break;
    599  1.1  jmcneill 		delay(100);
    600  1.1  jmcneill 	}
    601  1.1  jmcneill 	DPRINTF(("ti_iic_wait done retry %#x\n", retry));
    602  1.1  jmcneill 	return v;
    603  1.1  jmcneill }
    604  1.1  jmcneill 
    605  1.1  jmcneill static int
    606  1.1  jmcneill ti_iic_flush(struct ti_iic_softc *sc)
    607  1.1  jmcneill {
    608  1.1  jmcneill 	DPRINTF(("ti_iic_flush\n"));
    609  1.1  jmcneill #if 0
    610  1.1  jmcneill 	int retry = 1000;
    611  1.1  jmcneill 	uint16_t v;
    612  1.1  jmcneill 
    613  1.1  jmcneill 	while ((v = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS_RAW)) & I2C_IRQSTATUS_RRDY) {
    614  1.1  jmcneill 		if (--retry == 0) {
    615  1.1  jmcneill 			aprint_error_dev(sc->sc_dev,
    616  1.1  jmcneill 			    ": flush timeout, stat = %#x\n", v);
    617  1.1  jmcneill 			return EBUSY;
    618  1.1  jmcneill 		}
    619  1.1  jmcneill 		(void)I2C_READ_DATA(sc);
    620  1.1  jmcneill 		delay(1000);
    621  1.1  jmcneill 	}
    622  1.1  jmcneill #endif
    623  1.1  jmcneill 
    624  1.1  jmcneill 	I2C_WRITE_REG(sc, OMAP2_I2C_CNT, 0);
    625  1.1  jmcneill 	return 0;
    626  1.1  jmcneill }
    627  1.1  jmcneill 
    628  1.1  jmcneill static i2c_tag_t
    629  1.1  jmcneill ti_iic_get_tag(device_t dev)
    630  1.1  jmcneill {
    631  1.1  jmcneill 	struct ti_iic_softc * const sc = device_private(dev);
    632  1.1  jmcneill 
    633  1.1  jmcneill 	return &sc->sc_ic;
    634  1.1  jmcneill }
    635