ti_iic.c revision 1.2 1 1.2 jmcneill /* $NetBSD: ti_iic.c,v 1.2 2019/10/29 22:19:13 jmcneill Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*
4 1.1 jmcneill * Copyright (c) 2013 Manuel Bouyer. All rights reserved.
5 1.1 jmcneill *
6 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
7 1.1 jmcneill * modification, are permitted provided that the following conditions
8 1.1 jmcneill * are met:
9 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
10 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
11 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
13 1.1 jmcneill * documentation and/or other materials provided with the distribution.
14 1.1 jmcneill *
15 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 1.1 jmcneill * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 1.1 jmcneill * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 1.1 jmcneill * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 1.1 jmcneill * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 1.1 jmcneill * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 1.1 jmcneill */
26 1.1 jmcneill
27 1.1 jmcneill /*-
28 1.1 jmcneill * Copyright (c) 2012 Jared D. McNeill <jmcneill (at) invisible.ca>
29 1.1 jmcneill * All rights reserved.
30 1.1 jmcneill *
31 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
32 1.1 jmcneill * modification, are permitted provided that the following conditions
33 1.1 jmcneill * are met:
34 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
35 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
36 1.1 jmcneill * 2. The name of the author may not be used to endorse or promote products
37 1.1 jmcneill * derived from this software without specific prior written permission.
38 1.1 jmcneill *
39 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
40 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
41 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
42 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
43 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
44 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
45 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
46 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
47 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
48 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
49 1.1 jmcneill * SUCH DAMAGE.
50 1.1 jmcneill */
51 1.1 jmcneill
52 1.1 jmcneill #include <sys/cdefs.h>
53 1.2 jmcneill __KERNEL_RCSID(0, "$NetBSD: ti_iic.c,v 1.2 2019/10/29 22:19:13 jmcneill Exp $");
54 1.1 jmcneill
55 1.1 jmcneill #include <sys/param.h>
56 1.1 jmcneill #include <sys/systm.h>
57 1.1 jmcneill #include <sys/device.h>
58 1.1 jmcneill #include <sys/conf.h>
59 1.1 jmcneill #include <sys/bus.h>
60 1.1 jmcneill #include <sys/proc.h>
61 1.1 jmcneill #include <sys/kernel.h>
62 1.1 jmcneill #include <sys/mutex.h>
63 1.1 jmcneill #include <sys/condvar.h>
64 1.1 jmcneill
65 1.1 jmcneill #include <dev/i2c/i2cvar.h>
66 1.1 jmcneill
67 1.1 jmcneill #include <dev/fdt/fdtvar.h>
68 1.1 jmcneill
69 1.1 jmcneill #include <arm/ti/ti_prcm.h>
70 1.1 jmcneill #include <arm/ti/ti_iicreg.h>
71 1.1 jmcneill
72 1.1 jmcneill #ifndef OMAP2_I2C_SLAVE_ADDR
73 1.1 jmcneill #define OMAP2_I2C_SLAVE_ADDR 0x01
74 1.1 jmcneill #endif
75 1.1 jmcneill
76 1.1 jmcneill #define OMAP2_I2C_FIFOBYTES(fd) (8 << (fd))
77 1.1 jmcneill
78 1.1 jmcneill #ifdef I2CDEBUG
79 1.1 jmcneill #define DPRINTF(args) printf args
80 1.1 jmcneill #else
81 1.1 jmcneill #define DPRINTF(args)
82 1.1 jmcneill #endif
83 1.1 jmcneill
84 1.2 jmcneill static const struct of_compat_data compat_data[] = {
85 1.2 jmcneill /* compatible reg shift */
86 1.2 jmcneill { "ti,omap3-i2c", 2 },
87 1.2 jmcneill { "ti,omap4-i2c", 0 },
88 1.2 jmcneill { NULL }
89 1.1 jmcneill };
90 1.1 jmcneill
91 1.1 jmcneill /* operation in progress */
92 1.1 jmcneill typedef enum {
93 1.1 jmcneill TI_I2CREAD,
94 1.1 jmcneill TI_I2CWRITE,
95 1.1 jmcneill TI_I2CDONE,
96 1.1 jmcneill TI_I2CERROR
97 1.1 jmcneill } ti_i2cop_t;
98 1.1 jmcneill
99 1.1 jmcneill struct ti_iic_softc {
100 1.1 jmcneill device_t sc_dev;
101 1.1 jmcneill struct i2c_controller sc_ic;
102 1.1 jmcneill kmutex_t sc_lock;
103 1.1 jmcneill device_t sc_i2cdev;
104 1.1 jmcneill
105 1.1 jmcneill bus_space_tag_t sc_iot;
106 1.1 jmcneill bus_space_handle_t sc_ioh;
107 1.1 jmcneill
108 1.2 jmcneill u_int sc_reg_shift;
109 1.2 jmcneill
110 1.1 jmcneill void *sc_ih;
111 1.1 jmcneill kmutex_t sc_mtx;
112 1.1 jmcneill kcondvar_t sc_cv;
113 1.1 jmcneill ti_i2cop_t sc_op;
114 1.1 jmcneill int sc_buflen;
115 1.1 jmcneill int sc_bufidx;
116 1.1 jmcneill char *sc_buf;
117 1.1 jmcneill
118 1.1 jmcneill bool sc_busy;
119 1.1 jmcneill
120 1.1 jmcneill int sc_rxthres;
121 1.1 jmcneill int sc_txthres;
122 1.1 jmcneill };
123 1.1 jmcneill
124 1.1 jmcneill #define I2C_READ_REG(sc, reg) \
125 1.2 jmcneill bus_space_read_2((sc)->sc_iot, (sc)->sc_ioh, (reg) << (sc)->sc_reg_shift)
126 1.1 jmcneill #define I2C_READ_DATA(sc) \
127 1.2 jmcneill bus_space_read_1((sc)->sc_iot, (sc)->sc_ioh, OMAP2_I2C_DATA << (sc)->sc_reg_shift);
128 1.1 jmcneill #define I2C_WRITE_REG(sc, reg, val) \
129 1.2 jmcneill bus_space_write_2((sc)->sc_iot, (sc)->sc_ioh, (reg) << (sc)->sc_reg_shift, (val))
130 1.1 jmcneill #define I2C_WRITE_DATA(sc, val) \
131 1.2 jmcneill bus_space_write_1((sc)->sc_iot, (sc)->sc_ioh, OMAP2_I2C_DATA << (sc)->sc_reg_shift, (val))
132 1.1 jmcneill
133 1.1 jmcneill static int ti_iic_match(device_t, cfdata_t, void *);
134 1.1 jmcneill static void ti_iic_attach(device_t, device_t, void *);
135 1.1 jmcneill
136 1.1 jmcneill static int ti_iic_intr(void *);
137 1.1 jmcneill
138 1.1 jmcneill static int ti_iic_acquire_bus(void *, int);
139 1.1 jmcneill static void ti_iic_release_bus(void *, int);
140 1.1 jmcneill static int ti_iic_exec(void *, i2c_op_t, i2c_addr_t, const void *,
141 1.1 jmcneill size_t, void *, size_t, int);
142 1.1 jmcneill
143 1.1 jmcneill static int ti_iic_reset(struct ti_iic_softc *);
144 1.1 jmcneill static int ti_iic_op(struct ti_iic_softc *, i2c_addr_t, ti_i2cop_t,
145 1.1 jmcneill uint8_t *, size_t, int);
146 1.1 jmcneill static void ti_iic_handle_intr(struct ti_iic_softc *, uint32_t);
147 1.1 jmcneill static void ti_iic_do_read(struct ti_iic_softc *, uint32_t);
148 1.1 jmcneill static void ti_iic_do_write(struct ti_iic_softc *, uint32_t);
149 1.1 jmcneill
150 1.1 jmcneill static int ti_iic_wait(struct ti_iic_softc *, uint16_t, uint16_t, int);
151 1.1 jmcneill static uint32_t ti_iic_stat(struct ti_iic_softc *, uint32_t);
152 1.1 jmcneill static int ti_iic_flush(struct ti_iic_softc *);
153 1.1 jmcneill
154 1.1 jmcneill static i2c_tag_t ti_iic_get_tag(device_t);
155 1.1 jmcneill
156 1.1 jmcneill static const struct fdtbus_i2c_controller_func ti_iic_funcs = {
157 1.1 jmcneill .get_tag = ti_iic_get_tag,
158 1.1 jmcneill };
159 1.1 jmcneill
160 1.1 jmcneill CFATTACH_DECL_NEW(ti_iic, sizeof(struct ti_iic_softc),
161 1.1 jmcneill ti_iic_match, ti_iic_attach, NULL, NULL);
162 1.1 jmcneill
163 1.1 jmcneill static int
164 1.1 jmcneill ti_iic_match(device_t parent, cfdata_t match, void *opaque)
165 1.1 jmcneill {
166 1.1 jmcneill struct fdt_attach_args * const faa = opaque;
167 1.1 jmcneill
168 1.2 jmcneill return of_match_compat_data(faa->faa_phandle, compat_data);
169 1.1 jmcneill }
170 1.1 jmcneill
171 1.1 jmcneill static void
172 1.1 jmcneill ti_iic_attach(device_t parent, device_t self, void *opaque)
173 1.1 jmcneill {
174 1.1 jmcneill struct ti_iic_softc *sc = device_private(self);
175 1.1 jmcneill struct fdt_attach_args * const faa = opaque;
176 1.1 jmcneill const int phandle = faa->faa_phandle;
177 1.1 jmcneill int scheme, major, minor, fifodepth, fifo;
178 1.1 jmcneill char intrstr[128];
179 1.1 jmcneill bus_addr_t addr;
180 1.1 jmcneill bus_size_t size;
181 1.1 jmcneill uint16_t rev;
182 1.1 jmcneill
183 1.1 jmcneill if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
184 1.1 jmcneill aprint_error(": couldn't get registers\n");
185 1.1 jmcneill return;
186 1.1 jmcneill }
187 1.1 jmcneill if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
188 1.1 jmcneill aprint_error(": couldn't decode interrupt\n");
189 1.1 jmcneill return;
190 1.1 jmcneill }
191 1.1 jmcneill
192 1.2 jmcneill if (ti_prcm_enable_hwmod(phandle, 0) != 0) {
193 1.1 jmcneill aprint_error(": couldn't enable module\n");
194 1.1 jmcneill return;
195 1.1 jmcneill }
196 1.1 jmcneill
197 1.1 jmcneill sc->sc_dev = self;
198 1.1 jmcneill sc->sc_iot = faa->faa_bst;
199 1.1 jmcneill mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
200 1.1 jmcneill mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_NET);
201 1.1 jmcneill cv_init(&sc->sc_cv, "tiiic");
202 1.1 jmcneill sc->sc_ic.ic_cookie = sc;
203 1.1 jmcneill sc->sc_ic.ic_acquire_bus = ti_iic_acquire_bus;
204 1.1 jmcneill sc->sc_ic.ic_release_bus = ti_iic_release_bus;
205 1.1 jmcneill sc->sc_ic.ic_exec = ti_iic_exec;
206 1.1 jmcneill
207 1.1 jmcneill if (bus_space_map(sc->sc_iot, addr, size, 0, &sc->sc_ioh) != 0) {
208 1.1 jmcneill aprint_error(": couldn't map registers\n");
209 1.1 jmcneill return;
210 1.1 jmcneill }
211 1.2 jmcneill sc->sc_reg_shift = of_search_compatible(phandle, compat_data)->data;
212 1.1 jmcneill
213 1.1 jmcneill sc->sc_ih = fdtbus_intr_establish(phandle, 0, IPL_NET, 0,
214 1.1 jmcneill ti_iic_intr, sc);
215 1.1 jmcneill if (sc->sc_ih == NULL) {
216 1.1 jmcneill aprint_error(": couldn't establish interrupt\n");
217 1.1 jmcneill return;
218 1.1 jmcneill }
219 1.1 jmcneill
220 1.1 jmcneill scheme = I2C_REVNB_HI_SCHEME(I2C_READ_REG(sc, OMAP2_I2C_REVNB_HI));
221 1.1 jmcneill rev = I2C_READ_REG(sc, OMAP2_I2C_REVNB_LO);
222 1.1 jmcneill if (scheme == 0) {
223 1.1 jmcneill major = I2C_REV_SCHEME_0_MAJOR(rev);
224 1.1 jmcneill minor = I2C_REV_SCHEME_0_MINOR(rev);
225 1.1 jmcneill } else {
226 1.1 jmcneill major = I2C_REVNB_LO_MAJOR(rev);
227 1.1 jmcneill minor = I2C_REVNB_LO_MINOR(rev);
228 1.1 jmcneill }
229 1.1 jmcneill aprint_normal(": rev %d.%d, scheme %d\n", major, minor, scheme);
230 1.1 jmcneill aprint_naive("\n");
231 1.1 jmcneill
232 1.1 jmcneill fifodepth = I2C_BUFSTAT_FIFODEPTH(I2C_READ_REG(sc, OMAP2_I2C_BUFSTAT));
233 1.1 jmcneill fifo = OMAP2_I2C_FIFOBYTES(fifodepth);
234 1.1 jmcneill aprint_normal_dev(self, "%d-bytes FIFO\n", fifo);
235 1.1 jmcneill sc->sc_rxthres = sc->sc_txthres = fifo >> 1;
236 1.1 jmcneill
237 1.1 jmcneill ti_iic_reset(sc);
238 1.1 jmcneill ti_iic_flush(sc);
239 1.1 jmcneill
240 1.1 jmcneill fdtbus_register_i2c_controller(self, phandle, &ti_iic_funcs);
241 1.1 jmcneill
242 1.1 jmcneill fdtbus_attach_i2cbus(self, phandle, &sc->sc_ic, iicbus_print);
243 1.1 jmcneill }
244 1.1 jmcneill
245 1.1 jmcneill static int
246 1.1 jmcneill ti_iic_intr(void *arg)
247 1.1 jmcneill {
248 1.1 jmcneill struct ti_iic_softc *sc = arg;
249 1.1 jmcneill uint32_t stat;
250 1.1 jmcneill
251 1.1 jmcneill mutex_enter(&sc->sc_mtx);
252 1.1 jmcneill DPRINTF(("ti_iic_intr\n"));
253 1.1 jmcneill stat = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS);
254 1.1 jmcneill DPRINTF(("ti_iic_intr pre handle sc->sc_op eq %#x\n", sc->sc_op));
255 1.1 jmcneill ti_iic_handle_intr(sc, stat);
256 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_IRQSTATUS, stat);
257 1.1 jmcneill if (sc->sc_op == TI_I2CERROR || sc->sc_op == TI_I2CDONE) {
258 1.1 jmcneill DPRINTF(("ti_iic_intr post handle sc->sc_op %#x\n", sc->sc_op));
259 1.1 jmcneill cv_broadcast(&sc->sc_cv);
260 1.1 jmcneill }
261 1.1 jmcneill mutex_exit(&sc->sc_mtx);
262 1.1 jmcneill DPRINTF(("ti_iic_intr status 0x%x\n", stat));
263 1.1 jmcneill return 1;
264 1.1 jmcneill }
265 1.1 jmcneill
266 1.1 jmcneill static int
267 1.1 jmcneill ti_iic_acquire_bus(void *opaque, int flags)
268 1.1 jmcneill {
269 1.1 jmcneill struct ti_iic_softc *sc = opaque;
270 1.1 jmcneill
271 1.1 jmcneill mutex_enter(&sc->sc_lock);
272 1.1 jmcneill while (sc->sc_busy)
273 1.1 jmcneill cv_wait(&sc->sc_cv, &sc->sc_lock);
274 1.1 jmcneill sc->sc_busy = true;
275 1.1 jmcneill mutex_exit(&sc->sc_lock);
276 1.1 jmcneill
277 1.1 jmcneill return 0;
278 1.1 jmcneill }
279 1.1 jmcneill
280 1.1 jmcneill static void
281 1.1 jmcneill ti_iic_release_bus(void *opaque, int flags)
282 1.1 jmcneill {
283 1.1 jmcneill struct ti_iic_softc *sc = opaque;
284 1.1 jmcneill
285 1.1 jmcneill mutex_enter(&sc->sc_lock);
286 1.1 jmcneill sc->sc_busy = false;
287 1.1 jmcneill cv_broadcast(&sc->sc_cv);
288 1.1 jmcneill mutex_exit(&sc->sc_lock);
289 1.1 jmcneill }
290 1.1 jmcneill
291 1.1 jmcneill static int
292 1.1 jmcneill ti_iic_exec(void *opaque, i2c_op_t op, i2c_addr_t addr,
293 1.1 jmcneill const void *cmdbuf, size_t cmdlen, void *buf, size_t len, int flags)
294 1.1 jmcneill {
295 1.1 jmcneill struct ti_iic_softc *sc = opaque;
296 1.1 jmcneill int err;
297 1.1 jmcneill
298 1.1 jmcneill DPRINTF(("ti_iic_exec: op 0x%x cmdlen %zd len %zd flags 0x%x\n",
299 1.1 jmcneill op, cmdlen, len, flags));
300 1.1 jmcneill
301 1.1 jmcneill if (cmdlen > 0) {
302 1.1 jmcneill err = ti_iic_op(sc, addr, TI_I2CWRITE,
303 1.1 jmcneill __UNCONST(cmdbuf), cmdlen,
304 1.1 jmcneill (I2C_OP_READ_P(op) ? 0 : I2C_F_STOP) | flags);
305 1.1 jmcneill if (err)
306 1.1 jmcneill goto done;
307 1.1 jmcneill }
308 1.1 jmcneill
309 1.1 jmcneill if (I2C_OP_STOP_P(op))
310 1.1 jmcneill flags |= I2C_F_STOP;
311 1.1 jmcneill
312 1.1 jmcneill /*
313 1.1 jmcneill * I2C controller doesn't allow for zero-byte transfers.
314 1.1 jmcneill */
315 1.1 jmcneill if (len == 0) {
316 1.1 jmcneill err = EINVAL;
317 1.1 jmcneill goto done;
318 1.1 jmcneill }
319 1.1 jmcneill
320 1.1 jmcneill if (I2C_OP_READ_P(op)) {
321 1.1 jmcneill err = ti_iic_op(sc, addr, TI_I2CREAD, buf, len, flags);
322 1.1 jmcneill } else {
323 1.1 jmcneill err = ti_iic_op(sc, addr, TI_I2CWRITE, buf, len, flags);
324 1.1 jmcneill }
325 1.1 jmcneill
326 1.1 jmcneill done:
327 1.1 jmcneill if (err)
328 1.1 jmcneill ti_iic_reset(sc);
329 1.1 jmcneill
330 1.1 jmcneill ti_iic_flush(sc);
331 1.1 jmcneill
332 1.1 jmcneill DPRINTF(("ti_iic_exec: done %d\n", err));
333 1.1 jmcneill return err;
334 1.1 jmcneill }
335 1.1 jmcneill
336 1.1 jmcneill static int
337 1.1 jmcneill ti_iic_reset(struct ti_iic_softc *sc)
338 1.1 jmcneill {
339 1.1 jmcneill uint32_t psc, scll, sclh;
340 1.1 jmcneill int i;
341 1.1 jmcneill
342 1.1 jmcneill DPRINTF(("ti_iic_reset\n"));
343 1.1 jmcneill
344 1.1 jmcneill /* Disable */
345 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, 0);
346 1.1 jmcneill /* Soft reset */
347 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_SYSC, I2C_SYSC_SRST);
348 1.1 jmcneill delay(1000);
349 1.1 jmcneill /* enable so that we can check for reset complete */
350 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, I2C_CON_EN);
351 1.1 jmcneill delay(1000);
352 1.1 jmcneill for (i = 0; i < 1000; i++) { /* 1s delay for reset */
353 1.1 jmcneill if (I2C_READ_REG(sc, OMAP2_I2C_SYSS) & I2C_SYSS_RDONE)
354 1.1 jmcneill break;
355 1.1 jmcneill }
356 1.1 jmcneill /* Disable again */
357 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, 0);
358 1.1 jmcneill delay(50000);
359 1.1 jmcneill
360 1.1 jmcneill if (i >= 1000) {
361 1.1 jmcneill aprint_error_dev(sc->sc_dev, ": couldn't reset module\n");
362 1.1 jmcneill return 1;
363 1.1 jmcneill }
364 1.1 jmcneill
365 1.1 jmcneill
366 1.1 jmcneill /* XXX standard speed only */
367 1.1 jmcneill psc = 3;
368 1.1 jmcneill scll = 53;
369 1.1 jmcneill sclh = 55;
370 1.1 jmcneill
371 1.1 jmcneill /* Clocks */
372 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_PSC, psc);
373 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_SCLL, scll);
374 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_SCLH, sclh);
375 1.1 jmcneill
376 1.1 jmcneill /* Own I2C address */
377 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_OA, OMAP2_I2C_SLAVE_ADDR);
378 1.1 jmcneill
379 1.1 jmcneill /* 5 bytes fifo */
380 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_BUF,
381 1.1 jmcneill I2C_BUF_RXTRSH(sc->sc_rxthres) | I2C_BUF_TXTRSH(sc->sc_txthres));
382 1.1 jmcneill
383 1.1 jmcneill /* Enable */
384 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, I2C_CON_EN);
385 1.1 jmcneill
386 1.1 jmcneill return 0;
387 1.1 jmcneill }
388 1.1 jmcneill
389 1.1 jmcneill static int
390 1.1 jmcneill ti_iic_op(struct ti_iic_softc *sc, i2c_addr_t addr, ti_i2cop_t op,
391 1.1 jmcneill uint8_t *buf, size_t buflen, int flags)
392 1.1 jmcneill {
393 1.1 jmcneill uint16_t con, stat, mask;
394 1.1 jmcneill int err, retry;
395 1.1 jmcneill
396 1.1 jmcneill KASSERT(op == TI_I2CREAD || op == TI_I2CWRITE);
397 1.1 jmcneill DPRINTF(("ti_iic_op: addr %#x op %#x buf %p buflen %#x flags %#x\n",
398 1.1 jmcneill addr, op, buf, (unsigned int) buflen, flags));
399 1.1 jmcneill
400 1.1 jmcneill mask = I2C_IRQSTATUS_ARDY | I2C_IRQSTATUS_NACK | I2C_IRQSTATUS_AL;
401 1.1 jmcneill if (op == TI_I2CREAD) {
402 1.1 jmcneill mask |= I2C_IRQSTATUS_RDR | I2C_IRQSTATUS_RRDY;
403 1.1 jmcneill } else {
404 1.1 jmcneill mask |= I2C_IRQSTATUS_XDR | I2C_IRQSTATUS_XRDY;
405 1.1 jmcneill }
406 1.1 jmcneill
407 1.1 jmcneill err = ti_iic_wait(sc, I2C_IRQSTATUS_BB, 0, flags);
408 1.1 jmcneill if (err) {
409 1.1 jmcneill DPRINTF(("ti_iic_op: wait error %d\n", err));
410 1.1 jmcneill return err;
411 1.1 jmcneill }
412 1.1 jmcneill
413 1.1 jmcneill con = I2C_CON_EN;
414 1.1 jmcneill con |= I2C_CON_MST;
415 1.1 jmcneill con |= I2C_CON_STT;;
416 1.1 jmcneill if (flags & I2C_F_STOP)
417 1.1 jmcneill con |= I2C_CON_STP;
418 1.1 jmcneill if (addr & ~0x7f)
419 1.1 jmcneill con |= I2C_CON_XSA;
420 1.1 jmcneill if (op == TI_I2CWRITE)
421 1.1 jmcneill con |= I2C_CON_TRX;
422 1.1 jmcneill
423 1.1 jmcneill mutex_enter(&sc->sc_mtx);
424 1.1 jmcneill sc->sc_op = op;
425 1.1 jmcneill sc->sc_buf = buf;
426 1.1 jmcneill sc->sc_buflen = buflen;
427 1.1 jmcneill sc->sc_bufidx = 0;
428 1.1 jmcneill
429 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, I2C_CON_EN | I2C_CON_MST | I2C_CON_STP);
430 1.1 jmcneill DPRINTF(("ti_iic_op: op %d con 0x%x ", op, con));
431 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CNT, buflen);
432 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_SA, (addr & I2C_SA_MASK));
433 1.1 jmcneill DPRINTF(("SA 0x%x len %d\n", I2C_READ_REG(sc, OMAP2_I2C_SA), I2C_READ_REG(sc, OMAP2_I2C_CNT)));
434 1.1 jmcneill
435 1.1 jmcneill if ((flags & I2C_F_POLL) == 0) {
436 1.1 jmcneill /* clear any pending interrupt */
437 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_IRQSTATUS,
438 1.1 jmcneill I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS));
439 1.1 jmcneill /* and enable */
440 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_IRQENABLE_SET, mask);
441 1.1 jmcneill }
442 1.1 jmcneill /* start transfer */
443 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, con);
444 1.1 jmcneill
445 1.1 jmcneill if ((flags & I2C_F_POLL) == 0) {
446 1.1 jmcneill /* and wait for completion */
447 1.1 jmcneill DPRINTF(("ti_iic_op waiting, op %#x\n", sc->sc_op));
448 1.1 jmcneill while (sc->sc_op == op) {
449 1.1 jmcneill if (cv_timedwait(&sc->sc_cv, &sc->sc_mtx,
450 1.1 jmcneill mstohz(5000)) == EWOULDBLOCK) {
451 1.1 jmcneill /* timeout */
452 1.1 jmcneill op = TI_I2CERROR;
453 1.1 jmcneill }
454 1.1 jmcneill }
455 1.1 jmcneill DPRINTF(("ti_iic_op waiting done, op %#x\n", sc->sc_op));
456 1.1 jmcneill
457 1.1 jmcneill /* disable interrupts */
458 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_IRQENABLE_CLR, 0xffff);
459 1.1 jmcneill } else {
460 1.1 jmcneill /* poll for completion */
461 1.1 jmcneill DPRINTF(("ti_iic_op polling, op %x\n", sc->sc_op));
462 1.1 jmcneill while (sc->sc_op == op) {
463 1.1 jmcneill stat = ti_iic_stat(sc, mask);
464 1.1 jmcneill DPRINTF(("ti_iic_op stat 0x%x\n", stat));
465 1.1 jmcneill if (stat == 0) {
466 1.1 jmcneill /* timeout */
467 1.1 jmcneill sc->sc_op = TI_I2CERROR;
468 1.1 jmcneill } else {
469 1.1 jmcneill ti_iic_handle_intr(sc, stat);
470 1.1 jmcneill }
471 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_IRQSTATUS, stat);
472 1.1 jmcneill }
473 1.1 jmcneill DPRINTF(("ti_iic_op polling done, op now %x\n", sc->sc_op));
474 1.1 jmcneill }
475 1.1 jmcneill mutex_exit(&sc->sc_mtx);
476 1.1 jmcneill retry = 10000;
477 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CON, 0);
478 1.1 jmcneill while (I2C_READ_REG(sc, OMAP2_I2C_CON) & I2C_CON_MST) {
479 1.1 jmcneill delay(100);
480 1.1 jmcneill if (--retry == 0)
481 1.1 jmcneill break;
482 1.1 jmcneill }
483 1.1 jmcneill return (sc->sc_op == TI_I2CDONE) ? 0 : EIO;
484 1.1 jmcneill }
485 1.1 jmcneill
486 1.1 jmcneill static void
487 1.1 jmcneill ti_iic_handle_intr(struct ti_iic_softc *sc, uint32_t stat)
488 1.1 jmcneill {
489 1.1 jmcneill KASSERT(mutex_owned(&sc->sc_mtx));
490 1.1 jmcneill KASSERT(stat != 0);
491 1.1 jmcneill DPRINTF(("ti_iic_handle_intr stat %#x\n", stat));
492 1.1 jmcneill
493 1.1 jmcneill if (stat &
494 1.1 jmcneill (I2C_IRQSTATUS_NACK|I2C_IRQSTATUS_AL)) {
495 1.1 jmcneill sc->sc_op = TI_I2CERROR;
496 1.1 jmcneill return;
497 1.1 jmcneill }
498 1.1 jmcneill if (stat & I2C_IRQSTATUS_ARDY) {
499 1.1 jmcneill sc->sc_op = TI_I2CDONE;
500 1.1 jmcneill return;
501 1.1 jmcneill }
502 1.1 jmcneill if (sc->sc_op == TI_I2CREAD)
503 1.1 jmcneill ti_iic_do_read(sc, stat);
504 1.1 jmcneill else if (sc->sc_op == TI_I2CWRITE)
505 1.1 jmcneill ti_iic_do_write(sc, stat);
506 1.1 jmcneill else
507 1.1 jmcneill return;
508 1.1 jmcneill }
509 1.1 jmcneill void
510 1.1 jmcneill ti_iic_do_read(struct ti_iic_softc *sc, uint32_t stat)
511 1.1 jmcneill {
512 1.1 jmcneill int len = 0;
513 1.1 jmcneill
514 1.1 jmcneill KASSERT(mutex_owned(&sc->sc_mtx));
515 1.1 jmcneill DPRINTF(("ti_iic_do_read stat %#x\n", stat));
516 1.1 jmcneill if (stat & I2C_IRQSTATUS_RDR) {
517 1.1 jmcneill len = I2C_READ_REG(sc, OMAP2_I2C_BUFSTAT);
518 1.1 jmcneill len = I2C_BUFSTAT_RXSTAT(len);
519 1.1 jmcneill DPRINTF(("ti_iic_do_read receive drain len %d left %d\n",
520 1.1 jmcneill len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
521 1.1 jmcneill } else if (stat & I2C_IRQSTATUS_RRDY) {
522 1.1 jmcneill len = sc->sc_rxthres + 1;
523 1.1 jmcneill DPRINTF(("ti_iic_do_read receive len %d left %d\n",
524 1.1 jmcneill len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
525 1.1 jmcneill }
526 1.1 jmcneill for (;
527 1.1 jmcneill sc->sc_bufidx < sc->sc_buflen && len > 0;
528 1.1 jmcneill sc->sc_bufidx++, len--) {
529 1.1 jmcneill sc->sc_buf[sc->sc_bufidx] = I2C_READ_DATA(sc);
530 1.1 jmcneill DPRINTF(("ti_iic_do_read got b[%d]=0x%x\n", sc->sc_bufidx,
531 1.1 jmcneill sc->sc_buf[sc->sc_bufidx]));
532 1.1 jmcneill }
533 1.1 jmcneill DPRINTF(("ti_iic_do_read done\n"));
534 1.1 jmcneill }
535 1.1 jmcneill
536 1.1 jmcneill void
537 1.1 jmcneill ti_iic_do_write(struct ti_iic_softc *sc, uint32_t stat)
538 1.1 jmcneill {
539 1.1 jmcneill int len = 0;
540 1.1 jmcneill
541 1.1 jmcneill DPRINTF(("ti_iic_do_write stat %#x\n", stat));
542 1.1 jmcneill KASSERT(mutex_owned(&sc->sc_mtx));
543 1.1 jmcneill if (stat & I2C_IRQSTATUS_XDR) {
544 1.1 jmcneill len = I2C_READ_REG(sc, OMAP2_I2C_BUFSTAT);
545 1.1 jmcneill len = I2C_BUFSTAT_TXSTAT(len);
546 1.1 jmcneill DPRINTF(("ti_iic_do_write xmit drain len %d left %d\n",
547 1.1 jmcneill len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
548 1.1 jmcneill } else if (stat & I2C_IRQSTATUS_XRDY) {
549 1.1 jmcneill len = sc->sc_txthres + 1;
550 1.1 jmcneill DPRINTF(("ti_iic_do_write xmit len %d left %d\n",
551 1.1 jmcneill len, I2C_READ_REG(sc, OMAP2_I2C_CNT)));
552 1.1 jmcneill }
553 1.1 jmcneill for (;
554 1.1 jmcneill sc->sc_bufidx < sc->sc_buflen && len > 0;
555 1.1 jmcneill sc->sc_bufidx++, len--) {
556 1.1 jmcneill DPRINTF(("ti_iic_do_write send b[%d]=0x%x\n",
557 1.1 jmcneill sc->sc_bufidx, sc->sc_buf[sc->sc_bufidx]));
558 1.1 jmcneill I2C_WRITE_DATA(sc, sc->sc_buf[sc->sc_bufidx]);
559 1.1 jmcneill }
560 1.1 jmcneill DPRINTF(("ti_iic_do_write done\n"));
561 1.1 jmcneill }
562 1.1 jmcneill
563 1.1 jmcneill static int
564 1.1 jmcneill ti_iic_wait(struct ti_iic_softc *sc, uint16_t mask, uint16_t val, int flags)
565 1.1 jmcneill {
566 1.1 jmcneill int retry = 10;
567 1.1 jmcneill uint16_t v;
568 1.1 jmcneill DPRINTF(("ti_iic_wait mask %#x val %#x flags %#x\n", mask, val, flags));
569 1.1 jmcneill
570 1.1 jmcneill while (((v = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS_RAW)) & mask) != val) {
571 1.1 jmcneill --retry;
572 1.1 jmcneill if (retry == 0) {
573 1.1 jmcneill aprint_error_dev(sc->sc_dev, ": wait timeout, "
574 1.1 jmcneill "mask = %#x val = %#x stat = %#x\n",
575 1.1 jmcneill mask, val, v);
576 1.1 jmcneill return EBUSY;
577 1.1 jmcneill }
578 1.1 jmcneill if (flags & I2C_F_POLL) {
579 1.1 jmcneill delay(50000);
580 1.1 jmcneill } else {
581 1.1 jmcneill kpause("tiiic", false, mstohz(50), NULL);
582 1.1 jmcneill }
583 1.1 jmcneill }
584 1.1 jmcneill DPRINTF(("ti_iic_wait done retry %#x\n", retry));
585 1.1 jmcneill
586 1.1 jmcneill return 0;
587 1.1 jmcneill }
588 1.1 jmcneill
589 1.1 jmcneill static uint32_t
590 1.1 jmcneill ti_iic_stat(struct ti_iic_softc *sc, uint32_t mask)
591 1.1 jmcneill {
592 1.1 jmcneill uint32_t v;
593 1.1 jmcneill int retry = 500;
594 1.1 jmcneill DPRINTF(("ti_iic_wait mask %#x\n", mask));
595 1.1 jmcneill while (--retry > 0) {
596 1.1 jmcneill v = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS_RAW) & mask;
597 1.1 jmcneill if (v != 0)
598 1.1 jmcneill break;
599 1.1 jmcneill delay(100);
600 1.1 jmcneill }
601 1.1 jmcneill DPRINTF(("ti_iic_wait done retry %#x\n", retry));
602 1.1 jmcneill return v;
603 1.1 jmcneill }
604 1.1 jmcneill
605 1.1 jmcneill static int
606 1.1 jmcneill ti_iic_flush(struct ti_iic_softc *sc)
607 1.1 jmcneill {
608 1.1 jmcneill DPRINTF(("ti_iic_flush\n"));
609 1.1 jmcneill #if 0
610 1.1 jmcneill int retry = 1000;
611 1.1 jmcneill uint16_t v;
612 1.1 jmcneill
613 1.1 jmcneill while ((v = I2C_READ_REG(sc, OMAP2_I2C_IRQSTATUS_RAW)) & I2C_IRQSTATUS_RRDY) {
614 1.1 jmcneill if (--retry == 0) {
615 1.1 jmcneill aprint_error_dev(sc->sc_dev,
616 1.1 jmcneill ": flush timeout, stat = %#x\n", v);
617 1.1 jmcneill return EBUSY;
618 1.1 jmcneill }
619 1.1 jmcneill (void)I2C_READ_DATA(sc);
620 1.1 jmcneill delay(1000);
621 1.1 jmcneill }
622 1.1 jmcneill #endif
623 1.1 jmcneill
624 1.1 jmcneill I2C_WRITE_REG(sc, OMAP2_I2C_CNT, 0);
625 1.1 jmcneill return 0;
626 1.1 jmcneill }
627 1.1 jmcneill
628 1.1 jmcneill static i2c_tag_t
629 1.1 jmcneill ti_iic_get_tag(device_t dev)
630 1.1 jmcneill {
631 1.1 jmcneill struct ti_iic_softc * const sc = device_private(dev);
632 1.1 jmcneill
633 1.1 jmcneill return &sc->sc_ic;
634 1.1 jmcneill }
635