]> git.proxmox.com Git - qemu.git/blob - hw/omap_i2c.c
Add v{add, sub}{s, u}{b, h, w}s instructions
[qemu.git] / hw / omap_i2c.c
1 /*
2 * TI OMAP on-chip I2C controller. Only "new I2C" mode supported.
3 *
4 * Copyright (C) 2007 Andrzej Zaborowski <balrog@zabor.org>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation; either version 2 of
9 * the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 */
20 #include "hw.h"
21 #include "i2c.h"
22 #include "omap.h"
23
24 struct omap_i2c_s {
25 qemu_irq irq;
26 qemu_irq drq[2];
27 i2c_slave slave;
28 i2c_bus *bus;
29
30 uint8_t revision;
31 uint8_t mask;
32 uint16_t stat;
33 uint16_t dma;
34 uint16_t count;
35 int count_cur;
36 uint32_t fifo;
37 int rxlen;
38 int txlen;
39 uint16_t control;
40 uint16_t addr[2];
41 uint8_t divider;
42 uint8_t times[2];
43 uint16_t test;
44 };
45
46 #define OMAP2_INTR_REV 0x34
47 #define OMAP2_GC_REV 0x34
48
49 static void omap_i2c_interrupts_update(struct omap_i2c_s *s)
50 {
51 qemu_set_irq(s->irq, s->stat & s->mask);
52 if ((s->dma >> 15) & 1) /* RDMA_EN */
53 qemu_set_irq(s->drq[0], (s->stat >> 3) & 1); /* RRDY */
54 if ((s->dma >> 7) & 1) /* XDMA_EN */
55 qemu_set_irq(s->drq[1], (s->stat >> 4) & 1); /* XRDY */
56 }
57
58 /* These are only stubs now. */
59 static void omap_i2c_event(i2c_slave *i2c, enum i2c_event event)
60 {
61 struct omap_i2c_s *s = (struct omap_i2c_s *) i2c;
62
63 if ((~s->control >> 15) & 1) /* I2C_EN */
64 return;
65
66 switch (event) {
67 case I2C_START_SEND:
68 case I2C_START_RECV:
69 s->stat |= 1 << 9; /* AAS */
70 break;
71 case I2C_FINISH:
72 s->stat |= 1 << 2; /* ARDY */
73 break;
74 case I2C_NACK:
75 s->stat |= 1 << 1; /* NACK */
76 break;
77 }
78
79 omap_i2c_interrupts_update(s);
80 }
81
82 static int omap_i2c_rx(i2c_slave *i2c)
83 {
84 struct omap_i2c_s *s = (struct omap_i2c_s *) i2c;
85 uint8_t ret = 0;
86
87 if ((~s->control >> 15) & 1) /* I2C_EN */
88 return -1;
89
90 if (s->txlen)
91 ret = s->fifo >> ((-- s->txlen) << 3) & 0xff;
92 else
93 s->stat |= 1 << 10; /* XUDF */
94 s->stat |= 1 << 4; /* XRDY */
95
96 omap_i2c_interrupts_update(s);
97 return ret;
98 }
99
100 static int omap_i2c_tx(i2c_slave *i2c, uint8_t data)
101 {
102 struct omap_i2c_s *s = (struct omap_i2c_s *) i2c;
103
104 if ((~s->control >> 15) & 1) /* I2C_EN */
105 return 1;
106
107 if (s->rxlen < 4)
108 s->fifo |= data << ((s->rxlen ++) << 3);
109 else
110 s->stat |= 1 << 11; /* ROVR */
111 s->stat |= 1 << 3; /* RRDY */
112
113 omap_i2c_interrupts_update(s);
114 return 1;
115 }
116
117 static void omap_i2c_fifo_run(struct omap_i2c_s *s)
118 {
119 int ack = 1;
120
121 if (!i2c_bus_busy(s->bus))
122 return;
123
124 if ((s->control >> 2) & 1) { /* RM */
125 if ((s->control >> 1) & 1) { /* STP */
126 i2c_end_transfer(s->bus);
127 s->control &= ~(1 << 1); /* STP */
128 s->count_cur = s->count;
129 s->txlen = 0;
130 } else if ((s->control >> 9) & 1) { /* TRX */
131 while (ack && s->txlen)
132 ack = (i2c_send(s->bus,
133 (s->fifo >> ((-- s->txlen) << 3)) &
134 0xff) >= 0);
135 s->stat |= 1 << 4; /* XRDY */
136 } else {
137 while (s->rxlen < 4)
138 s->fifo |= i2c_recv(s->bus) << ((s->rxlen ++) << 3);
139 s->stat |= 1 << 3; /* RRDY */
140 }
141 } else {
142 if ((s->control >> 9) & 1) { /* TRX */
143 while (ack && s->count_cur && s->txlen) {
144 ack = (i2c_send(s->bus,
145 (s->fifo >> ((-- s->txlen) << 3)) &
146 0xff) >= 0);
147 s->count_cur --;
148 }
149 if (ack && s->count_cur)
150 s->stat |= 1 << 4; /* XRDY */
151 else
152 s->stat &= ~(1 << 4); /* XRDY */
153 if (!s->count_cur) {
154 s->stat |= 1 << 2; /* ARDY */
155 s->control &= ~(1 << 10); /* MST */
156 }
157 } else {
158 while (s->count_cur && s->rxlen < 4) {
159 s->fifo |= i2c_recv(s->bus) << ((s->rxlen ++) << 3);
160 s->count_cur --;
161 }
162 if (s->rxlen)
163 s->stat |= 1 << 3; /* RRDY */
164 else
165 s->stat &= ~(1 << 3); /* RRDY */
166 }
167 if (!s->count_cur) {
168 if ((s->control >> 1) & 1) { /* STP */
169 i2c_end_transfer(s->bus);
170 s->control &= ~(1 << 1); /* STP */
171 s->count_cur = s->count;
172 s->txlen = 0;
173 } else {
174 s->stat |= 1 << 2; /* ARDY */
175 s->control &= ~(1 << 10); /* MST */
176 }
177 }
178 }
179
180 s->stat |= (!ack) << 1; /* NACK */
181 if (!ack)
182 s->control &= ~(1 << 1); /* STP */
183 }
184
185 void omap_i2c_reset(struct omap_i2c_s *s)
186 {
187 s->mask = 0;
188 s->stat = 0;
189 s->dma = 0;
190 s->count = 0;
191 s->count_cur = 0;
192 s->fifo = 0;
193 s->rxlen = 0;
194 s->txlen = 0;
195 s->control = 0;
196 s->addr[0] = 0;
197 s->addr[1] = 0;
198 s->divider = 0;
199 s->times[0] = 0;
200 s->times[1] = 0;
201 s->test = 0;
202 }
203
204 static uint32_t omap_i2c_read(void *opaque, target_phys_addr_t addr)
205 {
206 struct omap_i2c_s *s = (struct omap_i2c_s *) opaque;
207 int offset = addr & OMAP_MPUI_REG_MASK;
208 uint16_t ret;
209
210 switch (offset) {
211 case 0x00: /* I2C_REV */
212 return s->revision; /* REV */
213
214 case 0x04: /* I2C_IE */
215 return s->mask;
216
217 case 0x08: /* I2C_STAT */
218 return s->stat | (i2c_bus_busy(s->bus) << 12);
219
220 case 0x0c: /* I2C_IV */
221 if (s->revision >= OMAP2_INTR_REV)
222 break;
223 ret = ffs(s->stat & s->mask);
224 if (ret)
225 s->stat ^= 1 << (ret - 1);
226 omap_i2c_interrupts_update(s);
227 return ret;
228
229 case 0x10: /* I2C_SYSS */
230 return (s->control >> 15) & 1; /* I2C_EN */
231
232 case 0x14: /* I2C_BUF */
233 return s->dma;
234
235 case 0x18: /* I2C_CNT */
236 return s->count_cur; /* DCOUNT */
237
238 case 0x1c: /* I2C_DATA */
239 ret = 0;
240 if (s->control & (1 << 14)) { /* BE */
241 ret |= ((s->fifo >> 0) & 0xff) << 8;
242 ret |= ((s->fifo >> 8) & 0xff) << 0;
243 } else {
244 ret |= ((s->fifo >> 8) & 0xff) << 8;
245 ret |= ((s->fifo >> 0) & 0xff) << 0;
246 }
247 if (s->rxlen == 1) {
248 s->stat |= 1 << 15; /* SBD */
249 s->rxlen = 0;
250 } else if (s->rxlen > 1) {
251 if (s->rxlen > 2)
252 s->fifo >>= 16;
253 s->rxlen -= 2;
254 } else
255 /* XXX: remote access (qualifier) error - what's that? */;
256 if (!s->rxlen) {
257 s->stat &= ~(1 << 3); /* RRDY */
258 if (((s->control >> 10) & 1) && /* MST */
259 ((~s->control >> 9) & 1)) { /* TRX */
260 s->stat |= 1 << 2; /* ARDY */
261 s->control &= ~(1 << 10); /* MST */
262 }
263 }
264 s->stat &= ~(1 << 11); /* ROVR */
265 omap_i2c_fifo_run(s);
266 omap_i2c_interrupts_update(s);
267 return ret;
268
269 case 0x20: /* I2C_SYSC */
270 return 0;
271
272 case 0x24: /* I2C_CON */
273 return s->control;
274
275 case 0x28: /* I2C_OA */
276 return s->addr[0];
277
278 case 0x2c: /* I2C_SA */
279 return s->addr[1];
280
281 case 0x30: /* I2C_PSC */
282 return s->divider;
283
284 case 0x34: /* I2C_SCLL */
285 return s->times[0];
286
287 case 0x38: /* I2C_SCLH */
288 return s->times[1];
289
290 case 0x3c: /* I2C_SYSTEST */
291 if (s->test & (1 << 15)) { /* ST_EN */
292 s->test ^= 0xa;
293 return s->test;
294 } else
295 return s->test & ~0x300f;
296 }
297
298 OMAP_BAD_REG(addr);
299 return 0;
300 }
301
302 static void omap_i2c_write(void *opaque, target_phys_addr_t addr,
303 uint32_t value)
304 {
305 struct omap_i2c_s *s = (struct omap_i2c_s *) opaque;
306 int offset = addr & OMAP_MPUI_REG_MASK;
307 int nack;
308
309 switch (offset) {
310 case 0x00: /* I2C_REV */
311 case 0x0c: /* I2C_IV */
312 case 0x10: /* I2C_SYSS */
313 OMAP_RO_REG(addr);
314 return;
315
316 case 0x04: /* I2C_IE */
317 s->mask = value & (s->revision < OMAP2_GC_REV ? 0x1f : 0x3f);
318 break;
319
320 case 0x08: /* I2C_STAT */
321 if (s->revision < OMAP2_INTR_REV) {
322 OMAP_RO_REG(addr);
323 return;
324 }
325
326 /* RRDY and XRDY are reset by hardware. (in all versions???) */
327 s->stat &= ~(value & 0x27);
328 omap_i2c_interrupts_update(s);
329 break;
330
331 case 0x14: /* I2C_BUF */
332 s->dma = value & 0x8080;
333 if (value & (1 << 15)) /* RDMA_EN */
334 s->mask &= ~(1 << 3); /* RRDY_IE */
335 if (value & (1 << 7)) /* XDMA_EN */
336 s->mask &= ~(1 << 4); /* XRDY_IE */
337 break;
338
339 case 0x18: /* I2C_CNT */
340 s->count = value; /* DCOUNT */
341 break;
342
343 case 0x1c: /* I2C_DATA */
344 if (s->txlen > 2) {
345 /* XXX: remote access (qualifier) error - what's that? */
346 break;
347 }
348 s->fifo <<= 16;
349 s->txlen += 2;
350 if (s->control & (1 << 14)) { /* BE */
351 s->fifo |= ((value >> 8) & 0xff) << 8;
352 s->fifo |= ((value >> 0) & 0xff) << 0;
353 } else {
354 s->fifo |= ((value >> 0) & 0xff) << 8;
355 s->fifo |= ((value >> 8) & 0xff) << 0;
356 }
357 s->stat &= ~(1 << 10); /* XUDF */
358 if (s->txlen > 2)
359 s->stat &= ~(1 << 4); /* XRDY */
360 omap_i2c_fifo_run(s);
361 omap_i2c_interrupts_update(s);
362 break;
363
364 case 0x20: /* I2C_SYSC */
365 if (s->revision < OMAP2_INTR_REV) {
366 OMAP_BAD_REG(addr);
367 return;
368 }
369
370 if (value & 2)
371 omap_i2c_reset(s);
372 break;
373
374 case 0x24: /* I2C_CON */
375 s->control = value & 0xcf87;
376 if (~value & (1 << 15)) { /* I2C_EN */
377 if (s->revision < OMAP2_INTR_REV)
378 omap_i2c_reset(s);
379 break;
380 }
381 if ((value & (1 << 15)) && !(value & (1 << 10))) { /* MST */
382 fprintf(stderr, "%s: I^2C slave mode not supported\n",
383 __FUNCTION__);
384 break;
385 }
386 if ((value & (1 << 15)) && value & (1 << 8)) { /* XA */
387 fprintf(stderr, "%s: 10-bit addressing mode not supported\n",
388 __FUNCTION__);
389 break;
390 }
391 if ((value & (1 << 15)) && value & (1 << 0)) { /* STT */
392 nack = !!i2c_start_transfer(s->bus, s->addr[1], /* SA */
393 (~value >> 9) & 1); /* TRX */
394 s->stat |= nack << 1; /* NACK */
395 s->control &= ~(1 << 0); /* STT */
396 s->fifo = 0;
397 if (nack)
398 s->control &= ~(1 << 1); /* STP */
399 else {
400 s->count_cur = s->count;
401 omap_i2c_fifo_run(s);
402 }
403 omap_i2c_interrupts_update(s);
404 }
405 break;
406
407 case 0x28: /* I2C_OA */
408 s->addr[0] = value & 0x3ff;
409 i2c_set_slave_address(&s->slave, value & 0x7f);
410 break;
411
412 case 0x2c: /* I2C_SA */
413 s->addr[1] = value & 0x3ff;
414 break;
415
416 case 0x30: /* I2C_PSC */
417 s->divider = value;
418 break;
419
420 case 0x34: /* I2C_SCLL */
421 s->times[0] = value;
422 break;
423
424 case 0x38: /* I2C_SCLH */
425 s->times[1] = value;
426 break;
427
428 case 0x3c: /* I2C_SYSTEST */
429 s->test = value & 0xf80f;
430 if (value & (1 << 11)) /* SBB */
431 if (s->revision >= OMAP2_INTR_REV) {
432 s->stat |= 0x3f;
433 omap_i2c_interrupts_update(s);
434 }
435 if (value & (1 << 15)) /* ST_EN */
436 fprintf(stderr, "%s: System Test not supported\n", __FUNCTION__);
437 break;
438
439 default:
440 OMAP_BAD_REG(addr);
441 return;
442 }
443 }
444
445 static void omap_i2c_writeb(void *opaque, target_phys_addr_t addr,
446 uint32_t value)
447 {
448 struct omap_i2c_s *s = (struct omap_i2c_s *) opaque;
449 int offset = addr & OMAP_MPUI_REG_MASK;
450
451 switch (offset) {
452 case 0x1c: /* I2C_DATA */
453 if (s->txlen > 2) {
454 /* XXX: remote access (qualifier) error - what's that? */
455 break;
456 }
457 s->fifo <<= 8;
458 s->txlen += 1;
459 s->fifo |= value & 0xff;
460 s->stat &= ~(1 << 10); /* XUDF */
461 if (s->txlen > 2)
462 s->stat &= ~(1 << 4); /* XRDY */
463 omap_i2c_fifo_run(s);
464 omap_i2c_interrupts_update(s);
465 break;
466
467 default:
468 OMAP_BAD_REG(addr);
469 return;
470 }
471 }
472
473 static CPUReadMemoryFunc *omap_i2c_readfn[] = {
474 omap_badwidth_read16,
475 omap_i2c_read,
476 omap_badwidth_read16,
477 };
478
479 static CPUWriteMemoryFunc *omap_i2c_writefn[] = {
480 omap_i2c_writeb, /* Only the last fifo write can be 8 bit. */
481 omap_i2c_write,
482 omap_badwidth_write16,
483 };
484
485 struct omap_i2c_s *omap_i2c_init(target_phys_addr_t base,
486 qemu_irq irq, qemu_irq *dma, omap_clk clk)
487 {
488 int iomemtype;
489 struct omap_i2c_s *s = (struct omap_i2c_s *)
490 qemu_mallocz(sizeof(struct omap_i2c_s));
491
492 /* TODO: set a value greater or equal to real hardware */
493 s->revision = 0x11;
494 s->irq = irq;
495 s->drq[0] = dma[0];
496 s->drq[1] = dma[1];
497 s->slave.event = omap_i2c_event;
498 s->slave.recv = omap_i2c_rx;
499 s->slave.send = omap_i2c_tx;
500 s->bus = i2c_init_bus();
501 omap_i2c_reset(s);
502
503 iomemtype = cpu_register_io_memory(0, omap_i2c_readfn,
504 omap_i2c_writefn, s);
505 cpu_register_physical_memory(base, 0x800, iomemtype);
506
507 return s;
508 }
509
510 struct omap_i2c_s *omap2_i2c_init(struct omap_target_agent_s *ta,
511 qemu_irq irq, qemu_irq *dma, omap_clk fclk, omap_clk iclk)
512 {
513 int iomemtype;
514 struct omap_i2c_s *s = (struct omap_i2c_s *)
515 qemu_mallocz(sizeof(struct omap_i2c_s));
516
517 s->revision = 0x34;
518 s->irq = irq;
519 s->drq[0] = dma[0];
520 s->drq[1] = dma[1];
521 s->slave.event = omap_i2c_event;
522 s->slave.recv = omap_i2c_rx;
523 s->slave.send = omap_i2c_tx;
524 s->bus = i2c_init_bus();
525 omap_i2c_reset(s);
526
527 iomemtype = l4_register_io_memory(0, omap_i2c_readfn,
528 omap_i2c_writefn, s);
529 omap_l4_attach(ta, 0, iomemtype);
530
531 return s;
532 }
533
534 i2c_bus *omap_i2c_bus(struct omap_i2c_s *s)
535 {
536 return s->bus;
537 }