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