Home | History | Annotate | Line # | Download | only in ingenic
jziic.c revision 1.4
      1  1.4     skrll /*	$NetBSD: jziic.c,v 1.4 2017/05/19 07:43:31 skrll Exp $ */
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.1  macallan  * Copyright (c) 2015 Michael Lorenz
      5  1.1  macallan  * All rights reserved.
      6  1.1  macallan  *
      7  1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8  1.1  macallan  * modification, are permitted provided that the following conditions
      9  1.1  macallan  * are met:
     10  1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11  1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12  1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15  1.1  macallan  *
     16  1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  macallan  */
     28  1.1  macallan 
     29  1.1  macallan #include <sys/cdefs.h>
     30  1.4     skrll __KERNEL_RCSID(0, "$NetBSD: jziic.c,v 1.4 2017/05/19 07:43:31 skrll Exp $");
     31  1.1  macallan 
     32  1.1  macallan /*
     33  1.1  macallan  * a preliminary driver for JZ4780's on-chip SMBus controllers
     34  1.1  macallan  * - needs more error handling and interrupt support
     35  1.4     skrll  * - transfers can't be more than the chip's FIFO, supposedly 16 bytes per
     36  1.1  macallan  *   direction
     37  1.1  macallan  * so, good enough for RTCs but not much else yet
     38  1.1  macallan  */
     39  1.1  macallan 
     40  1.1  macallan #include <sys/param.h>
     41  1.1  macallan #include <sys/systm.h>
     42  1.2  macallan #include <sys/kernel.h>
     43  1.1  macallan #include <sys/device.h>
     44  1.1  macallan #include <sys/mutex.h>
     45  1.1  macallan #include <sys/bus.h>
     46  1.1  macallan #include <sys/mutex.h>
     47  1.2  macallan #include <sys/condvar.h>
     48  1.1  macallan 
     49  1.1  macallan #include <mips/ingenic/ingenic_var.h>
     50  1.1  macallan #include <mips/ingenic/ingenic_regs.h>
     51  1.1  macallan 
     52  1.1  macallan #include <dev/i2c/i2cvar.h>
     53  1.1  macallan 
     54  1.1  macallan #include "opt_ingenic.h"
     55  1.1  macallan 
     56  1.1  macallan #ifdef JZIIC_DEBUG
     57  1.1  macallan #define DPRINTF aprint_error
     58  1.2  macallan #define STATIC /* */
     59  1.1  macallan #else
     60  1.1  macallan #define DPRINTF while (0) printf
     61  1.2  macallan #define STATIC static
     62  1.1  macallan #endif
     63  1.2  macallan 
     64  1.2  macallan STATIC int jziic_match(device_t, struct cfdata *, void *);
     65  1.2  macallan STATIC void jziic_attach(device_t, device_t, void *);
     66  1.1  macallan 
     67  1.1  macallan struct jziic_softc {
     68  1.1  macallan 	device_t 		sc_dev;
     69  1.1  macallan 	bus_space_tag_t 	sc_memt;
     70  1.1  macallan 	bus_space_handle_t 	sc_memh;
     71  1.1  macallan 	struct i2c_controller 	sc_i2c;
     72  1.2  macallan 	kmutex_t		sc_buslock, sc_cvlock;
     73  1.1  macallan 	uint32_t		sc_pclk;
     74  1.2  macallan 	/* stuff used for interrupt-driven transfers */
     75  1.2  macallan 	const uint8_t		*sc_cmd;
     76  1.2  macallan 	uint8_t			*sc_buf;
     77  1.2  macallan 	uint32_t		sc_cmdlen, sc_buflen;
     78  1.2  macallan 	uint32_t		sc_cmdptr, sc_bufptr, sc_rds;
     79  1.2  macallan 	uint32_t		sc_abort;
     80  1.2  macallan 	kcondvar_t		sc_ping;
     81  1.2  macallan 	uint8_t			sc_txbuf[256];
     82  1.2  macallan 	boolean_t		sc_reading;
     83  1.1  macallan };
     84  1.1  macallan 
     85  1.1  macallan CFATTACH_DECL_NEW(jziic, sizeof(struct jziic_softc),
     86  1.1  macallan     jziic_match, jziic_attach, NULL, NULL);
     87  1.1  macallan 
     88  1.2  macallan STATIC int jziic_enable(struct jziic_softc *);
     89  1.2  macallan STATIC void jziic_disable(struct jziic_softc *);
     90  1.2  macallan STATIC int jziic_wait(struct jziic_softc *);
     91  1.2  macallan STATIC void jziic_set_speed(struct jziic_softc *);
     92  1.2  macallan STATIC int jziic_i2c_acquire_bus(void *, int);
     93  1.2  macallan STATIC void jziic_i2c_release_bus(void *, int);
     94  1.2  macallan STATIC int jziic_i2c_exec(void *, i2c_op_t, i2c_addr_t, const void *, size_t,
     95  1.1  macallan 		    void *, size_t, int);
     96  1.2  macallan STATIC int jziic_i2c_exec_poll(struct jziic_softc *, i2c_op_t, i2c_addr_t,
     97  1.2  macallan     const void *, size_t, void *, size_t, int);
     98  1.2  macallan STATIC int jziic_i2c_exec_intr(struct jziic_softc *, i2c_op_t, i2c_addr_t,
     99  1.2  macallan     const void *, size_t, void *, size_t, int);
    100  1.2  macallan 
    101  1.2  macallan STATIC int jziic_intr(void *);
    102  1.1  macallan 
    103  1.1  macallan 
    104  1.1  macallan /* ARGSUSED */
    105  1.2  macallan STATIC int
    106  1.1  macallan jziic_match(device_t parent, struct cfdata *match, void *aux)
    107  1.1  macallan {
    108  1.1  macallan 	struct apbus_attach_args *aa = aux;
    109  1.1  macallan 
    110  1.1  macallan 	if (strcmp(aa->aa_name, "jziic") != 0)
    111  1.1  macallan 		return 0;
    112  1.1  macallan 
    113  1.1  macallan 	return 1;
    114  1.1  macallan }
    115  1.1  macallan 
    116  1.1  macallan /* ARGSUSED */
    117  1.2  macallan STATIC void
    118  1.1  macallan jziic_attach(device_t parent, device_t self, void *aux)
    119  1.1  macallan {
    120  1.1  macallan 	struct jziic_softc *sc = device_private(self);
    121  1.1  macallan 	struct apbus_attach_args *aa = aux;
    122  1.1  macallan 	struct i2cbus_attach_args iba;
    123  1.1  macallan 	int error;
    124  1.2  macallan 	void *ih;
    125  1.1  macallan #ifdef JZIIC_DEBUG
    126  1.1  macallan 	int i;
    127  1.1  macallan 	uint8_t in[1] = {0}, out[16];
    128  1.1  macallan #endif
    129  1.1  macallan 
    130  1.1  macallan 	sc->sc_dev = self;
    131  1.1  macallan 	sc->sc_pclk = aa->aa_pclk;
    132  1.1  macallan 	sc->sc_memt = aa->aa_bst;
    133  1.1  macallan 
    134  1.1  macallan 	error = bus_space_map(aa->aa_bst, aa->aa_addr, 0x100, 0, &sc->sc_memh);
    135  1.1  macallan 	if (error) {
    136  1.1  macallan 		aprint_error_dev(self,
    137  1.1  macallan 		    "can't map registers for %s: %d\n", aa->aa_name, error);
    138  1.1  macallan 		return;
    139  1.1  macallan 	}
    140  1.1  macallan 
    141  1.1  macallan 	mutex_init(&sc->sc_buslock, MUTEX_DEFAULT, IPL_NONE);
    142  1.2  macallan 	mutex_init(&sc->sc_cvlock, MUTEX_DEFAULT, IPL_NONE);
    143  1.2  macallan 	cv_init(&sc->sc_ping, device_xname(self));
    144  1.1  macallan 
    145  1.1  macallan 	aprint_naive(": SMBus controller\n");
    146  1.1  macallan 	aprint_normal(": SMBus controller\n");
    147  1.1  macallan 
    148  1.2  macallan 	ih = evbmips_intr_establish(aa->aa_irq, jziic_intr, sc);
    149  1.1  macallan 
    150  1.1  macallan 	if (ih == NULL) {
    151  1.1  macallan 		aprint_error_dev(self, "failed to establish interrupt %d\n",
    152  1.1  macallan 		     aa->aa_irq);
    153  1.1  macallan 		goto fail;
    154  1.1  macallan 	}
    155  1.1  macallan 
    156  1.1  macallan #ifdef JZIIC_DEBUG
    157  1.1  macallan 	if (jziic_i2c_exec(sc, I2C_OP_READ_WITH_STOP, 0x51, in, 1, out, 9, 0)
    158  1.1  macallan 	    >= 0) {
    159  1.1  macallan 		for (i = 0; i < 9; i++)
    160  1.1  macallan 			printf(" %02x", out[i]);
    161  1.1  macallan 		printf("\n");
    162  1.1  macallan 		delay(1000000);
    163  1.1  macallan 		jziic_i2c_exec(sc, I2C_OP_READ_WITH_STOP,
    164  1.1  macallan 		    0x51, in, 1, out, 9, 0);
    165  1.1  macallan 		for (i = 0; i < 9; i++)
    166  1.1  macallan 			printf(" %02x", out[i]);
    167  1.1  macallan 		printf("\n");
    168  1.1  macallan 		delay(1000000);
    169  1.1  macallan 		jziic_i2c_exec(sc, I2C_OP_READ_WITH_STOP,
    170  1.1  macallan 		    0x51, in, 1, out, 9, 0);
    171  1.1  macallan 		for (i = 0; i < 9; i++)
    172  1.1  macallan 			printf(" %02x", out[i]);
    173  1.1  macallan 		printf("\n");
    174  1.1  macallan 	}
    175  1.1  macallan #endif
    176  1.1  macallan 
    177  1.1  macallan 	/* fill in the i2c tag */
    178  1.1  macallan 	sc->sc_i2c.ic_cookie = sc;
    179  1.1  macallan 	sc->sc_i2c.ic_acquire_bus = jziic_i2c_acquire_bus;
    180  1.1  macallan 	sc->sc_i2c.ic_release_bus = jziic_i2c_release_bus;
    181  1.1  macallan 	sc->sc_i2c.ic_send_start = NULL;
    182  1.1  macallan 	sc->sc_i2c.ic_send_stop = NULL;
    183  1.1  macallan 	sc->sc_i2c.ic_initiate_xfer = NULL;
    184  1.1  macallan 	sc->sc_i2c.ic_read_byte = NULL;
    185  1.1  macallan 	sc->sc_i2c.ic_write_byte = NULL;
    186  1.1  macallan 	sc->sc_i2c.ic_exec = jziic_i2c_exec;
    187  1.1  macallan 
    188  1.3  macallan 	memset(&iba, 0, sizeof(iba));
    189  1.1  macallan 	iba.iba_tag = &sc->sc_i2c;
    190  1.1  macallan 	(void) config_found_ia(sc->sc_dev, "i2cbus", &iba, iicbus_print);
    191  1.1  macallan 
    192  1.1  macallan 
    193  1.1  macallan 	return;
    194  1.1  macallan 
    195  1.1  macallan fail:
    196  1.1  macallan 	if (ih) {
    197  1.1  macallan 		evbmips_intr_disestablish(ih);
    198  1.1  macallan 	}
    199  1.1  macallan 	bus_space_unmap(sc->sc_memt, sc->sc_memh, 0x100);
    200  1.1  macallan }
    201  1.1  macallan 
    202  1.2  macallan STATIC int
    203  1.1  macallan jziic_enable(struct jziic_softc *sc)
    204  1.1  macallan {
    205  1.1  macallan 	int bail = 100000;
    206  1.1  macallan 	uint32_t reg;
    207  1.1  macallan 
    208  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBENB, JZ_ENABLE);
    209  1.1  macallan 	reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    210  1.1  macallan 	DPRINTF("status: %02x\n", reg);
    211  1.1  macallan 	while ((bail > 0) && (reg == 0)) {
    212  1.1  macallan 		bail--;
    213  1.1  macallan 		reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    214  1.1  macallan 	}
    215  1.1  macallan 	DPRINTF("bail: %d\n", bail);
    216  1.1  macallan 	return (reg != 0);
    217  1.1  macallan }
    218  1.1  macallan 
    219  1.2  macallan STATIC void
    220  1.1  macallan jziic_disable(struct jziic_softc *sc)
    221  1.1  macallan {
    222  1.1  macallan 	int bail = 100000;
    223  1.1  macallan 	uint32_t reg;
    224  1.1  macallan 
    225  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBENB, 0);
    226  1.1  macallan 	reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    227  1.1  macallan 	DPRINTF("status: %02x\n", reg);
    228  1.1  macallan 	while ((bail > 0) && (reg != 0)) {
    229  1.1  macallan 		bail--;
    230  1.1  macallan 		reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    231  1.1  macallan 	}
    232  1.1  macallan 	DPRINTF("bail: %d\n", bail);
    233  1.1  macallan }
    234  1.1  macallan 
    235  1.2  macallan STATIC int
    236  1.1  macallan jziic_i2c_acquire_bus(void *cookie, int flags)
    237  1.1  macallan {
    238  1.1  macallan 	struct jziic_softc *sc = cookie;
    239  1.1  macallan 
    240  1.1  macallan 	mutex_enter(&sc->sc_buslock);
    241  1.1  macallan 	return 0;
    242  1.1  macallan }
    243  1.1  macallan 
    244  1.2  macallan STATIC void
    245  1.1  macallan jziic_i2c_release_bus(void *cookie, int flags)
    246  1.1  macallan {
    247  1.1  macallan 	struct jziic_softc *sc = cookie;
    248  1.1  macallan 
    249  1.1  macallan 	mutex_exit(&sc->sc_buslock);
    250  1.1  macallan }
    251  1.1  macallan 
    252  1.2  macallan STATIC int
    253  1.1  macallan jziic_wait(struct jziic_softc *sc)
    254  1.1  macallan {
    255  1.1  macallan 	uint32_t reg;
    256  1.1  macallan 	int bail = 10000;
    257  1.1  macallan 	reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST);
    258  1.1  macallan 	while ((reg & JZ_MSTACT) && (bail > 0)) {
    259  1.1  macallan 		delay(100);
    260  1.1  macallan 		reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST);
    261  1.1  macallan 		bail--;
    262  1.4     skrll 	}
    263  1.1  macallan 	return ((reg & JZ_MSTACT) == 0);
    264  1.1  macallan }
    265  1.1  macallan 
    266  1.2  macallan STATIC void
    267  1.2  macallan jziic_set_speed(struct jziic_softc *sc)
    268  1.1  macallan {
    269  1.1  macallan 	int ticks, hcnt, lcnt, hold, setup;
    270  1.1  macallan 
    271  1.1  macallan 	/* PCLK ticks per SMBus cycle */
    272  1.1  macallan 	ticks = sc->sc_pclk / 100; /* assuming 100kHz for now */
    273  1.1  macallan 	hcnt = (ticks * 40 / (40 + 47)) - 8;
    274  1.1  macallan 	lcnt = (ticks * 47 / (40 + 47)) - 1;
    275  1.1  macallan 	hold = sc->sc_pclk * 4 / 10000 - 1; /* ... * 400 / 1000000 ... */
    276  1.1  macallan 	hold = max(1, hold);
    277  1.1  macallan 	hold |= JZ_HDENB;
    278  1.1  macallan 	setup = sc->sc_pclk * 3 / 10000 + 1; /* ... * 300 / 1000000 ... */
    279  1.1  macallan 	DPRINTF("hcnt %d lcnt %d hold %d\n", hcnt, lcnt, hold);
    280  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSHCNT, hcnt);
    281  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSLCNT, lcnt);
    282  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSDAHD, hold);
    283  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSDASU, setup);
    284  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCON,
    285  1.1  macallan 	    JZ_SLVDIS | JZ_STPHLD | JZ_REST | JZ_SPD_100KB | JZ_MD);
    286  1.1  macallan 	(void)bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBCINT);
    287  1.2  macallan }
    288  1.2  macallan 
    289  1.2  macallan STATIC int
    290  1.2  macallan jziic_i2c_exec(void *cookie, i2c_op_t op, i2c_addr_t addr, const void *vcmd,
    291  1.2  macallan     size_t cmdlen, void *vbuf, size_t buflen, int flags)
    292  1.2  macallan {
    293  1.2  macallan 	struct jziic_softc *sc = cookie;
    294  1.2  macallan 
    295  1.2  macallan 	if (cold || (flags & I2C_F_POLL)) {
    296  1.2  macallan 		return jziic_i2c_exec_poll(sc, op, addr, vcmd, cmdlen, vbuf,
    297  1.2  macallan 		    buflen, flags);
    298  1.2  macallan 	} else {
    299  1.2  macallan #ifdef JZIIC_DEBUG
    300  1.2  macallan 		uint8_t *b = vbuf;
    301  1.2  macallan 		int i, ret;
    302  1.2  macallan 
    303  1.2  macallan 		memset(vbuf, 0, buflen);
    304  1.2  macallan 		jziic_i2c_exec_intr(sc, op, addr, vcmd, cmdlen, vbuf,
    305  1.2  macallan 		    buflen, flags);
    306  1.2  macallan 		for (i = 0; i < buflen; i++) {
    307  1.2  macallan 			printf(" %02x", b[i]);
    308  1.2  macallan 		}
    309  1.2  macallan 		printf("\n");
    310  1.2  macallan 		ret = jziic_i2c_exec_poll(sc, op, addr, vcmd, cmdlen, vbuf,
    311  1.2  macallan 		    buflen, flags);
    312  1.2  macallan 		for (i = 0; i < buflen; i++) {
    313  1.2  macallan 			printf(" %02x", b[i]);
    314  1.2  macallan 		}
    315  1.2  macallan 		printf("\n");
    316  1.2  macallan 		return ret;
    317  1.2  macallan #else
    318  1.2  macallan 		return jziic_i2c_exec_intr(sc, op, addr, vcmd, cmdlen, vbuf,
    319  1.2  macallan 		    buflen, flags);
    320  1.2  macallan #endif
    321  1.2  macallan 	}
    322  1.2  macallan }
    323  1.2  macallan 
    324  1.2  macallan STATIC int
    325  1.2  macallan jziic_i2c_exec_poll(struct jziic_softc *sc, i2c_op_t op, i2c_addr_t addr,
    326  1.2  macallan     const void *vcmd, size_t cmdlen, void *vbuf, size_t buflen, int flags)
    327  1.2  macallan {
    328  1.2  macallan 	int i, bail = 10000, ret = 0;
    329  1.2  macallan 	uint32_t abort;
    330  1.2  macallan 	uint8_t *rx, data;
    331  1.2  macallan 	const uint8_t *tx;
    332  1.2  macallan 
    333  1.2  macallan 	tx = vcmd;
    334  1.2  macallan 	rx = vbuf;
    335  1.2  macallan 
    336  1.2  macallan 	DPRINTF("%s: 0x%02x %d %d\n", __func__, addr, cmdlen, buflen);
    337  1.2  macallan 
    338  1.2  macallan 	jziic_disable(sc);
    339  1.2  macallan 
    340  1.2  macallan 	/* we're polling, so disable interrupts */
    341  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    342  1.2  macallan 
    343  1.2  macallan 	jziic_set_speed(sc);
    344  1.1  macallan 	jziic_wait(sc);
    345  1.1  macallan 	/* try to talk... */
    346  1.1  macallan 
    347  1.1  macallan 	if (!jziic_enable(sc)) {
    348  1.1  macallan 		ret = -1;
    349  1.1  macallan 		goto bork;
    350  1.1  macallan 	}
    351  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    352  1.1  macallan 
    353  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBTAR, addr);
    354  1.1  macallan 	jziic_wait(sc);
    355  1.1  macallan 	DPRINTF("st: %02x\n",
    356  1.1  macallan 	    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST));
    357  1.1  macallan 	DPRINTF("wr int: %02x\n",
    358  1.1  macallan 	    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST));
    359  1.1  macallan 	abort = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBABTSRC);
    360  1.1  macallan 	DPRINTF("abort: %02x\n", abort);
    361  1.1  macallan 	if ((abort != 0)) {
    362  1.1  macallan 		ret = -1;
    363  1.1  macallan 		goto bork;
    364  1.1  macallan 	}
    365  1.1  macallan 
    366  1.1  macallan 	do {
    367  1.1  macallan 		bail--;
    368  1.1  macallan 		delay(100);
    369  1.1  macallan 	} while (((bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST) &
    370  1.1  macallan 	           JZ_TFE) == 0) && (bail > 0));
    371  1.1  macallan 
    372  1.1  macallan 	if (cmdlen != 0) {
    373  1.1  macallan 		for (i = 0; i < cmdlen; i++) {
    374  1.1  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    375  1.1  macallan 			    JZ_SMBDC, *tx);
    376  1.1  macallan 			tx++;
    377  1.1  macallan 		}
    378  1.1  macallan 	}
    379  1.1  macallan 
    380  1.1  macallan 	if (I2C_OP_READ_P(op)) {
    381  1.1  macallan 		/* now read */
    382  1.1  macallan 		for (i = 0; i < (buflen + 1); i++) {
    383  1.1  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    384  1.1  macallan 			    JZ_SMBDC, JZ_CMD);
    385  1.1  macallan 		}
    386  1.1  macallan 		wbflush();
    387  1.1  macallan 		DPRINTF("rd st: %02x\n",
    388  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST));
    389  1.1  macallan 		DPRINTF("rd int: %02x\n",
    390  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST));
    391  1.1  macallan 		DPRINTF("abort: %02x\n",
    392  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBABTSRC));
    393  1.1  macallan 		for (i = 0; i < buflen; i++) {
    394  1.1  macallan 			bail = 10000;
    395  1.1  macallan 			while (((bus_space_read_4(sc->sc_memt, sc->sc_memh,
    396  1.1  macallan 				  JZ_SMBST) & JZ_RFNE) == 0) && (bail > 0)) {
    397  1.1  macallan 				bail--;
    398  1.1  macallan 				delay(100);
    399  1.4     skrll 			}
    400  1.1  macallan 			if (bail == 0) {
    401  1.1  macallan 				ret = -1;
    402  1.1  macallan 				goto bork;
    403  1.1  macallan 			}
    404  1.1  macallan 			data = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    405  1.1  macallan 			    JZ_SMBDC);
    406  1.1  macallan 			DPRINTF("rd st: %02x %d\n",
    407  1.1  macallan 			  bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST),
    408  1.1  macallan 			  bail);
    409  1.1  macallan 			DPRINTF("rd int: %02x\n",
    410  1.1  macallan 			  bus_space_read_4(sc->sc_memt, sc->sc_memh,
    411  1.1  macallan 			   JZ_SMBINTST));
    412  1.1  macallan 			DPRINTF("abort: %02x\n", abort);
    413  1.1  macallan 			DPRINTF("rd data: %02x\n", data);
    414  1.1  macallan 			*rx = data;
    415  1.1  macallan 			rx++;
    416  1.1  macallan 		}
    417  1.1  macallan 	} else {
    418  1.1  macallan 		tx = vbuf;
    419  1.1  macallan 		for (i = 0; i < buflen; i++) {
    420  1.1  macallan 			DPRINTF("wr data: %02x\n", *tx);
    421  1.1  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    422  1.1  macallan 			    JZ_SMBDC, *tx);
    423  1.1  macallan 			wbflush();
    424  1.1  macallan 			tx++;
    425  1.1  macallan 		}
    426  1.1  macallan 		jziic_wait(sc);
    427  1.1  macallan 		abort = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    428  1.1  macallan 		    JZ_SMBABTSRC);
    429  1.1  macallan 		DPRINTF("abort: %02x\n", abort);
    430  1.1  macallan 		if ((abort != 0)) {
    431  1.1  macallan 			ret = -1;
    432  1.1  macallan 			goto bork;
    433  1.1  macallan 		}
    434  1.1  macallan 
    435  1.1  macallan 		DPRINTF("st: %02x %d\n",
    436  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST), bail);
    437  1.1  macallan 		DPRINTF("wr int: %02x\n",
    438  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST));
    439  1.1  macallan 	}
    440  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCON,
    441  1.1  macallan 	    JZ_SLVDIS | JZ_REST | JZ_SPD_100KB | JZ_MD);
    442  1.1  macallan bork:
    443  1.1  macallan 	jziic_disable(sc);
    444  1.1  macallan 	return ret;
    445  1.1  macallan }
    446  1.2  macallan 
    447  1.2  macallan STATIC int
    448  1.2  macallan jziic_i2c_exec_intr(struct jziic_softc *sc, i2c_op_t op, i2c_addr_t addr,
    449  1.2  macallan     const void *vcmd, size_t cmdlen, void *vbuf, size_t buflen, int flags)
    450  1.2  macallan {
    451  1.2  macallan 	int i, ret = 0, bail;
    452  1.2  macallan 
    453  1.2  macallan 	DPRINTF("%s: 0x%02x %d %d\n", __func__, addr, cmdlen, buflen);
    454  1.2  macallan 
    455  1.2  macallan 	jziic_disable(sc);
    456  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    457  1.2  macallan 
    458  1.2  macallan 	mutex_enter(&sc->sc_cvlock);
    459  1.2  macallan 
    460  1.2  macallan 	sc->sc_reading = FALSE;
    461  1.2  macallan 
    462  1.2  macallan 	if (I2C_OP_READ_P(op)) {
    463  1.2  macallan 		sc->sc_cmd = vcmd;
    464  1.2  macallan 		sc->sc_cmdlen = cmdlen;
    465  1.2  macallan 		sc->sc_buf = vbuf;
    466  1.2  macallan 		sc->sc_buflen = buflen;
    467  1.2  macallan 		memset(vbuf, 0, buflen);
    468  1.2  macallan 	} else {
    469  1.2  macallan 		if ((cmdlen + buflen) > 256)
    470  1.2  macallan 			return -1;
    471  1.2  macallan 		memcpy(sc->sc_txbuf, vcmd, cmdlen);
    472  1.2  macallan 		memcpy(sc->sc_txbuf + cmdlen, vbuf, buflen);
    473  1.2  macallan 		sc->sc_cmd = sc->sc_txbuf;
    474  1.2  macallan 		sc->sc_cmdlen = cmdlen + buflen;
    475  1.2  macallan 		sc->sc_buf = NULL;
    476  1.2  macallan 		sc->sc_buflen = 0;
    477  1.2  macallan 	}
    478  1.2  macallan 	sc->sc_cmdptr = 0;
    479  1.2  macallan 	sc->sc_bufptr = 0;
    480  1.2  macallan 	sc->sc_rds = 0;
    481  1.2  macallan 	sc->sc_abort = 0;
    482  1.2  macallan 
    483  1.2  macallan 	jziic_set_speed(sc);
    484  1.2  macallan 	jziic_wait(sc);
    485  1.2  macallan 
    486  1.2  macallan 	/* set FIFO levels */
    487  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBTXTL, 4);
    488  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBRXTL, 0
    489  1.2  macallan 	    /*min(7, max(0, buflen - 2 ))*/);
    490  1.2  macallan 
    491  1.2  macallan 	/* try to talk... */
    492  1.2  macallan 
    493  1.2  macallan 	if (!jziic_enable(sc)) {
    494  1.2  macallan 		ret = -1;
    495  1.2  macallan 		goto bork;
    496  1.2  macallan 	}
    497  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    498  1.2  macallan 
    499  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBTAR, addr);
    500  1.2  macallan 	jziic_wait(sc);
    501  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCINT, JZ_CLEARALL);
    502  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM,
    503  1.2  macallan 	    JZ_TXABT | JZ_TXEMP);
    504  1.2  macallan 
    505  1.2  macallan 	bail = 100 * sc->sc_cmdlen;
    506  1.2  macallan 	while ((sc->sc_cmdptr < sc->sc_cmdlen) && (bail > 0)) {
    507  1.2  macallan 		cv_timedwait(&sc->sc_ping, &sc->sc_cvlock, 1);
    508  1.2  macallan 		if (sc->sc_abort) {
    509  1.2  macallan 			/* we received an abort interrupt -> bailout */
    510  1.2  macallan 		    	DPRINTF("abort: %x\n", sc->sc_abort);
    511  1.2  macallan 		    	ret = -1;
    512  1.2  macallan 		    	goto bork;
    513  1.2  macallan 		}
    514  1.2  macallan 	    	bail--;
    515  1.2  macallan 	}
    516  1.2  macallan 
    517  1.2  macallan 	if (sc->sc_cmdptr < sc->sc_cmdlen) {
    518  1.2  macallan 		/* we didn't send everything? */
    519  1.2  macallan 	    	DPRINTF("sent %d of %d\n", sc->sc_cmdptr, sc->sc_cmdlen);
    520  1.2  macallan 	    	ret = -1;
    521  1.2  macallan 	    	goto bork;
    522  1.2  macallan 	}
    523  1.2  macallan 
    524  1.2  macallan 	if (I2C_OP_READ_P(op)) {
    525  1.2  macallan 		/* now read */
    526  1.2  macallan 		sc->sc_reading = TRUE;
    527  1.2  macallan 		bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM,
    528  1.2  macallan 		    JZ_TXABT | JZ_RXFL | JZ_TXEMP);
    529  1.2  macallan 
    530  1.2  macallan 		for (i = 0; i < min((buflen + 1), 4); i++) {
    531  1.2  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    532  1.2  macallan 			    JZ_SMBDC, JZ_CMD);
    533  1.2  macallan 			wbflush();
    534  1.2  macallan 		}
    535  1.2  macallan 		sc->sc_rds = i;
    536  1.2  macallan 
    537  1.2  macallan 		bail = 10 * sc->sc_buflen; /* 10 ticks per byte should be ok */
    538  1.2  macallan 		while ((sc->sc_bufptr < sc->sc_buflen) && (bail > 0)) {
    539  1.4     skrll 			cv_timedwait(&sc->sc_ping, &sc->sc_cvlock, 1);
    540  1.2  macallan 			if (sc->sc_abort) {
    541  1.2  macallan 				/* we received an abort interrupt -> bailout */
    542  1.2  macallan 		  	  	DPRINTF("rx abort: %x\n", sc->sc_abort);
    543  1.2  macallan 			    	ret = -1;
    544  1.2  macallan 			    	goto bork;
    545  1.2  macallan 			}
    546  1.2  macallan 			bail--;
    547  1.2  macallan 		}
    548  1.2  macallan 
    549  1.2  macallan 		if (sc->sc_bufptr < sc->sc_buflen) {
    550  1.2  macallan 			/* we didn't get everything? */
    551  1.2  macallan 		    	DPRINTF("rcvd %d of %d\n", sc->sc_bufptr, sc->sc_buflen);
    552  1.2  macallan 		    	ret = -1;
    553  1.2  macallan 		    	goto bork;
    554  1.2  macallan 		}
    555  1.2  macallan 	}
    556  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCON,
    557  1.2  macallan 	    JZ_SLVDIS | JZ_REST | JZ_SPD_100KB | JZ_MD);
    558  1.2  macallan bork:
    559  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    560  1.2  macallan 	jziic_disable(sc);
    561  1.2  macallan 	mutex_exit(&sc->sc_cvlock);
    562  1.2  macallan 	return ret;
    563  1.2  macallan }
    564  1.2  macallan 
    565  1.2  macallan STATIC int
    566  1.2  macallan jziic_intr(void *cookie)
    567  1.2  macallan {
    568  1.2  macallan 	struct jziic_softc *sc = cookie;
    569  1.2  macallan 	uint32_t stat, data, rstat;
    570  1.2  macallan 	int i;
    571  1.2  macallan 
    572  1.2  macallan 	stat = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST);
    573  1.2  macallan 	if (stat & JZ_TXEMP) {
    574  1.2  macallan 		if (sc->sc_reading) {
    575  1.2  macallan 			if (sc->sc_rds < (sc->sc_buflen + 1)) {
    576  1.2  macallan 				for (i = 0;
    577  1.2  macallan 				     i < min(4, (sc->sc_buflen + 1) -
    578  1.2  macallan 				                 sc->sc_rds);
    579  1.2  macallan 				     i++) {
    580  1.2  macallan 					bus_space_write_4( sc->sc_memt,
    581  1.2  macallan 					    sc->sc_memh,
    582  1.2  macallan 					    JZ_SMBDC, JZ_CMD);
    583  1.2  macallan 					wbflush();
    584  1.2  macallan 				}
    585  1.2  macallan 				sc->sc_rds += i;
    586  1.2  macallan 			} else {
    587  1.2  macallan 				/* we're done, so turn TX FIFO interrupt off */
    588  1.2  macallan 				bus_space_write_4(sc->sc_memt, sc->sc_memh,
    589  1.2  macallan 				    JZ_SMBINTM,
    590  1.2  macallan 				    JZ_TXABT | JZ_RXFL);
    591  1.2  macallan 			}
    592  1.4     skrll 		} else {
    593  1.2  macallan 			rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    594  1.2  macallan 			    JZ_SMBST);
    595  1.4     skrll 			while ((rstat & JZ_TFNF) &&
    596  1.2  macallan 			         (sc->sc_cmdptr < sc->sc_cmdlen)) {
    597  1.2  macallan 				data = *sc->sc_cmd;
    598  1.2  macallan 				sc->sc_cmd++;
    599  1.2  macallan 				sc->sc_cmdptr++;
    600  1.2  macallan 				bus_space_write_4(sc->sc_memt, sc->sc_memh,
    601  1.2  macallan 				    JZ_SMBDC, data & 0xff);
    602  1.2  macallan 				rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    603  1.2  macallan 				    JZ_SMBST);
    604  1.2  macallan 			};
    605  1.2  macallan 			/* no need to clear this one */
    606  1.2  macallan 			if (sc->sc_cmdptr >= sc->sc_cmdlen) {
    607  1.2  macallan 				cv_signal(&sc->sc_ping);
    608  1.2  macallan 				bus_space_write_4(sc->sc_memt, sc->sc_memh,
    609  1.2  macallan 				    JZ_SMBINTM, JZ_TXABT);
    610  1.2  macallan 			}
    611  1.4     skrll 		}
    612  1.2  macallan 	}
    613  1.2  macallan 	if (stat & JZ_RXFL) {
    614  1.2  macallan 		rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST);
    615  1.2  macallan 		while ((rstat & JZ_RFNE) && (sc->sc_bufptr < sc->sc_buflen)) {
    616  1.2  macallan 			data = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    617  1.2  macallan 			   JZ_SMBDC);
    618  1.2  macallan 			*sc->sc_buf = (uint8_t)(data & 0xff);
    619  1.2  macallan 			sc->sc_buf++;
    620  1.2  macallan 			sc->sc_bufptr++;
    621  1.2  macallan 			rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    622  1.2  macallan 			    JZ_SMBST);
    623  1.2  macallan 		}
    624  1.2  macallan 		if (sc->sc_bufptr >= sc->sc_buflen)
    625  1.2  macallan 			cv_signal(&sc->sc_ping);
    626  1.2  macallan 	}
    627  1.2  macallan 	if (stat & JZ_TXABT) {
    628  1.2  macallan 		sc->sc_abort = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    629  1.2  macallan 		    JZ_SMBABTSRC);
    630  1.2  macallan 		cv_signal(&sc->sc_ping);
    631  1.2  macallan 		bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCINT,
    632  1.2  macallan 		    JZ_CLEARALL);
    633  1.2  macallan 		bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    634  1.2  macallan 	}
    635  1.2  macallan 	return 0;
    636  1.2  macallan }
    637