Home | History | Annotate | Line # | Download | only in sunxi
sunxi_rsb.c revision 1.11
      1  1.11   thorpej /* $NetBSD: sunxi_rsb.c,v 1.11 2021/01/18 02:35:49 thorpej Exp $ */
      2   1.1  jmcneill 
      3   1.1  jmcneill /*-
      4   1.1  jmcneill  * Copyright (c) 2014-2017 Jared McNeill <jmcneill (at) invisible.ca>
      5   1.1  jmcneill  * All rights reserved.
      6   1.1  jmcneill  *
      7   1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8   1.1  jmcneill  * modification, are permitted provided that the following conditions
      9   1.1  jmcneill  * are met:
     10   1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12   1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15   1.1  jmcneill  *
     16   1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17   1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18   1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19   1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20   1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21   1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22   1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23   1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24   1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25   1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26   1.1  jmcneill  * SUCH DAMAGE.
     27   1.1  jmcneill  */
     28   1.1  jmcneill 
     29   1.1  jmcneill #include <sys/cdefs.h>
     30  1.11   thorpej __KERNEL_RCSID(0, "$NetBSD: sunxi_rsb.c,v 1.11 2021/01/18 02:35:49 thorpej Exp $");
     31   1.1  jmcneill 
     32   1.1  jmcneill #include <sys/param.h>
     33   1.1  jmcneill #include <sys/bus.h>
     34   1.1  jmcneill #include <sys/device.h>
     35   1.1  jmcneill #include <sys/intr.h>
     36   1.1  jmcneill #include <sys/systm.h>
     37   1.1  jmcneill #include <sys/kernel.h>
     38   1.1  jmcneill #include <sys/mutex.h>
     39   1.1  jmcneill #include <sys/condvar.h>
     40   1.1  jmcneill 
     41   1.1  jmcneill #include <dev/i2c/i2cvar.h>
     42   1.1  jmcneill 
     43   1.1  jmcneill #include <dev/fdt/fdtvar.h>
     44   1.1  jmcneill 
     45   1.1  jmcneill #include <arm/sunxi/sunxi_rsb.h>
     46   1.1  jmcneill 
     47   1.1  jmcneill enum sunxi_rsb_type {
     48   1.1  jmcneill 	SUNXI_P2WI,
     49   1.1  jmcneill 	SUNXI_RSB,
     50   1.1  jmcneill };
     51   1.1  jmcneill 
     52  1.11   thorpej static const struct device_compatible_entry compat_data[] = {
     53  1.11   thorpej 	{ .compat = "allwinner,sun6i-a31-p2wi",	.value = SUNXI_P2WI },
     54  1.11   thorpej 	{ .compat = "allwinner,sun8i-a23-rsb",	.value = SUNXI_RSB },
     55  1.11   thorpej 
     56  1.11   thorpej 	{ 0 }
     57   1.1  jmcneill };
     58   1.1  jmcneill 
     59   1.1  jmcneill #define RSB_ADDR_PMIC_PRIMARY	0x3a3
     60   1.1  jmcneill #define RSB_ADDR_PMIC_SECONDARY	0x745
     61   1.1  jmcneill #define RSB_ADDR_PERIPH_IC	0xe89
     62   1.1  jmcneill 
     63   1.1  jmcneill /*
     64   1.1  jmcneill  * Device address to Run-time address mappings.
     65   1.1  jmcneill  *
     66   1.1  jmcneill  * Run-time address (RTA) is an 8-bit value used to address the device during
     67   1.1  jmcneill  * a read or write transaction. The following are valid RTAs:
     68   1.1  jmcneill  *  0x17 0x2d 0x3a 0x4e 0x59 0x63 0x74 0x8b 0x9c 0xa6 0xb1 0xc5 0xd2 0xe8 0xff
     69   1.1  jmcneill  *
     70   1.1  jmcneill  * Allwinner uses RTA 0x2d for the primary PMIC, 0x3a for the secondary PMIC,
     71   1.1  jmcneill  * and 0x4e for the peripheral IC (where applicable).
     72   1.1  jmcneill  */
     73   1.1  jmcneill static const struct {
     74   1.1  jmcneill 	uint16_t        addr;
     75   1.1  jmcneill 	uint8_t         rta;
     76   1.1  jmcneill } rsb_rtamap[] = {
     77   1.1  jmcneill 	{ .addr = RSB_ADDR_PMIC_PRIMARY,	.rta = 0x2d },
     78   1.1  jmcneill 	{ .addr = RSB_ADDR_PMIC_SECONDARY,	.rta = 0x3a },
     79   1.1  jmcneill 	{ .addr = RSB_ADDR_PERIPH_IC,		.rta = 0x4e },
     80   1.1  jmcneill 	{ .addr = 0,				.rta = 0 }
     81   1.1  jmcneill };
     82   1.1  jmcneill 
     83   1.1  jmcneill struct sunxi_rsb_softc {
     84   1.1  jmcneill 	device_t sc_dev;
     85   1.1  jmcneill 	bus_space_tag_t sc_bst;
     86   1.1  jmcneill 	bus_space_handle_t sc_bsh;
     87   1.1  jmcneill 	enum sunxi_rsb_type sc_type;
     88   1.1  jmcneill 	struct i2c_controller sc_ic;
     89   1.8   thorpej 	kmutex_t sc_intr_lock;
     90   1.8   thorpej 	kcondvar_t sc_intr_wait;
     91   1.1  jmcneill 	device_t sc_i2cdev;
     92   1.1  jmcneill 	void *sc_ih;
     93   1.1  jmcneill 	uint32_t sc_stat;
     94   1.6  jmcneill 	bool sc_busy;
     95   1.1  jmcneill 
     96   1.1  jmcneill 	uint16_t sc_rsb_last_da;
     97   1.1  jmcneill };
     98   1.1  jmcneill 
     99   1.1  jmcneill #define RSB_READ(sc, reg) \
    100   1.1  jmcneill     bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
    101   1.1  jmcneill #define RSB_WRITE(sc, reg, val) \
    102   1.1  jmcneill     bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    103   1.1  jmcneill 
    104   1.1  jmcneill static int	sunxi_rsb_exec(void *, i2c_op_t, i2c_addr_t, const void *,
    105   1.1  jmcneill 			       size_t, void *, size_t, int);
    106   1.1  jmcneill 
    107   1.1  jmcneill static int	sunxi_rsb_intr(void *);
    108   1.1  jmcneill static int	sunxi_rsb_wait(struct sunxi_rsb_softc *, int);
    109   1.1  jmcneill static int	sunxi_rsb_rsb_config(struct sunxi_rsb_softc *,
    110   1.1  jmcneill 				     uint8_t, i2c_addr_t, int);
    111   1.1  jmcneill 
    112   1.1  jmcneill static int	sunxi_rsb_match(device_t, cfdata_t, void *);
    113   1.1  jmcneill static void	sunxi_rsb_attach(device_t, device_t, void *);
    114   1.1  jmcneill 
    115   1.1  jmcneill CFATTACH_DECL_NEW(sunxi_rsb, sizeof(struct sunxi_rsb_softc),
    116   1.1  jmcneill 	sunxi_rsb_match, sunxi_rsb_attach, NULL, NULL);
    117   1.1  jmcneill 
    118   1.1  jmcneill static int
    119   1.1  jmcneill sunxi_rsb_match(device_t parent, cfdata_t cf, void *aux)
    120   1.1  jmcneill {
    121   1.1  jmcneill 	struct fdt_attach_args * const faa = aux;
    122   1.1  jmcneill 
    123   1.1  jmcneill 	return of_match_compat_data(faa->faa_phandle, compat_data);
    124   1.1  jmcneill }
    125   1.1  jmcneill 
    126   1.1  jmcneill static void
    127   1.1  jmcneill sunxi_rsb_attach(device_t parent, device_t self, void *aux)
    128   1.1  jmcneill {
    129   1.1  jmcneill 	struct sunxi_rsb_softc * const sc = device_private(self);
    130   1.1  jmcneill 	struct fdt_attach_args * const faa = aux;
    131   1.1  jmcneill 	const int phandle = faa->faa_phandle;
    132   1.1  jmcneill 	struct fdtbus_reset *rst;
    133   1.1  jmcneill 	struct clk *clk;
    134   1.1  jmcneill 	char intrstr[128];
    135   1.1  jmcneill 	bus_addr_t addr;
    136   1.1  jmcneill 	bus_size_t size;
    137   1.1  jmcneill 
    138   1.1  jmcneill 	if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
    139   1.1  jmcneill 		aprint_error(": couldn't get registers\n");
    140   1.1  jmcneill 		return;
    141   1.1  jmcneill 	}
    142   1.1  jmcneill 
    143   1.1  jmcneill 	if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
    144   1.1  jmcneill 		aprint_error(": couldn't decode interrupt\n");
    145   1.1  jmcneill 		return;
    146   1.1  jmcneill 	}
    147   1.1  jmcneill 
    148   1.1  jmcneill 	if ((clk = fdtbus_clock_get_index(phandle, 0)) != NULL)
    149   1.1  jmcneill 		if (clk_enable(clk) != 0) {
    150   1.1  jmcneill 			aprint_error(": couldn't enable clock\n");
    151   1.1  jmcneill 			return;
    152   1.1  jmcneill 		}
    153   1.1  jmcneill 	if ((rst = fdtbus_reset_get_index(phandle, 0)) != NULL)
    154   1.1  jmcneill 		if (fdtbus_reset_deassert(rst) != 0) {
    155   1.1  jmcneill 			aprint_error(": couldn't de-assert reset\n");
    156   1.1  jmcneill 			return;
    157   1.1  jmcneill 		}
    158   1.1  jmcneill 
    159   1.1  jmcneill 	sc->sc_dev = self;
    160  1.11   thorpej 	sc->sc_type = of_search_compatible(phandle, compat_data)->value;
    161   1.1  jmcneill 	sc->sc_bst = faa->faa_bst;
    162   1.1  jmcneill 	if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) {
    163   1.1  jmcneill 		aprint_error(": couldn't map registers\n");
    164   1.1  jmcneill 		return;
    165   1.1  jmcneill 	}
    166   1.1  jmcneill 
    167   1.8   thorpej 	mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED);
    168   1.8   thorpej 	cv_init(&sc->sc_intr_wait, "sunxirsb");
    169   1.1  jmcneill 
    170   1.1  jmcneill 	aprint_naive("\n");
    171   1.1  jmcneill 	aprint_normal(": %s\n", sc->sc_type == SUNXI_P2WI ? "P2WI" : "RSB");
    172   1.1  jmcneill 
    173  1.10  jmcneill 	sc->sc_ih = fdtbus_intr_establish_xname(phandle, 0, IPL_VM, 0,
    174  1.10  jmcneill 	    sunxi_rsb_intr, sc, device_xname(self));
    175   1.1  jmcneill 	if (sc->sc_ih == NULL) {
    176   1.1  jmcneill 		aprint_error_dev(self, "couldn't establish interrupt on %s\n",
    177   1.1  jmcneill 		    intrstr);
    178   1.1  jmcneill 		return;
    179   1.1  jmcneill 	}
    180   1.1  jmcneill 	aprint_normal_dev(self, "interrupting on %s\n", intrstr);
    181   1.1  jmcneill 
    182   1.8   thorpej 	iic_tag_init(&sc->sc_ic);
    183   1.1  jmcneill 	sc->sc_ic.ic_cookie = sc;
    184   1.1  jmcneill 	sc->sc_ic.ic_exec = sunxi_rsb_exec;
    185   1.1  jmcneill 
    186   1.9   thorpej 	fdtbus_register_i2c_controller(&sc->sc_ic, phandle);
    187   1.1  jmcneill 
    188   1.3  jmcneill 	fdtbus_attach_i2cbus(self, phandle, &sc->sc_ic, iicbus_print);
    189   1.1  jmcneill }
    190   1.1  jmcneill 
    191   1.1  jmcneill static int
    192   1.1  jmcneill sunxi_rsb_intr(void *priv)
    193   1.1  jmcneill {
    194   1.1  jmcneill 	struct sunxi_rsb_softc *sc = priv;
    195   1.1  jmcneill 	uint32_t stat;
    196   1.1  jmcneill 
    197   1.1  jmcneill 	stat = RSB_READ(sc, RSB_STAT_REG);
    198   1.1  jmcneill 	if ((stat & RSB_STAT_MASK) == 0)
    199   1.1  jmcneill 		return 0;
    200   1.1  jmcneill 
    201   1.1  jmcneill 	RSB_WRITE(sc, RSB_STAT_REG, stat & RSB_STAT_MASK);
    202   1.1  jmcneill 
    203   1.8   thorpej 	mutex_enter(&sc->sc_intr_lock);
    204   1.1  jmcneill 	sc->sc_stat |= stat;
    205   1.8   thorpej 	cv_broadcast(&sc->sc_intr_wait);
    206   1.8   thorpej 	mutex_exit(&sc->sc_intr_lock);
    207   1.1  jmcneill 
    208   1.1  jmcneill 	return 1;
    209   1.1  jmcneill }
    210   1.1  jmcneill 
    211   1.1  jmcneill static int
    212   1.4  jmcneill sunxi_rsb_soft_reset(struct sunxi_rsb_softc *sc)
    213   1.4  jmcneill {
    214   1.4  jmcneill 	int retry = 1000;
    215   1.4  jmcneill 
    216   1.4  jmcneill 	RSB_WRITE(sc, RSB_CTRL_REG, RSB_CTRL_SOFT_RESET);
    217   1.4  jmcneill 	while (--retry > 0) {
    218   1.4  jmcneill 		if ((RSB_READ(sc, RSB_CTRL_REG) & RSB_CTRL_SOFT_RESET) == 0)
    219   1.4  jmcneill 			break;
    220   1.4  jmcneill 		delay(10);
    221   1.4  jmcneill 	}
    222   1.4  jmcneill 	if (retry == 0)
    223   1.4  jmcneill 		return EIO;
    224   1.4  jmcneill 
    225   1.4  jmcneill 	return 0;
    226   1.4  jmcneill }
    227   1.4  jmcneill 
    228   1.4  jmcneill static int
    229   1.1  jmcneill sunxi_rsb_wait(struct sunxi_rsb_softc *sc, int flags)
    230   1.1  jmcneill {
    231   1.1  jmcneill 	int error = 0, retry;
    232   1.1  jmcneill 
    233   1.1  jmcneill 	/* Wait up to 5 seconds for a transfer to complete */
    234   1.1  jmcneill 	sc->sc_stat = 0;
    235   1.1  jmcneill 	for (retry = (flags & I2C_F_POLL) ? 100 : 5; retry > 0; retry--) {
    236   1.1  jmcneill 		if (flags & I2C_F_POLL) {
    237   1.1  jmcneill 			sc->sc_stat |= RSB_READ(sc, RSB_STAT_REG);
    238   1.1  jmcneill 		} else {
    239   1.8   thorpej 			error = cv_timedwait(&sc->sc_intr_wait,
    240   1.8   thorpej 					     &sc->sc_intr_lock, hz);
    241   1.1  jmcneill 			if (error && error != EWOULDBLOCK) {
    242   1.1  jmcneill 				break;
    243   1.1  jmcneill 			}
    244   1.1  jmcneill 		}
    245   1.1  jmcneill 		if (sc->sc_stat & RSB_STAT_MASK) {
    246   1.1  jmcneill 			break;
    247   1.1  jmcneill 		}
    248   1.1  jmcneill 		if (flags & I2C_F_POLL) {
    249   1.1  jmcneill 			delay(10000);
    250   1.1  jmcneill 		}
    251   1.1  jmcneill 	}
    252   1.1  jmcneill 	if (retry == 0)
    253   1.1  jmcneill 		error = EAGAIN;
    254   1.1  jmcneill 
    255   1.1  jmcneill 	if (flags & I2C_F_POLL) {
    256   1.1  jmcneill 		RSB_WRITE(sc, RSB_STAT_REG,
    257   1.1  jmcneill 		    sc->sc_stat & RSB_STAT_MASK);
    258   1.1  jmcneill 	}
    259   1.1  jmcneill 
    260   1.1  jmcneill 	if (error) {
    261   1.1  jmcneill 		/* Abort transaction */
    262   1.1  jmcneill 		device_printf(sc->sc_dev, "transfer timeout, error = %d\n",
    263   1.1  jmcneill 		    error);
    264   1.1  jmcneill 		RSB_WRITE(sc, RSB_CTRL_REG,
    265   1.1  jmcneill 		    RSB_CTRL_ABORT_TRANS);
    266   1.1  jmcneill 		return error;
    267   1.1  jmcneill 	}
    268   1.1  jmcneill 
    269   1.1  jmcneill 	if (sc->sc_stat & RSB_STAT_LOAD_BSY) {
    270   1.1  jmcneill 		device_printf(sc->sc_dev, "transfer busy\n");
    271   1.1  jmcneill 		return EBUSY;
    272   1.1  jmcneill 	}
    273   1.1  jmcneill 	if (sc->sc_stat & RSB_STAT_TRANS_ERR) {
    274   1.5  christos 		device_printf(sc->sc_dev, "transfer error, id 0x%02" PRIx64
    275   1.5  christos 		    "\n", __SHIFTOUT(sc->sc_stat, RSB_STAT_TRANS_ERR_ID));
    276   1.1  jmcneill 		return EIO;
    277   1.1  jmcneill 	}
    278   1.1  jmcneill 
    279   1.1  jmcneill 	return 0;
    280   1.1  jmcneill }
    281   1.1  jmcneill 
    282   1.1  jmcneill static int
    283   1.1  jmcneill sunxi_rsb_rsb_config(struct sunxi_rsb_softc *sc, uint8_t rta, i2c_addr_t da,
    284   1.1  jmcneill     int flags)
    285   1.1  jmcneill {
    286   1.1  jmcneill 	uint32_t dar, ctrl;
    287   1.1  jmcneill 
    288   1.8   thorpej 	KASSERT(mutex_owned(&sc->sc_intr_lock));
    289   1.1  jmcneill 
    290   1.1  jmcneill 	RSB_WRITE(sc, RSB_STAT_REG,
    291   1.1  jmcneill 	    RSB_READ(sc, RSB_STAT_REG) & RSB_STAT_MASK);
    292   1.1  jmcneill 
    293   1.1  jmcneill 	dar = __SHIFTIN(rta, RSB_DAR_RTA);
    294   1.1  jmcneill 	dar |= __SHIFTIN(da, RSB_DAR_DA);
    295   1.1  jmcneill 	RSB_WRITE(sc, RSB_DAR_REG, dar);
    296   1.1  jmcneill 	RSB_WRITE(sc, RSB_CMD_REG, RSB_CMD_IDX_SRTA);
    297   1.1  jmcneill 
    298   1.1  jmcneill 	/* Make sure the controller is idle */
    299   1.1  jmcneill 	ctrl = RSB_READ(sc, RSB_CTRL_REG);
    300   1.1  jmcneill 	if (ctrl & RSB_CTRL_START_TRANS) {
    301   1.1  jmcneill 		device_printf(sc->sc_dev, "device is busy\n");
    302   1.1  jmcneill 		return EBUSY;
    303   1.1  jmcneill 	}
    304   1.1  jmcneill 
    305   1.1  jmcneill 	/* Start the transfer */
    306   1.1  jmcneill 	RSB_WRITE(sc, RSB_CTRL_REG,
    307   1.1  jmcneill 	    ctrl | RSB_CTRL_START_TRANS);
    308   1.1  jmcneill 
    309   1.1  jmcneill 	return sunxi_rsb_wait(sc, flags);
    310   1.1  jmcneill }
    311   1.1  jmcneill 
    312   1.1  jmcneill static int
    313   1.1  jmcneill sunxi_rsb_exec(void *priv, i2c_op_t op, i2c_addr_t addr,
    314   1.1  jmcneill     const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
    315   1.1  jmcneill {
    316   1.1  jmcneill 	struct sunxi_rsb_softc *sc = priv;
    317   1.1  jmcneill 	uint32_t dlen, ctrl;
    318   1.1  jmcneill 	uint8_t rta;
    319   1.1  jmcneill 	int error, i;
    320   1.1  jmcneill 
    321   1.1  jmcneill 	if (cmdlen != 1 || (len != 1 && len != 2 && len != 4))
    322   1.1  jmcneill 		return EINVAL;
    323   1.1  jmcneill 
    324   1.8   thorpej 	mutex_enter(&sc->sc_intr_lock);
    325   1.8   thorpej 
    326   1.4  jmcneill 	error = sunxi_rsb_soft_reset(sc);
    327   1.4  jmcneill 	if (error != 0) {
    328   1.8   thorpej 		mutex_exit(&sc->sc_intr_lock);
    329   1.4  jmcneill 		device_printf(sc->sc_dev, "soft reset timed out\n");
    330   1.4  jmcneill 		return error;
    331   1.4  jmcneill 	}
    332   1.4  jmcneill 
    333   1.4  jmcneill 	if ((flags & I2C_F_POLL) == 0) {
    334   1.4  jmcneill 		/* Enable interrupts */
    335   1.4  jmcneill 		RSB_WRITE(sc, RSB_INTE_REG,
    336   1.4  jmcneill 		    RSB_INTE_LOAD_BSY_ENB |
    337   1.4  jmcneill 		    RSB_INTE_TRANS_ERR_ENB |
    338   1.4  jmcneill 		    RSB_INTE_TRANS_OVER_ENB);
    339   1.4  jmcneill 		RSB_WRITE(sc, RSB_CTRL_REG,
    340   1.4  jmcneill 		    RSB_CTRL_GLOBAL_INT_ENB);
    341   1.4  jmcneill 	}
    342   1.4  jmcneill 
    343   1.1  jmcneill 	if (sc->sc_type == SUNXI_RSB && sc->sc_rsb_last_da != addr) {
    344   1.1  jmcneill 		/* Lookup run-time address for given device address */
    345   1.1  jmcneill 		for (rta = 0, i = 0; rsb_rtamap[i].rta != 0; i++)
    346   1.1  jmcneill 			if (rsb_rtamap[i].addr == addr) {
    347   1.1  jmcneill 				rta = rsb_rtamap[i].rta;
    348   1.1  jmcneill 				break;
    349   1.1  jmcneill 			}
    350   1.1  jmcneill 		if (rta == 0) {
    351   1.8   thorpej 			mutex_exit(&sc->sc_intr_lock);
    352   1.1  jmcneill 			device_printf(sc->sc_dev,
    353   1.1  jmcneill 			    "RTA not known for address %#x\n", addr);
    354   1.1  jmcneill 			return ENXIO;
    355   1.1  jmcneill 		}
    356   1.1  jmcneill 		error = sunxi_rsb_rsb_config(sc, rta, addr, flags);
    357   1.1  jmcneill 		if (error) {
    358   1.1  jmcneill 			device_printf(sc->sc_dev,
    359   1.1  jmcneill 			    "SRTA failed, flags = %x, error = %d\n",
    360   1.1  jmcneill 			    flags, error);
    361   1.1  jmcneill 			sc->sc_rsb_last_da = 0;
    362   1.4  jmcneill 			goto done;
    363   1.1  jmcneill 		}
    364   1.1  jmcneill 
    365   1.1  jmcneill 		sc->sc_rsb_last_da = addr;
    366   1.1  jmcneill 	}
    367   1.1  jmcneill 
    368   1.1  jmcneill 	/* Data byte register */
    369   1.1  jmcneill 	RSB_WRITE(sc, RSB_DADDR0_REG, *(const uint8_t *)cmdbuf);
    370   1.1  jmcneill 
    371   1.1  jmcneill 	if (I2C_OP_WRITE_P(op)) {
    372   1.1  jmcneill 		uint8_t *pbuf = buf;
    373   1.1  jmcneill 		uint32_t data;
    374   1.1  jmcneill 		/* Write data */
    375   1.1  jmcneill 		switch (len) {
    376   1.1  jmcneill 		case 1:
    377   1.1  jmcneill 			data = pbuf[0];
    378   1.1  jmcneill 			break;
    379   1.1  jmcneill 		case 2:
    380   1.1  jmcneill 			data = pbuf[0] | (pbuf[1] << 8);
    381   1.1  jmcneill 			break;
    382   1.1  jmcneill 		case 4:
    383   1.1  jmcneill 			data = pbuf[0] | (pbuf[1] << 8) |
    384   1.1  jmcneill 			    (pbuf[2] << 16) | (pbuf[3] << 24);
    385   1.1  jmcneill 			break;
    386   1.1  jmcneill 		default:
    387   1.4  jmcneill 			error = EINVAL;
    388   1.4  jmcneill 			goto done;
    389   1.1  jmcneill 		}
    390   1.1  jmcneill 		RSB_WRITE(sc, RSB_DATA0_REG, data);
    391   1.1  jmcneill 	}
    392   1.1  jmcneill 
    393   1.1  jmcneill 	if (sc->sc_type == SUNXI_RSB) {
    394   1.1  jmcneill 		uint8_t cmd;
    395   1.1  jmcneill 		if (I2C_OP_WRITE_P(op)) {
    396   1.1  jmcneill 			switch (len) {
    397   1.1  jmcneill 			case 1:	cmd = RSB_CMD_IDX_WR8; break;
    398   1.1  jmcneill 			case 2: cmd = RSB_CMD_IDX_WR16; break;
    399   1.1  jmcneill 			case 4: cmd = RSB_CMD_IDX_WR32; break;
    400   1.4  jmcneill 			default: error = EINVAL; goto done;
    401   1.1  jmcneill 			}
    402   1.1  jmcneill 		} else {
    403   1.1  jmcneill 			switch (len) {
    404   1.1  jmcneill 			case 1:	cmd = RSB_CMD_IDX_RD8; break;
    405   1.1  jmcneill 			case 2: cmd = RSB_CMD_IDX_RD16; break;
    406   1.1  jmcneill 			case 4: cmd = RSB_CMD_IDX_RD32; break;
    407   1.4  jmcneill 			default: error = EINVAL; goto done;
    408   1.1  jmcneill 			}
    409   1.1  jmcneill 		}
    410   1.1  jmcneill 		RSB_WRITE(sc, RSB_CMD_REG, cmd);
    411   1.1  jmcneill 	}
    412   1.1  jmcneill 
    413   1.1  jmcneill 	/* Program data length register; if reading, set read/write bit */
    414   1.1  jmcneill 	dlen = __SHIFTIN(len - 1, RSB_DLEN_ACCESS_LENGTH);
    415   1.1  jmcneill 	if (I2C_OP_READ_P(op)) {
    416   1.1  jmcneill 		dlen |= RSB_DLEN_READ_WRITE_FLAG;
    417   1.1  jmcneill 	}
    418   1.1  jmcneill 	RSB_WRITE(sc, RSB_DLEN_REG, dlen);
    419   1.1  jmcneill 
    420   1.1  jmcneill 	/* Make sure the controller is idle */
    421   1.1  jmcneill 	ctrl = RSB_READ(sc, RSB_CTRL_REG);
    422   1.1  jmcneill 	if (ctrl & RSB_CTRL_START_TRANS) {
    423   1.1  jmcneill 		device_printf(sc->sc_dev, "device is busy\n");
    424   1.4  jmcneill 		error = EBUSY;
    425   1.4  jmcneill 		goto done;
    426   1.1  jmcneill 	}
    427   1.1  jmcneill 
    428   1.1  jmcneill 	/* Start the transfer */
    429   1.1  jmcneill 	RSB_WRITE(sc, RSB_CTRL_REG,
    430   1.1  jmcneill 	    ctrl | RSB_CTRL_START_TRANS);
    431   1.1  jmcneill 
    432   1.1  jmcneill 	error = sunxi_rsb_wait(sc, flags);
    433   1.4  jmcneill 	if (error)
    434   1.4  jmcneill 		goto done;
    435   1.1  jmcneill 
    436   1.1  jmcneill 	if (I2C_OP_READ_P(op)) {
    437   1.1  jmcneill 		uint32_t data = RSB_READ(sc, RSB_DATA0_REG);
    438   1.1  jmcneill 		switch (len) {
    439   1.1  jmcneill 		case 4:
    440   1.1  jmcneill 			*(uint32_t *)buf = data;
    441   1.1  jmcneill 			break;
    442   1.1  jmcneill 		case 2:
    443   1.1  jmcneill 			*(uint16_t *)buf = data & 0xffff;
    444   1.1  jmcneill 			break;
    445   1.1  jmcneill 		case 1:
    446   1.1  jmcneill 			*(uint8_t *)buf = data & 0xff;
    447   1.1  jmcneill 			break;
    448   1.1  jmcneill 		default:
    449   1.4  jmcneill 			error = EINVAL;
    450   1.4  jmcneill 			goto done;
    451   1.1  jmcneill 		}
    452   1.1  jmcneill 	}
    453   1.1  jmcneill 
    454   1.4  jmcneill 	error = 0;
    455   1.4  jmcneill 
    456   1.4  jmcneill done:
    457   1.4  jmcneill 	RSB_WRITE(sc, RSB_CTRL_REG, 0);
    458   1.8   thorpej 	mutex_exit(&sc->sc_intr_lock);
    459   1.4  jmcneill 
    460   1.4  jmcneill 	return error;
    461   1.1  jmcneill }
    462