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