1 1.16 thorpej /* $NetBSD: sunxi_rsb.c,v 1.16 2025/09/16 11:55:17 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.16 thorpej __KERNEL_RCSID(0, "$NetBSD: sunxi_rsb.c,v 1.16 2025/09/16 11:55:17 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.13 thorpej DEVICE_COMPAT_EOL 56 1.1 jmcneill }; 57 1.1 jmcneill 58 1.1 jmcneill #define RSB_ADDR_PMIC_PRIMARY 0x3a3 59 1.1 jmcneill #define RSB_ADDR_PMIC_SECONDARY 0x745 60 1.1 jmcneill #define RSB_ADDR_PERIPH_IC 0xe89 61 1.1 jmcneill 62 1.1 jmcneill /* 63 1.1 jmcneill * Device address to Run-time address mappings. 64 1.1 jmcneill * 65 1.1 jmcneill * Run-time address (RTA) is an 8-bit value used to address the device during 66 1.1 jmcneill * a read or write transaction. The following are valid RTAs: 67 1.1 jmcneill * 0x17 0x2d 0x3a 0x4e 0x59 0x63 0x74 0x8b 0x9c 0xa6 0xb1 0xc5 0xd2 0xe8 0xff 68 1.1 jmcneill * 69 1.1 jmcneill * Allwinner uses RTA 0x2d for the primary PMIC, 0x3a for the secondary PMIC, 70 1.1 jmcneill * and 0x4e for the peripheral IC (where applicable). 71 1.1 jmcneill */ 72 1.1 jmcneill static const struct { 73 1.1 jmcneill uint16_t addr; 74 1.1 jmcneill uint8_t rta; 75 1.1 jmcneill } rsb_rtamap[] = { 76 1.1 jmcneill { .addr = RSB_ADDR_PMIC_PRIMARY, .rta = 0x2d }, 77 1.1 jmcneill { .addr = RSB_ADDR_PMIC_SECONDARY, .rta = 0x3a }, 78 1.1 jmcneill { .addr = RSB_ADDR_PERIPH_IC, .rta = 0x4e }, 79 1.1 jmcneill { .addr = 0, .rta = 0 } 80 1.1 jmcneill }; 81 1.1 jmcneill 82 1.1 jmcneill struct sunxi_rsb_softc { 83 1.1 jmcneill device_t sc_dev; 84 1.1 jmcneill bus_space_tag_t sc_bst; 85 1.1 jmcneill bus_space_handle_t sc_bsh; 86 1.1 jmcneill enum sunxi_rsb_type sc_type; 87 1.1 jmcneill struct i2c_controller sc_ic; 88 1.8 thorpej kmutex_t sc_intr_lock; 89 1.8 thorpej kcondvar_t sc_intr_wait; 90 1.1 jmcneill device_t sc_i2cdev; 91 1.1 jmcneill void *sc_ih; 92 1.1 jmcneill uint32_t sc_stat; 93 1.6 jmcneill bool sc_busy; 94 1.1 jmcneill 95 1.1 jmcneill uint16_t sc_rsb_last_da; 96 1.1 jmcneill }; 97 1.1 jmcneill 98 1.1 jmcneill #define RSB_READ(sc, reg) \ 99 1.1 jmcneill bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg)) 100 1.1 jmcneill #define RSB_WRITE(sc, reg, val) \ 101 1.1 jmcneill bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) 102 1.1 jmcneill 103 1.1 jmcneill static int sunxi_rsb_exec(void *, i2c_op_t, i2c_addr_t, const void *, 104 1.1 jmcneill size_t, void *, size_t, int); 105 1.1 jmcneill 106 1.1 jmcneill static int sunxi_rsb_intr(void *); 107 1.1 jmcneill static int sunxi_rsb_wait(struct sunxi_rsb_softc *, int); 108 1.1 jmcneill static int sunxi_rsb_rsb_config(struct sunxi_rsb_softc *, 109 1.1 jmcneill uint8_t, i2c_addr_t, int); 110 1.1 jmcneill 111 1.1 jmcneill static int sunxi_rsb_match(device_t, cfdata_t, void *); 112 1.1 jmcneill static void sunxi_rsb_attach(device_t, device_t, void *); 113 1.1 jmcneill 114 1.1 jmcneill CFATTACH_DECL_NEW(sunxi_rsb, sizeof(struct sunxi_rsb_softc), 115 1.1 jmcneill sunxi_rsb_match, sunxi_rsb_attach, NULL, NULL); 116 1.1 jmcneill 117 1.1 jmcneill static int 118 1.1 jmcneill sunxi_rsb_match(device_t parent, cfdata_t cf, void *aux) 119 1.1 jmcneill { 120 1.1 jmcneill struct fdt_attach_args * const faa = aux; 121 1.1 jmcneill 122 1.14 thorpej return of_compatible_match(faa->faa_phandle, compat_data); 123 1.1 jmcneill } 124 1.1 jmcneill 125 1.1 jmcneill static void 126 1.1 jmcneill sunxi_rsb_attach(device_t parent, device_t self, void *aux) 127 1.1 jmcneill { 128 1.1 jmcneill struct sunxi_rsb_softc * const sc = device_private(self); 129 1.1 jmcneill struct fdt_attach_args * const faa = aux; 130 1.1 jmcneill const int phandle = faa->faa_phandle; 131 1.1 jmcneill struct fdtbus_reset *rst; 132 1.1 jmcneill struct clk *clk; 133 1.1 jmcneill char intrstr[128]; 134 1.1 jmcneill bus_addr_t addr; 135 1.1 jmcneill bus_size_t size; 136 1.1 jmcneill 137 1.1 jmcneill if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) { 138 1.1 jmcneill aprint_error(": couldn't get registers\n"); 139 1.1 jmcneill return; 140 1.1 jmcneill } 141 1.1 jmcneill 142 1.1 jmcneill if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) { 143 1.1 jmcneill aprint_error(": couldn't decode interrupt\n"); 144 1.1 jmcneill return; 145 1.1 jmcneill } 146 1.1 jmcneill 147 1.1 jmcneill if ((clk = fdtbus_clock_get_index(phandle, 0)) != NULL) 148 1.1 jmcneill if (clk_enable(clk) != 0) { 149 1.1 jmcneill aprint_error(": couldn't enable clock\n"); 150 1.1 jmcneill return; 151 1.1 jmcneill } 152 1.1 jmcneill if ((rst = fdtbus_reset_get_index(phandle, 0)) != NULL) 153 1.1 jmcneill if (fdtbus_reset_deassert(rst) != 0) { 154 1.1 jmcneill aprint_error(": couldn't de-assert reset\n"); 155 1.1 jmcneill return; 156 1.1 jmcneill } 157 1.1 jmcneill 158 1.1 jmcneill sc->sc_dev = self; 159 1.14 thorpej sc->sc_type = of_compatible_lookup(phandle, compat_data)->value; 160 1.1 jmcneill sc->sc_bst = faa->faa_bst; 161 1.1 jmcneill if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) { 162 1.1 jmcneill aprint_error(": couldn't map registers\n"); 163 1.1 jmcneill return; 164 1.1 jmcneill } 165 1.1 jmcneill 166 1.8 thorpej mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED); 167 1.8 thorpej cv_init(&sc->sc_intr_wait, "sunxirsb"); 168 1.1 jmcneill 169 1.1 jmcneill aprint_naive("\n"); 170 1.1 jmcneill aprint_normal(": %s\n", sc->sc_type == SUNXI_P2WI ? "P2WI" : "RSB"); 171 1.1 jmcneill 172 1.10 jmcneill sc->sc_ih = fdtbus_intr_establish_xname(phandle, 0, IPL_VM, 0, 173 1.10 jmcneill sunxi_rsb_intr, sc, device_xname(self)); 174 1.1 jmcneill if (sc->sc_ih == NULL) { 175 1.1 jmcneill aprint_error_dev(self, "couldn't establish interrupt on %s\n", 176 1.1 jmcneill intrstr); 177 1.1 jmcneill return; 178 1.1 jmcneill } 179 1.1 jmcneill aprint_normal_dev(self, "interrupting on %s\n", intrstr); 180 1.1 jmcneill 181 1.8 thorpej iic_tag_init(&sc->sc_ic); 182 1.1 jmcneill sc->sc_ic.ic_cookie = sc; 183 1.1 jmcneill sc->sc_ic.ic_exec = sunxi_rsb_exec; 184 1.1 jmcneill 185 1.15 thorpej iicbus_attach(self, &sc->sc_ic); 186 1.1 jmcneill } 187 1.1 jmcneill 188 1.1 jmcneill static int 189 1.1 jmcneill sunxi_rsb_intr(void *priv) 190 1.1 jmcneill { 191 1.1 jmcneill struct sunxi_rsb_softc *sc = priv; 192 1.1 jmcneill uint32_t stat; 193 1.1 jmcneill 194 1.1 jmcneill stat = RSB_READ(sc, RSB_STAT_REG); 195 1.1 jmcneill if ((stat & RSB_STAT_MASK) == 0) 196 1.1 jmcneill return 0; 197 1.1 jmcneill 198 1.1 jmcneill RSB_WRITE(sc, RSB_STAT_REG, stat & RSB_STAT_MASK); 199 1.1 jmcneill 200 1.8 thorpej mutex_enter(&sc->sc_intr_lock); 201 1.1 jmcneill sc->sc_stat |= stat; 202 1.8 thorpej cv_broadcast(&sc->sc_intr_wait); 203 1.8 thorpej mutex_exit(&sc->sc_intr_lock); 204 1.1 jmcneill 205 1.1 jmcneill return 1; 206 1.1 jmcneill } 207 1.1 jmcneill 208 1.1 jmcneill static int 209 1.4 jmcneill sunxi_rsb_soft_reset(struct sunxi_rsb_softc *sc) 210 1.4 jmcneill { 211 1.4 jmcneill int retry = 1000; 212 1.4 jmcneill 213 1.4 jmcneill RSB_WRITE(sc, RSB_CTRL_REG, RSB_CTRL_SOFT_RESET); 214 1.4 jmcneill while (--retry > 0) { 215 1.4 jmcneill if ((RSB_READ(sc, RSB_CTRL_REG) & RSB_CTRL_SOFT_RESET) == 0) 216 1.4 jmcneill break; 217 1.4 jmcneill delay(10); 218 1.4 jmcneill } 219 1.4 jmcneill if (retry == 0) 220 1.4 jmcneill return EIO; 221 1.4 jmcneill 222 1.4 jmcneill return 0; 223 1.4 jmcneill } 224 1.4 jmcneill 225 1.4 jmcneill static int 226 1.1 jmcneill sunxi_rsb_wait(struct sunxi_rsb_softc *sc, int flags) 227 1.1 jmcneill { 228 1.1 jmcneill int error = 0, retry; 229 1.1 jmcneill 230 1.1 jmcneill /* Wait up to 5 seconds for a transfer to complete */ 231 1.1 jmcneill sc->sc_stat = 0; 232 1.1 jmcneill for (retry = (flags & I2C_F_POLL) ? 100 : 5; retry > 0; retry--) { 233 1.1 jmcneill if (flags & I2C_F_POLL) { 234 1.1 jmcneill sc->sc_stat |= RSB_READ(sc, RSB_STAT_REG); 235 1.1 jmcneill } else { 236 1.8 thorpej error = cv_timedwait(&sc->sc_intr_wait, 237 1.8 thorpej &sc->sc_intr_lock, hz); 238 1.1 jmcneill if (error && error != EWOULDBLOCK) { 239 1.1 jmcneill break; 240 1.1 jmcneill } 241 1.1 jmcneill } 242 1.1 jmcneill if (sc->sc_stat & RSB_STAT_MASK) { 243 1.1 jmcneill break; 244 1.1 jmcneill } 245 1.1 jmcneill if (flags & I2C_F_POLL) { 246 1.1 jmcneill delay(10000); 247 1.1 jmcneill } 248 1.1 jmcneill } 249 1.1 jmcneill if (retry == 0) 250 1.1 jmcneill error = EAGAIN; 251 1.1 jmcneill 252 1.1 jmcneill if (flags & I2C_F_POLL) { 253 1.1 jmcneill RSB_WRITE(sc, RSB_STAT_REG, 254 1.1 jmcneill sc->sc_stat & RSB_STAT_MASK); 255 1.1 jmcneill } 256 1.1 jmcneill 257 1.1 jmcneill if (error) { 258 1.1 jmcneill /* Abort transaction */ 259 1.1 jmcneill device_printf(sc->sc_dev, "transfer timeout, error = %d\n", 260 1.1 jmcneill error); 261 1.1 jmcneill RSB_WRITE(sc, RSB_CTRL_REG, 262 1.1 jmcneill RSB_CTRL_ABORT_TRANS); 263 1.1 jmcneill return error; 264 1.1 jmcneill } 265 1.1 jmcneill 266 1.1 jmcneill if (sc->sc_stat & RSB_STAT_LOAD_BSY) { 267 1.1 jmcneill device_printf(sc->sc_dev, "transfer busy\n"); 268 1.1 jmcneill return EBUSY; 269 1.1 jmcneill } 270 1.1 jmcneill if (sc->sc_stat & RSB_STAT_TRANS_ERR) { 271 1.5 christos device_printf(sc->sc_dev, "transfer error, id 0x%02" PRIx64 272 1.5 christos "\n", __SHIFTOUT(sc->sc_stat, RSB_STAT_TRANS_ERR_ID)); 273 1.1 jmcneill return EIO; 274 1.1 jmcneill } 275 1.1 jmcneill 276 1.1 jmcneill return 0; 277 1.1 jmcneill } 278 1.1 jmcneill 279 1.1 jmcneill static int 280 1.1 jmcneill sunxi_rsb_rsb_config(struct sunxi_rsb_softc *sc, uint8_t rta, i2c_addr_t da, 281 1.1 jmcneill int flags) 282 1.1 jmcneill { 283 1.1 jmcneill uint32_t dar, ctrl; 284 1.1 jmcneill 285 1.8 thorpej KASSERT(mutex_owned(&sc->sc_intr_lock)); 286 1.1 jmcneill 287 1.1 jmcneill RSB_WRITE(sc, RSB_STAT_REG, 288 1.1 jmcneill RSB_READ(sc, RSB_STAT_REG) & RSB_STAT_MASK); 289 1.1 jmcneill 290 1.1 jmcneill dar = __SHIFTIN(rta, RSB_DAR_RTA); 291 1.1 jmcneill dar |= __SHIFTIN(da, RSB_DAR_DA); 292 1.1 jmcneill RSB_WRITE(sc, RSB_DAR_REG, dar); 293 1.1 jmcneill RSB_WRITE(sc, RSB_CMD_REG, RSB_CMD_IDX_SRTA); 294 1.1 jmcneill 295 1.1 jmcneill /* Make sure the controller is idle */ 296 1.1 jmcneill ctrl = RSB_READ(sc, RSB_CTRL_REG); 297 1.1 jmcneill if (ctrl & RSB_CTRL_START_TRANS) { 298 1.1 jmcneill device_printf(sc->sc_dev, "device is busy\n"); 299 1.1 jmcneill return EBUSY; 300 1.1 jmcneill } 301 1.1 jmcneill 302 1.1 jmcneill /* Start the transfer */ 303 1.1 jmcneill RSB_WRITE(sc, RSB_CTRL_REG, 304 1.1 jmcneill ctrl | RSB_CTRL_START_TRANS); 305 1.1 jmcneill 306 1.1 jmcneill return sunxi_rsb_wait(sc, flags); 307 1.1 jmcneill } 308 1.1 jmcneill 309 1.1 jmcneill static int 310 1.1 jmcneill sunxi_rsb_exec(void *priv, i2c_op_t op, i2c_addr_t addr, 311 1.1 jmcneill const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags) 312 1.1 jmcneill { 313 1.1 jmcneill struct sunxi_rsb_softc *sc = priv; 314 1.1 jmcneill uint32_t dlen, ctrl; 315 1.1 jmcneill uint8_t rta; 316 1.1 jmcneill int error, i; 317 1.1 jmcneill 318 1.1 jmcneill if (cmdlen != 1 || (len != 1 && len != 2 && len != 4)) 319 1.1 jmcneill return EINVAL; 320 1.1 jmcneill 321 1.8 thorpej mutex_enter(&sc->sc_intr_lock); 322 1.8 thorpej 323 1.4 jmcneill error = sunxi_rsb_soft_reset(sc); 324 1.4 jmcneill if (error != 0) { 325 1.8 thorpej mutex_exit(&sc->sc_intr_lock); 326 1.4 jmcneill device_printf(sc->sc_dev, "soft reset timed out\n"); 327 1.4 jmcneill return error; 328 1.4 jmcneill } 329 1.4 jmcneill 330 1.4 jmcneill if ((flags & I2C_F_POLL) == 0) { 331 1.4 jmcneill /* Enable interrupts */ 332 1.4 jmcneill RSB_WRITE(sc, RSB_INTE_REG, 333 1.4 jmcneill RSB_INTE_LOAD_BSY_ENB | 334 1.4 jmcneill RSB_INTE_TRANS_ERR_ENB | 335 1.4 jmcneill RSB_INTE_TRANS_OVER_ENB); 336 1.4 jmcneill RSB_WRITE(sc, RSB_CTRL_REG, 337 1.4 jmcneill RSB_CTRL_GLOBAL_INT_ENB); 338 1.4 jmcneill } 339 1.4 jmcneill 340 1.1 jmcneill if (sc->sc_type == SUNXI_RSB && sc->sc_rsb_last_da != addr) { 341 1.1 jmcneill /* Lookup run-time address for given device address */ 342 1.1 jmcneill for (rta = 0, i = 0; rsb_rtamap[i].rta != 0; i++) 343 1.1 jmcneill if (rsb_rtamap[i].addr == addr) { 344 1.1 jmcneill rta = rsb_rtamap[i].rta; 345 1.1 jmcneill break; 346 1.1 jmcneill } 347 1.1 jmcneill if (rta == 0) { 348 1.8 thorpej mutex_exit(&sc->sc_intr_lock); 349 1.1 jmcneill device_printf(sc->sc_dev, 350 1.1 jmcneill "RTA not known for address %#x\n", addr); 351 1.1 jmcneill return ENXIO; 352 1.1 jmcneill } 353 1.1 jmcneill error = sunxi_rsb_rsb_config(sc, rta, addr, flags); 354 1.1 jmcneill if (error) { 355 1.1 jmcneill device_printf(sc->sc_dev, 356 1.1 jmcneill "SRTA failed, flags = %x, error = %d\n", 357 1.1 jmcneill flags, error); 358 1.1 jmcneill sc->sc_rsb_last_da = 0; 359 1.4 jmcneill goto done; 360 1.1 jmcneill } 361 1.1 jmcneill 362 1.1 jmcneill sc->sc_rsb_last_da = addr; 363 1.1 jmcneill } 364 1.1 jmcneill 365 1.1 jmcneill /* Data byte register */ 366 1.1 jmcneill RSB_WRITE(sc, RSB_DADDR0_REG, *(const uint8_t *)cmdbuf); 367 1.1 jmcneill 368 1.1 jmcneill if (I2C_OP_WRITE_P(op)) { 369 1.1 jmcneill uint8_t *pbuf = buf; 370 1.1 jmcneill uint32_t data; 371 1.1 jmcneill /* Write data */ 372 1.1 jmcneill switch (len) { 373 1.1 jmcneill case 1: 374 1.1 jmcneill data = pbuf[0]; 375 1.1 jmcneill break; 376 1.1 jmcneill case 2: 377 1.1 jmcneill data = pbuf[0] | (pbuf[1] << 8); 378 1.1 jmcneill break; 379 1.1 jmcneill case 4: 380 1.1 jmcneill data = pbuf[0] | (pbuf[1] << 8) | 381 1.1 jmcneill (pbuf[2] << 16) | (pbuf[3] << 24); 382 1.1 jmcneill break; 383 1.1 jmcneill default: 384 1.4 jmcneill error = EINVAL; 385 1.4 jmcneill goto done; 386 1.1 jmcneill } 387 1.1 jmcneill RSB_WRITE(sc, RSB_DATA0_REG, data); 388 1.1 jmcneill } 389 1.1 jmcneill 390 1.1 jmcneill if (sc->sc_type == SUNXI_RSB) { 391 1.1 jmcneill uint8_t cmd; 392 1.1 jmcneill if (I2C_OP_WRITE_P(op)) { 393 1.1 jmcneill switch (len) { 394 1.1 jmcneill case 1: cmd = RSB_CMD_IDX_WR8; break; 395 1.1 jmcneill case 2: cmd = RSB_CMD_IDX_WR16; break; 396 1.1 jmcneill case 4: cmd = RSB_CMD_IDX_WR32; break; 397 1.4 jmcneill default: error = EINVAL; goto done; 398 1.1 jmcneill } 399 1.1 jmcneill } else { 400 1.1 jmcneill switch (len) { 401 1.1 jmcneill case 1: cmd = RSB_CMD_IDX_RD8; break; 402 1.1 jmcneill case 2: cmd = RSB_CMD_IDX_RD16; break; 403 1.1 jmcneill case 4: cmd = RSB_CMD_IDX_RD32; break; 404 1.4 jmcneill default: error = EINVAL; goto done; 405 1.1 jmcneill } 406 1.1 jmcneill } 407 1.1 jmcneill RSB_WRITE(sc, RSB_CMD_REG, cmd); 408 1.1 jmcneill } 409 1.1 jmcneill 410 1.1 jmcneill /* Program data length register; if reading, set read/write bit */ 411 1.1 jmcneill dlen = __SHIFTIN(len - 1, RSB_DLEN_ACCESS_LENGTH); 412 1.1 jmcneill if (I2C_OP_READ_P(op)) { 413 1.1 jmcneill dlen |= RSB_DLEN_READ_WRITE_FLAG; 414 1.1 jmcneill } 415 1.1 jmcneill RSB_WRITE(sc, RSB_DLEN_REG, dlen); 416 1.1 jmcneill 417 1.1 jmcneill /* Make sure the controller is idle */ 418 1.1 jmcneill ctrl = RSB_READ(sc, RSB_CTRL_REG); 419 1.1 jmcneill if (ctrl & RSB_CTRL_START_TRANS) { 420 1.1 jmcneill device_printf(sc->sc_dev, "device is busy\n"); 421 1.4 jmcneill error = EBUSY; 422 1.4 jmcneill goto done; 423 1.1 jmcneill } 424 1.1 jmcneill 425 1.1 jmcneill /* Start the transfer */ 426 1.1 jmcneill RSB_WRITE(sc, RSB_CTRL_REG, 427 1.1 jmcneill ctrl | RSB_CTRL_START_TRANS); 428 1.1 jmcneill 429 1.1 jmcneill error = sunxi_rsb_wait(sc, flags); 430 1.4 jmcneill if (error) 431 1.4 jmcneill goto done; 432 1.1 jmcneill 433 1.1 jmcneill if (I2C_OP_READ_P(op)) { 434 1.1 jmcneill uint32_t data = RSB_READ(sc, RSB_DATA0_REG); 435 1.1 jmcneill switch (len) { 436 1.1 jmcneill case 4: 437 1.1 jmcneill *(uint32_t *)buf = data; 438 1.1 jmcneill break; 439 1.1 jmcneill case 2: 440 1.1 jmcneill *(uint16_t *)buf = data & 0xffff; 441 1.1 jmcneill break; 442 1.1 jmcneill case 1: 443 1.1 jmcneill *(uint8_t *)buf = data & 0xff; 444 1.1 jmcneill break; 445 1.1 jmcneill default: 446 1.4 jmcneill error = EINVAL; 447 1.4 jmcneill goto done; 448 1.1 jmcneill } 449 1.1 jmcneill } 450 1.1 jmcneill 451 1.4 jmcneill error = 0; 452 1.4 jmcneill 453 1.4 jmcneill done: 454 1.4 jmcneill RSB_WRITE(sc, RSB_CTRL_REG, 0); 455 1.8 thorpej mutex_exit(&sc->sc_intr_lock); 456 1.4 jmcneill 457 1.4 jmcneill return error; 458 1.1 jmcneill } 459