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