Home | History | Annotate | Line # | Download | only in ingenic
jziic.c revision 1.7
      1  1.7   thorpej /*	$NetBSD: jziic.c,v 1.7 2019/12/23 02:16:43 thorpej 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.7   thorpej __KERNEL_RCSID(0, "$NetBSD: jziic.c,v 1.7 2019/12/23 02:16:43 thorpej 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.6   thorpej 	kmutex_t		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_exec(void *, i2c_op_t, i2c_addr_t, const void *, size_t,
     93  1.1  macallan 		    void *, size_t, int);
     94  1.2  macallan STATIC int jziic_i2c_exec_poll(struct jziic_softc *, i2c_op_t, i2c_addr_t,
     95  1.2  macallan     const void *, size_t, void *, size_t, int);
     96  1.2  macallan STATIC int jziic_i2c_exec_intr(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 
     99  1.2  macallan STATIC int jziic_intr(void *);
    100  1.1  macallan 
    101  1.1  macallan 
    102  1.1  macallan /* ARGSUSED */
    103  1.2  macallan STATIC int
    104  1.1  macallan jziic_match(device_t parent, struct cfdata *match, void *aux)
    105  1.1  macallan {
    106  1.1  macallan 	struct apbus_attach_args *aa = aux;
    107  1.1  macallan 
    108  1.1  macallan 	if (strcmp(aa->aa_name, "jziic") != 0)
    109  1.1  macallan 		return 0;
    110  1.1  macallan 
    111  1.1  macallan 	return 1;
    112  1.1  macallan }
    113  1.1  macallan 
    114  1.1  macallan /* ARGSUSED */
    115  1.2  macallan STATIC void
    116  1.1  macallan jziic_attach(device_t parent, device_t self, void *aux)
    117  1.1  macallan {
    118  1.1  macallan 	struct jziic_softc *sc = device_private(self);
    119  1.1  macallan 	struct apbus_attach_args *aa = aux;
    120  1.1  macallan 	struct i2cbus_attach_args iba;
    121  1.1  macallan 	int error;
    122  1.2  macallan 	void *ih;
    123  1.1  macallan #ifdef JZIIC_DEBUG
    124  1.1  macallan 	int i;
    125  1.1  macallan 	uint8_t in[1] = {0}, out[16];
    126  1.1  macallan #endif
    127  1.1  macallan 
    128  1.1  macallan 	sc->sc_dev = self;
    129  1.1  macallan 	sc->sc_pclk = aa->aa_pclk;
    130  1.1  macallan 	sc->sc_memt = aa->aa_bst;
    131  1.1  macallan 
    132  1.1  macallan 	error = bus_space_map(aa->aa_bst, aa->aa_addr, 0x100, 0, &sc->sc_memh);
    133  1.1  macallan 	if (error) {
    134  1.1  macallan 		aprint_error_dev(self,
    135  1.1  macallan 		    "can't map registers for %s: %d\n", aa->aa_name, error);
    136  1.1  macallan 		return;
    137  1.1  macallan 	}
    138  1.1  macallan 
    139  1.2  macallan 	mutex_init(&sc->sc_cvlock, MUTEX_DEFAULT, IPL_NONE);
    140  1.2  macallan 	cv_init(&sc->sc_ping, device_xname(self));
    141  1.1  macallan 
    142  1.1  macallan 	aprint_naive(": SMBus controller\n");
    143  1.1  macallan 	aprint_normal(": SMBus controller\n");
    144  1.1  macallan 
    145  1.2  macallan 	ih = evbmips_intr_establish(aa->aa_irq, jziic_intr, sc);
    146  1.1  macallan 
    147  1.1  macallan 	if (ih == NULL) {
    148  1.1  macallan 		aprint_error_dev(self, "failed to establish interrupt %d\n",
    149  1.1  macallan 		     aa->aa_irq);
    150  1.1  macallan 		goto fail;
    151  1.1  macallan 	}
    152  1.1  macallan 
    153  1.1  macallan #ifdef JZIIC_DEBUG
    154  1.1  macallan 	if (jziic_i2c_exec(sc, I2C_OP_READ_WITH_STOP, 0x51, in, 1, out, 9, 0)
    155  1.1  macallan 	    >= 0) {
    156  1.1  macallan 		for (i = 0; i < 9; i++)
    157  1.1  macallan 			printf(" %02x", out[i]);
    158  1.1  macallan 		printf("\n");
    159  1.1  macallan 		delay(1000000);
    160  1.1  macallan 		jziic_i2c_exec(sc, I2C_OP_READ_WITH_STOP,
    161  1.1  macallan 		    0x51, in, 1, out, 9, 0);
    162  1.1  macallan 		for (i = 0; i < 9; i++)
    163  1.1  macallan 			printf(" %02x", out[i]);
    164  1.1  macallan 		printf("\n");
    165  1.1  macallan 		delay(1000000);
    166  1.1  macallan 		jziic_i2c_exec(sc, I2C_OP_READ_WITH_STOP,
    167  1.1  macallan 		    0x51, in, 1, out, 9, 0);
    168  1.1  macallan 		for (i = 0; i < 9; i++)
    169  1.1  macallan 			printf(" %02x", out[i]);
    170  1.1  macallan 		printf("\n");
    171  1.1  macallan 	}
    172  1.1  macallan #endif
    173  1.1  macallan 
    174  1.1  macallan 	/* fill in the i2c tag */
    175  1.6   thorpej 	iic_tag_init(&sc->sc_i2c);
    176  1.1  macallan 	sc->sc_i2c.ic_cookie = sc;
    177  1.1  macallan 	sc->sc_i2c.ic_exec = jziic_i2c_exec;
    178  1.1  macallan 
    179  1.3  macallan 	memset(&iba, 0, sizeof(iba));
    180  1.1  macallan 	iba.iba_tag = &sc->sc_i2c;
    181  1.1  macallan 	(void) config_found_ia(sc->sc_dev, "i2cbus", &iba, iicbus_print);
    182  1.1  macallan 
    183  1.1  macallan 
    184  1.1  macallan 	return;
    185  1.1  macallan 
    186  1.1  macallan fail:
    187  1.1  macallan 	if (ih) {
    188  1.1  macallan 		evbmips_intr_disestablish(ih);
    189  1.1  macallan 	}
    190  1.1  macallan 	bus_space_unmap(sc->sc_memt, sc->sc_memh, 0x100);
    191  1.1  macallan }
    192  1.1  macallan 
    193  1.2  macallan STATIC int
    194  1.1  macallan jziic_enable(struct jziic_softc *sc)
    195  1.1  macallan {
    196  1.1  macallan 	int bail = 100000;
    197  1.1  macallan 	uint32_t reg;
    198  1.1  macallan 
    199  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBENB, JZ_ENABLE);
    200  1.1  macallan 	reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    201  1.1  macallan 	DPRINTF("status: %02x\n", reg);
    202  1.1  macallan 	while ((bail > 0) && (reg == 0)) {
    203  1.1  macallan 		bail--;
    204  1.1  macallan 		reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    205  1.1  macallan 	}
    206  1.1  macallan 	DPRINTF("bail: %d\n", bail);
    207  1.1  macallan 	return (reg != 0);
    208  1.1  macallan }
    209  1.1  macallan 
    210  1.2  macallan STATIC void
    211  1.1  macallan jziic_disable(struct jziic_softc *sc)
    212  1.1  macallan {
    213  1.1  macallan 	int bail = 100000;
    214  1.1  macallan 	uint32_t reg;
    215  1.1  macallan 
    216  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBENB, 0);
    217  1.1  macallan 	reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    218  1.1  macallan 	DPRINTF("status: %02x\n", reg);
    219  1.1  macallan 	while ((bail > 0) && (reg != 0)) {
    220  1.1  macallan 		bail--;
    221  1.1  macallan 		reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBENBST);
    222  1.1  macallan 	}
    223  1.1  macallan 	DPRINTF("bail: %d\n", bail);
    224  1.1  macallan }
    225  1.1  macallan 
    226  1.2  macallan STATIC int
    227  1.1  macallan jziic_wait(struct jziic_softc *sc)
    228  1.1  macallan {
    229  1.1  macallan 	uint32_t reg;
    230  1.1  macallan 	int bail = 10000;
    231  1.1  macallan 	reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST);
    232  1.1  macallan 	while ((reg & JZ_MSTACT) && (bail > 0)) {
    233  1.1  macallan 		delay(100);
    234  1.1  macallan 		reg = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST);
    235  1.1  macallan 		bail--;
    236  1.4     skrll 	}
    237  1.1  macallan 	return ((reg & JZ_MSTACT) == 0);
    238  1.1  macallan }
    239  1.1  macallan 
    240  1.2  macallan STATIC void
    241  1.2  macallan jziic_set_speed(struct jziic_softc *sc)
    242  1.1  macallan {
    243  1.1  macallan 	int ticks, hcnt, lcnt, hold, setup;
    244  1.1  macallan 
    245  1.1  macallan 	/* PCLK ticks per SMBus cycle */
    246  1.1  macallan 	ticks = sc->sc_pclk / 100; /* assuming 100kHz for now */
    247  1.1  macallan 	hcnt = (ticks * 40 / (40 + 47)) - 8;
    248  1.1  macallan 	lcnt = (ticks * 47 / (40 + 47)) - 1;
    249  1.1  macallan 	hold = sc->sc_pclk * 4 / 10000 - 1; /* ... * 400 / 1000000 ... */
    250  1.5  riastrad 	hold = uimax(1, hold);
    251  1.1  macallan 	hold |= JZ_HDENB;
    252  1.1  macallan 	setup = sc->sc_pclk * 3 / 10000 + 1; /* ... * 300 / 1000000 ... */
    253  1.1  macallan 	DPRINTF("hcnt %d lcnt %d hold %d\n", hcnt, lcnt, hold);
    254  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSHCNT, hcnt);
    255  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSLCNT, lcnt);
    256  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSDAHD, hold);
    257  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBSDASU, setup);
    258  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCON,
    259  1.1  macallan 	    JZ_SLVDIS | JZ_STPHLD | JZ_REST | JZ_SPD_100KB | JZ_MD);
    260  1.1  macallan 	(void)bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBCINT);
    261  1.2  macallan }
    262  1.2  macallan 
    263  1.2  macallan STATIC int
    264  1.2  macallan jziic_i2c_exec(void *cookie, i2c_op_t op, i2c_addr_t addr, const void *vcmd,
    265  1.2  macallan     size_t cmdlen, void *vbuf, size_t buflen, int flags)
    266  1.2  macallan {
    267  1.2  macallan 	struct jziic_softc *sc = cookie;
    268  1.2  macallan 
    269  1.7   thorpej 	if (flags & I2C_F_POLL) {
    270  1.2  macallan 		return jziic_i2c_exec_poll(sc, op, addr, vcmd, cmdlen, vbuf,
    271  1.2  macallan 		    buflen, flags);
    272  1.2  macallan 	} else {
    273  1.2  macallan #ifdef JZIIC_DEBUG
    274  1.2  macallan 		uint8_t *b = vbuf;
    275  1.2  macallan 		int i, ret;
    276  1.2  macallan 
    277  1.2  macallan 		memset(vbuf, 0, buflen);
    278  1.2  macallan 		jziic_i2c_exec_intr(sc, op, addr, vcmd, cmdlen, vbuf,
    279  1.2  macallan 		    buflen, flags);
    280  1.2  macallan 		for (i = 0; i < buflen; i++) {
    281  1.2  macallan 			printf(" %02x", b[i]);
    282  1.2  macallan 		}
    283  1.2  macallan 		printf("\n");
    284  1.2  macallan 		ret = jziic_i2c_exec_poll(sc, op, addr, vcmd, cmdlen, vbuf,
    285  1.2  macallan 		    buflen, flags);
    286  1.2  macallan 		for (i = 0; i < buflen; i++) {
    287  1.2  macallan 			printf(" %02x", b[i]);
    288  1.2  macallan 		}
    289  1.2  macallan 		printf("\n");
    290  1.2  macallan 		return ret;
    291  1.2  macallan #else
    292  1.2  macallan 		return jziic_i2c_exec_intr(sc, op, addr, vcmd, cmdlen, vbuf,
    293  1.2  macallan 		    buflen, flags);
    294  1.2  macallan #endif
    295  1.2  macallan 	}
    296  1.2  macallan }
    297  1.2  macallan 
    298  1.2  macallan STATIC int
    299  1.2  macallan jziic_i2c_exec_poll(struct jziic_softc *sc, i2c_op_t op, i2c_addr_t addr,
    300  1.2  macallan     const void *vcmd, size_t cmdlen, void *vbuf, size_t buflen, int flags)
    301  1.2  macallan {
    302  1.2  macallan 	int i, bail = 10000, ret = 0;
    303  1.2  macallan 	uint32_t abort;
    304  1.2  macallan 	uint8_t *rx, data;
    305  1.2  macallan 	const uint8_t *tx;
    306  1.2  macallan 
    307  1.2  macallan 	tx = vcmd;
    308  1.2  macallan 	rx = vbuf;
    309  1.2  macallan 
    310  1.2  macallan 	DPRINTF("%s: 0x%02x %d %d\n", __func__, addr, cmdlen, buflen);
    311  1.2  macallan 
    312  1.2  macallan 	jziic_disable(sc);
    313  1.2  macallan 
    314  1.2  macallan 	/* we're polling, so disable interrupts */
    315  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    316  1.2  macallan 
    317  1.2  macallan 	jziic_set_speed(sc);
    318  1.1  macallan 	jziic_wait(sc);
    319  1.1  macallan 	/* try to talk... */
    320  1.1  macallan 
    321  1.1  macallan 	if (!jziic_enable(sc)) {
    322  1.1  macallan 		ret = -1;
    323  1.1  macallan 		goto bork;
    324  1.1  macallan 	}
    325  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    326  1.1  macallan 
    327  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBTAR, addr);
    328  1.1  macallan 	jziic_wait(sc);
    329  1.1  macallan 	DPRINTF("st: %02x\n",
    330  1.1  macallan 	    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST));
    331  1.1  macallan 	DPRINTF("wr int: %02x\n",
    332  1.1  macallan 	    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST));
    333  1.1  macallan 	abort = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBABTSRC);
    334  1.1  macallan 	DPRINTF("abort: %02x\n", abort);
    335  1.1  macallan 	if ((abort != 0)) {
    336  1.1  macallan 		ret = -1;
    337  1.1  macallan 		goto bork;
    338  1.1  macallan 	}
    339  1.1  macallan 
    340  1.1  macallan 	do {
    341  1.1  macallan 		bail--;
    342  1.1  macallan 		delay(100);
    343  1.1  macallan 	} while (((bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST) &
    344  1.1  macallan 	           JZ_TFE) == 0) && (bail > 0));
    345  1.1  macallan 
    346  1.1  macallan 	if (cmdlen != 0) {
    347  1.1  macallan 		for (i = 0; i < cmdlen; i++) {
    348  1.1  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    349  1.1  macallan 			    JZ_SMBDC, *tx);
    350  1.1  macallan 			tx++;
    351  1.1  macallan 		}
    352  1.1  macallan 	}
    353  1.1  macallan 
    354  1.1  macallan 	if (I2C_OP_READ_P(op)) {
    355  1.1  macallan 		/* now read */
    356  1.1  macallan 		for (i = 0; i < (buflen + 1); i++) {
    357  1.1  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    358  1.1  macallan 			    JZ_SMBDC, JZ_CMD);
    359  1.1  macallan 		}
    360  1.1  macallan 		wbflush();
    361  1.1  macallan 		DPRINTF("rd st: %02x\n",
    362  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST));
    363  1.1  macallan 		DPRINTF("rd int: %02x\n",
    364  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST));
    365  1.1  macallan 		DPRINTF("abort: %02x\n",
    366  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBABTSRC));
    367  1.1  macallan 		for (i = 0; i < buflen; i++) {
    368  1.1  macallan 			bail = 10000;
    369  1.1  macallan 			while (((bus_space_read_4(sc->sc_memt, sc->sc_memh,
    370  1.1  macallan 				  JZ_SMBST) & JZ_RFNE) == 0) && (bail > 0)) {
    371  1.1  macallan 				bail--;
    372  1.1  macallan 				delay(100);
    373  1.4     skrll 			}
    374  1.1  macallan 			if (bail == 0) {
    375  1.1  macallan 				ret = -1;
    376  1.1  macallan 				goto bork;
    377  1.1  macallan 			}
    378  1.1  macallan 			data = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    379  1.1  macallan 			    JZ_SMBDC);
    380  1.1  macallan 			DPRINTF("rd st: %02x %d\n",
    381  1.1  macallan 			  bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST),
    382  1.1  macallan 			  bail);
    383  1.1  macallan 			DPRINTF("rd int: %02x\n",
    384  1.1  macallan 			  bus_space_read_4(sc->sc_memt, sc->sc_memh,
    385  1.1  macallan 			   JZ_SMBINTST));
    386  1.1  macallan 			DPRINTF("abort: %02x\n", abort);
    387  1.1  macallan 			DPRINTF("rd data: %02x\n", data);
    388  1.1  macallan 			*rx = data;
    389  1.1  macallan 			rx++;
    390  1.1  macallan 		}
    391  1.1  macallan 	} else {
    392  1.1  macallan 		tx = vbuf;
    393  1.1  macallan 		for (i = 0; i < buflen; i++) {
    394  1.1  macallan 			DPRINTF("wr data: %02x\n", *tx);
    395  1.1  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    396  1.1  macallan 			    JZ_SMBDC, *tx);
    397  1.1  macallan 			wbflush();
    398  1.1  macallan 			tx++;
    399  1.1  macallan 		}
    400  1.1  macallan 		jziic_wait(sc);
    401  1.1  macallan 		abort = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    402  1.1  macallan 		    JZ_SMBABTSRC);
    403  1.1  macallan 		DPRINTF("abort: %02x\n", abort);
    404  1.1  macallan 		if ((abort != 0)) {
    405  1.1  macallan 			ret = -1;
    406  1.1  macallan 			goto bork;
    407  1.1  macallan 		}
    408  1.1  macallan 
    409  1.1  macallan 		DPRINTF("st: %02x %d\n",
    410  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST), bail);
    411  1.1  macallan 		DPRINTF("wr int: %02x\n",
    412  1.1  macallan 		    bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST));
    413  1.1  macallan 	}
    414  1.1  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCON,
    415  1.1  macallan 	    JZ_SLVDIS | JZ_REST | JZ_SPD_100KB | JZ_MD);
    416  1.1  macallan bork:
    417  1.1  macallan 	jziic_disable(sc);
    418  1.1  macallan 	return ret;
    419  1.1  macallan }
    420  1.2  macallan 
    421  1.2  macallan STATIC int
    422  1.2  macallan jziic_i2c_exec_intr(struct jziic_softc *sc, i2c_op_t op, i2c_addr_t addr,
    423  1.2  macallan     const void *vcmd, size_t cmdlen, void *vbuf, size_t buflen, int flags)
    424  1.2  macallan {
    425  1.2  macallan 	int i, ret = 0, bail;
    426  1.2  macallan 
    427  1.2  macallan 	DPRINTF("%s: 0x%02x %d %d\n", __func__, addr, cmdlen, buflen);
    428  1.2  macallan 
    429  1.2  macallan 	jziic_disable(sc);
    430  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    431  1.2  macallan 
    432  1.2  macallan 	mutex_enter(&sc->sc_cvlock);
    433  1.2  macallan 
    434  1.2  macallan 	sc->sc_reading = FALSE;
    435  1.2  macallan 
    436  1.2  macallan 	if (I2C_OP_READ_P(op)) {
    437  1.2  macallan 		sc->sc_cmd = vcmd;
    438  1.2  macallan 		sc->sc_cmdlen = cmdlen;
    439  1.2  macallan 		sc->sc_buf = vbuf;
    440  1.2  macallan 		sc->sc_buflen = buflen;
    441  1.2  macallan 		memset(vbuf, 0, buflen);
    442  1.2  macallan 	} else {
    443  1.2  macallan 		if ((cmdlen + buflen) > 256)
    444  1.2  macallan 			return -1;
    445  1.2  macallan 		memcpy(sc->sc_txbuf, vcmd, cmdlen);
    446  1.2  macallan 		memcpy(sc->sc_txbuf + cmdlen, vbuf, buflen);
    447  1.2  macallan 		sc->sc_cmd = sc->sc_txbuf;
    448  1.2  macallan 		sc->sc_cmdlen = cmdlen + buflen;
    449  1.2  macallan 		sc->sc_buf = NULL;
    450  1.2  macallan 		sc->sc_buflen = 0;
    451  1.2  macallan 	}
    452  1.2  macallan 	sc->sc_cmdptr = 0;
    453  1.2  macallan 	sc->sc_bufptr = 0;
    454  1.2  macallan 	sc->sc_rds = 0;
    455  1.2  macallan 	sc->sc_abort = 0;
    456  1.2  macallan 
    457  1.2  macallan 	jziic_set_speed(sc);
    458  1.2  macallan 	jziic_wait(sc);
    459  1.2  macallan 
    460  1.2  macallan 	/* set FIFO levels */
    461  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBTXTL, 4);
    462  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBRXTL, 0
    463  1.2  macallan 	    /*min(7, max(0, buflen - 2 ))*/);
    464  1.2  macallan 
    465  1.2  macallan 	/* try to talk... */
    466  1.2  macallan 
    467  1.2  macallan 	if (!jziic_enable(sc)) {
    468  1.2  macallan 		ret = -1;
    469  1.2  macallan 		goto bork;
    470  1.2  macallan 	}
    471  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    472  1.2  macallan 
    473  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBTAR, addr);
    474  1.2  macallan 	jziic_wait(sc);
    475  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCINT, JZ_CLEARALL);
    476  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM,
    477  1.2  macallan 	    JZ_TXABT | JZ_TXEMP);
    478  1.2  macallan 
    479  1.2  macallan 	bail = 100 * sc->sc_cmdlen;
    480  1.2  macallan 	while ((sc->sc_cmdptr < sc->sc_cmdlen) && (bail > 0)) {
    481  1.2  macallan 		cv_timedwait(&sc->sc_ping, &sc->sc_cvlock, 1);
    482  1.2  macallan 		if (sc->sc_abort) {
    483  1.2  macallan 			/* we received an abort interrupt -> bailout */
    484  1.2  macallan 		    	DPRINTF("abort: %x\n", sc->sc_abort);
    485  1.2  macallan 		    	ret = -1;
    486  1.2  macallan 		    	goto bork;
    487  1.2  macallan 		}
    488  1.2  macallan 	    	bail--;
    489  1.2  macallan 	}
    490  1.2  macallan 
    491  1.2  macallan 	if (sc->sc_cmdptr < sc->sc_cmdlen) {
    492  1.2  macallan 		/* we didn't send everything? */
    493  1.2  macallan 	    	DPRINTF("sent %d of %d\n", sc->sc_cmdptr, sc->sc_cmdlen);
    494  1.2  macallan 	    	ret = -1;
    495  1.2  macallan 	    	goto bork;
    496  1.2  macallan 	}
    497  1.2  macallan 
    498  1.2  macallan 	if (I2C_OP_READ_P(op)) {
    499  1.2  macallan 		/* now read */
    500  1.2  macallan 		sc->sc_reading = TRUE;
    501  1.2  macallan 		bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM,
    502  1.2  macallan 		    JZ_TXABT | JZ_RXFL | JZ_TXEMP);
    503  1.2  macallan 
    504  1.5  riastrad 		for (i = 0; i < uimin((buflen + 1), 4); i++) {
    505  1.2  macallan 			bus_space_write_4(sc->sc_memt, sc->sc_memh,
    506  1.2  macallan 			    JZ_SMBDC, JZ_CMD);
    507  1.2  macallan 			wbflush();
    508  1.2  macallan 		}
    509  1.2  macallan 		sc->sc_rds = i;
    510  1.2  macallan 
    511  1.2  macallan 		bail = 10 * sc->sc_buflen; /* 10 ticks per byte should be ok */
    512  1.2  macallan 		while ((sc->sc_bufptr < sc->sc_buflen) && (bail > 0)) {
    513  1.4     skrll 			cv_timedwait(&sc->sc_ping, &sc->sc_cvlock, 1);
    514  1.2  macallan 			if (sc->sc_abort) {
    515  1.2  macallan 				/* we received an abort interrupt -> bailout */
    516  1.2  macallan 		  	  	DPRINTF("rx abort: %x\n", sc->sc_abort);
    517  1.2  macallan 			    	ret = -1;
    518  1.2  macallan 			    	goto bork;
    519  1.2  macallan 			}
    520  1.2  macallan 			bail--;
    521  1.2  macallan 		}
    522  1.2  macallan 
    523  1.2  macallan 		if (sc->sc_bufptr < sc->sc_buflen) {
    524  1.2  macallan 			/* we didn't get everything? */
    525  1.2  macallan 		    	DPRINTF("rcvd %d of %d\n", sc->sc_bufptr, sc->sc_buflen);
    526  1.2  macallan 		    	ret = -1;
    527  1.2  macallan 		    	goto bork;
    528  1.2  macallan 		}
    529  1.2  macallan 	}
    530  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCON,
    531  1.2  macallan 	    JZ_SLVDIS | JZ_REST | JZ_SPD_100KB | JZ_MD);
    532  1.2  macallan bork:
    533  1.2  macallan 	bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    534  1.2  macallan 	jziic_disable(sc);
    535  1.2  macallan 	mutex_exit(&sc->sc_cvlock);
    536  1.2  macallan 	return ret;
    537  1.2  macallan }
    538  1.2  macallan 
    539  1.2  macallan STATIC int
    540  1.2  macallan jziic_intr(void *cookie)
    541  1.2  macallan {
    542  1.2  macallan 	struct jziic_softc *sc = cookie;
    543  1.2  macallan 	uint32_t stat, data, rstat;
    544  1.2  macallan 	int i;
    545  1.2  macallan 
    546  1.2  macallan 	stat = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTST);
    547  1.2  macallan 	if (stat & JZ_TXEMP) {
    548  1.2  macallan 		if (sc->sc_reading) {
    549  1.2  macallan 			if (sc->sc_rds < (sc->sc_buflen + 1)) {
    550  1.2  macallan 				for (i = 0;
    551  1.5  riastrad 				     i < uimin(4, (sc->sc_buflen + 1) -
    552  1.2  macallan 				                 sc->sc_rds);
    553  1.2  macallan 				     i++) {
    554  1.2  macallan 					bus_space_write_4( sc->sc_memt,
    555  1.2  macallan 					    sc->sc_memh,
    556  1.2  macallan 					    JZ_SMBDC, JZ_CMD);
    557  1.2  macallan 					wbflush();
    558  1.2  macallan 				}
    559  1.2  macallan 				sc->sc_rds += i;
    560  1.2  macallan 			} else {
    561  1.2  macallan 				/* we're done, so turn TX FIFO interrupt off */
    562  1.2  macallan 				bus_space_write_4(sc->sc_memt, sc->sc_memh,
    563  1.2  macallan 				    JZ_SMBINTM,
    564  1.2  macallan 				    JZ_TXABT | JZ_RXFL);
    565  1.2  macallan 			}
    566  1.4     skrll 		} else {
    567  1.2  macallan 			rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    568  1.2  macallan 			    JZ_SMBST);
    569  1.4     skrll 			while ((rstat & JZ_TFNF) &&
    570  1.2  macallan 			         (sc->sc_cmdptr < sc->sc_cmdlen)) {
    571  1.2  macallan 				data = *sc->sc_cmd;
    572  1.2  macallan 				sc->sc_cmd++;
    573  1.2  macallan 				sc->sc_cmdptr++;
    574  1.2  macallan 				bus_space_write_4(sc->sc_memt, sc->sc_memh,
    575  1.2  macallan 				    JZ_SMBDC, data & 0xff);
    576  1.2  macallan 				rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    577  1.2  macallan 				    JZ_SMBST);
    578  1.2  macallan 			};
    579  1.2  macallan 			/* no need to clear this one */
    580  1.2  macallan 			if (sc->sc_cmdptr >= sc->sc_cmdlen) {
    581  1.2  macallan 				cv_signal(&sc->sc_ping);
    582  1.2  macallan 				bus_space_write_4(sc->sc_memt, sc->sc_memh,
    583  1.2  macallan 				    JZ_SMBINTM, JZ_TXABT);
    584  1.2  macallan 			}
    585  1.4     skrll 		}
    586  1.2  macallan 	}
    587  1.2  macallan 	if (stat & JZ_RXFL) {
    588  1.2  macallan 		rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh, JZ_SMBST);
    589  1.2  macallan 		while ((rstat & JZ_RFNE) && (sc->sc_bufptr < sc->sc_buflen)) {
    590  1.2  macallan 			data = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    591  1.2  macallan 			   JZ_SMBDC);
    592  1.2  macallan 			*sc->sc_buf = (uint8_t)(data & 0xff);
    593  1.2  macallan 			sc->sc_buf++;
    594  1.2  macallan 			sc->sc_bufptr++;
    595  1.2  macallan 			rstat = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    596  1.2  macallan 			    JZ_SMBST);
    597  1.2  macallan 		}
    598  1.2  macallan 		if (sc->sc_bufptr >= sc->sc_buflen)
    599  1.2  macallan 			cv_signal(&sc->sc_ping);
    600  1.2  macallan 	}
    601  1.2  macallan 	if (stat & JZ_TXABT) {
    602  1.2  macallan 		sc->sc_abort = bus_space_read_4(sc->sc_memt, sc->sc_memh,
    603  1.2  macallan 		    JZ_SMBABTSRC);
    604  1.2  macallan 		cv_signal(&sc->sc_ping);
    605  1.2  macallan 		bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBCINT,
    606  1.2  macallan 		    JZ_CLEARALL);
    607  1.2  macallan 		bus_space_write_4(sc->sc_memt, sc->sc_memh, JZ_SMBINTM, 0);
    608  1.2  macallan 	}
    609  1.2  macallan 	return 0;
    610  1.2  macallan }
    611