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