Refactor aio callback allocation to use an aiocb pool (Avi Kivity)
[sniper_test.git] / hw / cbus.c
blobba8afe56c5e9a7efc8d238430d72fd736208fd2a
1 /*
2 * CBUS three-pin bus and the Retu / Betty / Tahvo / Vilma / Avilma /
3 * Hinku / Vinku / Ahne / Pihi chips used in various Nokia platforms.
4 * Based on reverse-engineering of a linux driver.
6 * Copyright (C) 2008 Nokia Corporation
7 * Written by Andrzej Zaborowski <andrew@openedhand.com>
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License as
11 * published by the Free Software Foundation; either version 2 or
12 * (at your option) version 3 of the License.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License along
20 * with this program; if not, write to the Free Software Foundation, Inc.,
21 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
24 #include "qemu-common.h"
25 #include "irq.h"
26 #include "devices.h"
27 #include "sysemu.h"
29 //#define DEBUG
31 struct cbus_slave_s;
32 struct cbus_priv_s {
33 struct cbus_s cbus;
35 int sel;
36 int dat;
37 int clk;
38 int bit;
39 int dir;
40 uint16_t val;
41 qemu_irq dat_out;
43 int addr;
44 int reg;
45 int rw;
46 enum {
47 cbus_address,
48 cbus_value,
49 } cycle;
51 struct cbus_slave_s *slave[8];
54 struct cbus_slave_s {
55 void *opaque;
56 void (*io)(void *opaque, int rw, int reg, uint16_t *val);
57 int addr;
60 static void cbus_io(struct cbus_priv_s *s)
62 if (s->slave[s->addr])
63 s->slave[s->addr]->io(s->slave[s->addr]->opaque,
64 s->rw, s->reg, &s->val);
65 else
66 cpu_abort(cpu_single_env, "%s: bad slave address %i\n",
67 __FUNCTION__, s->addr);
70 static void cbus_cycle(struct cbus_priv_s *s)
72 switch (s->cycle) {
73 case cbus_address:
74 s->addr = (s->val >> 6) & 7;
75 s->rw = (s->val >> 5) & 1;
76 s->reg = (s->val >> 0) & 0x1f;
78 s->cycle = cbus_value;
79 s->bit = 15;
80 s->dir = !s->rw;
81 s->val = 0;
83 if (s->rw)
84 cbus_io(s);
85 break;
87 case cbus_value:
88 if (!s->rw)
89 cbus_io(s);
91 s->cycle = cbus_address;
92 s->bit = 8;
93 s->dir = 1;
94 s->val = 0;
95 break;
99 static void cbus_clk(void *opaque, int line, int level)
101 struct cbus_priv_s *s = (struct cbus_priv_s *) opaque;
103 if (!s->sel && level && !s->clk) {
104 if (s->dir)
105 s->val |= s->dat << (s->bit --);
106 else
107 qemu_set_irq(s->dat_out, (s->val >> (s->bit --)) & 1);
109 if (s->bit < 0)
110 cbus_cycle(s);
113 s->clk = level;
116 static void cbus_dat(void *opaque, int line, int level)
118 struct cbus_priv_s *s = (struct cbus_priv_s *) opaque;
120 s->dat = level;
123 static void cbus_sel(void *opaque, int line, int level)
125 struct cbus_priv_s *s = (struct cbus_priv_s *) opaque;
127 if (!level) {
128 s->dir = 1;
129 s->bit = 8;
130 s->val = 0;
133 s->sel = level;
136 struct cbus_s *cbus_init(qemu_irq dat)
138 struct cbus_priv_s *s = (struct cbus_priv_s *) qemu_mallocz(sizeof(*s));
140 s->dat_out = dat;
141 s->cbus.clk = qemu_allocate_irqs(cbus_clk, s, 1)[0];
142 s->cbus.dat = qemu_allocate_irqs(cbus_dat, s, 1)[0];
143 s->cbus.sel = qemu_allocate_irqs(cbus_sel, s, 1)[0];
145 s->sel = 1;
146 s->clk = 0;
147 s->dat = 0;
149 return &s->cbus;
152 void cbus_attach(struct cbus_s *bus, void *slave_opaque)
154 struct cbus_slave_s *slave = (struct cbus_slave_s *) slave_opaque;
155 struct cbus_priv_s *s = (struct cbus_priv_s *) bus;
157 s->slave[slave->addr] = slave;
160 /* Retu/Vilma */
161 struct cbus_retu_s {
162 uint16_t irqst;
163 uint16_t irqen;
164 uint16_t cc[2];
165 int channel;
166 uint16_t result[16];
167 uint16_t sample;
168 uint16_t status;
170 struct {
171 uint16_t cal;
172 } rtc;
174 int is_vilma;
175 qemu_irq irq;
176 struct cbus_slave_s cbus;
179 static void retu_interrupt_update(struct cbus_retu_s *s)
181 qemu_set_irq(s->irq, s->irqst & ~s->irqen);
184 #define RETU_REG_ASICR 0x00 /* (RO) ASIC ID & revision */
185 #define RETU_REG_IDR 0x01 /* (T) Interrupt ID */
186 #define RETU_REG_IMR 0x02 /* (RW) Interrupt mask */
187 #define RETU_REG_RTCDSR 0x03 /* (RW) RTC seconds register */
188 #define RETU_REG_RTCHMR 0x04 /* (RO) RTC hours and minutes reg */
189 #define RETU_REG_RTCHMAR 0x05 /* (RW) RTC hours and minutes set reg */
190 #define RETU_REG_RTCCALR 0x06 /* (RW) RTC calibration register */
191 #define RETU_REG_ADCR 0x08 /* (RW) ADC result register */
192 #define RETU_REG_ADCSCR 0x09 /* (RW) ADC sample control register */
193 #define RETU_REG_AFCR 0x0a /* (RW) AFC register */
194 #define RETU_REG_ANTIFR 0x0b /* (RW) AntiF register */
195 #define RETU_REG_CALIBR 0x0c /* (RW) CalibR register*/
196 #define RETU_REG_CCR1 0x0d /* (RW) Common control register 1 */
197 #define RETU_REG_CCR2 0x0e /* (RW) Common control register 2 */
198 #define RETU_REG_RCTRL_CLR 0x0f /* (T) Regulator clear register */
199 #define RETU_REG_RCTRL_SET 0x10 /* (T) Regulator set register */
200 #define RETU_REG_TXCR 0x11 /* (RW) TxC register */
201 #define RETU_REG_STATUS 0x16 /* (RO) Status register */
202 #define RETU_REG_WATCHDOG 0x17 /* (RW) Watchdog register */
203 #define RETU_REG_AUDTXR 0x18 /* (RW) Audio Codec Tx register */
204 #define RETU_REG_AUDPAR 0x19 /* (RW) AudioPA register */
205 #define RETU_REG_AUDRXR1 0x1a /* (RW) Audio receive register 1 */
206 #define RETU_REG_AUDRXR2 0x1b /* (RW) Audio receive register 2 */
207 #define RETU_REG_SGR1 0x1c /* (RW) */
208 #define RETU_REG_SCR1 0x1d /* (RW) */
209 #define RETU_REG_SGR2 0x1e /* (RW) */
210 #define RETU_REG_SCR2 0x1f /* (RW) */
212 /* Retu Interrupt sources */
213 enum {
214 retu_int_pwr = 0, /* Power button */
215 retu_int_char = 1, /* Charger */
216 retu_int_rtcs = 2, /* Seconds */
217 retu_int_rtcm = 3, /* Minutes */
218 retu_int_rtcd = 4, /* Days */
219 retu_int_rtca = 5, /* Alarm */
220 retu_int_hook = 6, /* Hook */
221 retu_int_head = 7, /* Headset */
222 retu_int_adcs = 8, /* ADC sample */
225 /* Retu ADC channel wiring */
226 enum {
227 retu_adc_bsi = 1, /* BSI */
228 retu_adc_batt_temp = 2, /* Battery temperature */
229 retu_adc_chg_volt = 3, /* Charger voltage */
230 retu_adc_head_det = 4, /* Headset detection */
231 retu_adc_hook_det = 5, /* Hook detection */
232 retu_adc_rf_gp = 6, /* RF GP */
233 retu_adc_tx_det = 7, /* Wideband Tx detection */
234 retu_adc_batt_volt = 8, /* Battery voltage */
235 retu_adc_sens = 10, /* Light sensor */
236 retu_adc_sens_temp = 11, /* Light sensor temperature */
237 retu_adc_bbatt_volt = 12, /* Backup battery voltage */
238 retu_adc_self_temp = 13, /* RETU temperature */
241 static inline uint16_t retu_read(struct cbus_retu_s *s, int reg)
243 #ifdef DEBUG
244 printf("RETU read at %02x\n", reg);
245 #endif
247 switch (reg) {
248 case RETU_REG_ASICR:
249 return 0x0215 | (s->is_vilma << 7);
251 case RETU_REG_IDR: /* TODO: Or is this ffs(s->irqst)? */
252 return s->irqst;
254 case RETU_REG_IMR:
255 return s->irqen;
257 case RETU_REG_RTCDSR:
258 case RETU_REG_RTCHMR:
259 case RETU_REG_RTCHMAR:
260 /* TODO */
261 return 0x0000;
263 case RETU_REG_RTCCALR:
264 return s->rtc.cal;
266 case RETU_REG_ADCR:
267 return (s->channel << 10) | s->result[s->channel];
268 case RETU_REG_ADCSCR:
269 return s->sample;
271 case RETU_REG_AFCR:
272 case RETU_REG_ANTIFR:
273 case RETU_REG_CALIBR:
274 /* TODO */
275 return 0x0000;
277 case RETU_REG_CCR1:
278 return s->cc[0];
279 case RETU_REG_CCR2:
280 return s->cc[1];
282 case RETU_REG_RCTRL_CLR:
283 case RETU_REG_RCTRL_SET:
284 case RETU_REG_TXCR:
285 /* TODO */
286 return 0x0000;
288 case RETU_REG_STATUS:
289 return s->status;
291 case RETU_REG_WATCHDOG:
292 case RETU_REG_AUDTXR:
293 case RETU_REG_AUDPAR:
294 case RETU_REG_AUDRXR1:
295 case RETU_REG_AUDRXR2:
296 case RETU_REG_SGR1:
297 case RETU_REG_SCR1:
298 case RETU_REG_SGR2:
299 case RETU_REG_SCR2:
300 /* TODO */
301 return 0x0000;
303 default:
304 cpu_abort(cpu_single_env, "%s: bad register %02x\n",
305 __FUNCTION__, reg);
309 static inline void retu_write(struct cbus_retu_s *s, int reg, uint16_t val)
311 #ifdef DEBUG
312 printf("RETU write of %04x at %02x\n", val, reg);
313 #endif
315 switch (reg) {
316 case RETU_REG_IDR:
317 s->irqst ^= val;
318 retu_interrupt_update(s);
319 break;
321 case RETU_REG_IMR:
322 s->irqen = val;
323 retu_interrupt_update(s);
324 break;
326 case RETU_REG_RTCDSR:
327 case RETU_REG_RTCHMAR:
328 /* TODO */
329 break;
331 case RETU_REG_RTCCALR:
332 s->rtc.cal = val;
333 break;
335 case RETU_REG_ADCR:
336 s->channel = (val >> 10) & 0xf;
337 s->irqst |= 1 << retu_int_adcs;
338 retu_interrupt_update(s);
339 break;
340 case RETU_REG_ADCSCR:
341 s->sample &= ~val;
342 break;
344 case RETU_REG_AFCR:
345 case RETU_REG_ANTIFR:
346 case RETU_REG_CALIBR:
348 case RETU_REG_CCR1:
349 s->cc[0] = val;
350 break;
351 case RETU_REG_CCR2:
352 s->cc[1] = val;
353 break;
355 case RETU_REG_RCTRL_CLR:
356 case RETU_REG_RCTRL_SET:
357 /* TODO */
358 break;
360 case RETU_REG_WATCHDOG:
361 if (val == 0 && (s->cc[0] & 2))
362 qemu_system_shutdown_request();
363 break;
365 case RETU_REG_TXCR:
366 case RETU_REG_AUDTXR:
367 case RETU_REG_AUDPAR:
368 case RETU_REG_AUDRXR1:
369 case RETU_REG_AUDRXR2:
370 case RETU_REG_SGR1:
371 case RETU_REG_SCR1:
372 case RETU_REG_SGR2:
373 case RETU_REG_SCR2:
374 /* TODO */
375 break;
377 default:
378 cpu_abort(cpu_single_env, "%s: bad register %02x\n",
379 __FUNCTION__, reg);
383 static void retu_io(void *opaque, int rw, int reg, uint16_t *val)
385 struct cbus_retu_s *s = (struct cbus_retu_s *) opaque;
387 if (rw)
388 *val = retu_read(s, reg);
389 else
390 retu_write(s, reg, *val);
393 void *retu_init(qemu_irq irq, int vilma)
395 struct cbus_retu_s *s = (struct cbus_retu_s *) qemu_mallocz(sizeof(*s));
397 s->irq = irq;
398 s->irqen = 0xffff;
399 s->irqst = 0x0000;
400 s->status = 0x0020;
401 s->is_vilma = !!vilma;
402 s->rtc.cal = 0x01;
403 s->result[retu_adc_bsi] = 0x3c2;
404 s->result[retu_adc_batt_temp] = 0x0fc;
405 s->result[retu_adc_chg_volt] = 0x165;
406 s->result[retu_adc_head_det] = 123;
407 s->result[retu_adc_hook_det] = 1023;
408 s->result[retu_adc_rf_gp] = 0x11;
409 s->result[retu_adc_tx_det] = 0x11;
410 s->result[retu_adc_batt_volt] = 0x250;
411 s->result[retu_adc_sens] = 2;
412 s->result[retu_adc_sens_temp] = 0x11;
413 s->result[retu_adc_bbatt_volt] = 0x3d0;
414 s->result[retu_adc_self_temp] = 0x330;
416 s->cbus.opaque = s;
417 s->cbus.io = retu_io;
418 s->cbus.addr = 1;
420 return &s->cbus;
423 void retu_key_event(void *retu, int state)
425 struct cbus_slave_s *slave = (struct cbus_slave_s *) retu;
426 struct cbus_retu_s *s = (struct cbus_retu_s *) slave->opaque;
428 s->irqst |= 1 << retu_int_pwr;
429 retu_interrupt_update(s);
431 if (state)
432 s->status &= ~(1 << 5);
433 else
434 s->status |= 1 << 5;
437 #if 0
438 static void retu_head_event(void *retu, int state)
440 struct cbus_slave_s *slave = (struct cbus_slave_s *) retu;
441 struct cbus_retu_s *s = (struct cbus_retu_s *) slave->opaque;
443 if ((s->cc[0] & 0x500) == 0x500) { /* TODO: Which bits? */
444 /* TODO: reissue the interrupt every 100ms or so. */
445 s->irqst |= 1 << retu_int_head;
446 retu_interrupt_update(s);
449 if (state)
450 s->result[retu_adc_head_det] = 50;
451 else
452 s->result[retu_adc_head_det] = 123;
455 static void retu_hook_event(void *retu, int state)
457 struct cbus_slave_s *slave = (struct cbus_slave_s *) retu;
458 struct cbus_retu_s *s = (struct cbus_retu_s *) slave->opaque;
460 if ((s->cc[0] & 0x500) == 0x500) {
461 /* TODO: reissue the interrupt every 100ms or so. */
462 s->irqst |= 1 << retu_int_hook;
463 retu_interrupt_update(s);
466 if (state)
467 s->result[retu_adc_hook_det] = 50;
468 else
469 s->result[retu_adc_hook_det] = 123;
471 #endif
473 /* Tahvo/Betty */
474 struct cbus_tahvo_s {
475 uint16_t irqst;
476 uint16_t irqen;
477 uint8_t charger;
478 uint8_t backlight;
479 uint16_t usbr;
480 uint16_t power;
482 int is_betty;
483 qemu_irq irq;
484 struct cbus_slave_s cbus;
487 static void tahvo_interrupt_update(struct cbus_tahvo_s *s)
489 qemu_set_irq(s->irq, s->irqst & ~s->irqen);
492 #define TAHVO_REG_ASICR 0x00 /* (RO) ASIC ID & revision */
493 #define TAHVO_REG_IDR 0x01 /* (T) Interrupt ID */
494 #define TAHVO_REG_IDSR 0x02 /* (RO) Interrupt status */
495 #define TAHVO_REG_IMR 0x03 /* (RW) Interrupt mask */
496 #define TAHVO_REG_CHAPWMR 0x04 /* (RW) Charger PWM */
497 #define TAHVO_REG_LEDPWMR 0x05 /* (RW) LED PWM */
498 #define TAHVO_REG_USBR 0x06 /* (RW) USB control */
499 #define TAHVO_REG_RCR 0x07 /* (RW) Some kind of power management */
500 #define TAHVO_REG_CCR1 0x08 /* (RW) Common control register 1 */
501 #define TAHVO_REG_CCR2 0x09 /* (RW) Common control register 2 */
502 #define TAHVO_REG_TESTR1 0x0a /* (RW) Test register 1 */
503 #define TAHVO_REG_TESTR2 0x0b /* (RW) Test register 2 */
504 #define TAHVO_REG_NOPR 0x0c /* (RW) Number of periods */
505 #define TAHVO_REG_FRR 0x0d /* (RO) FR */
507 static inline uint16_t tahvo_read(struct cbus_tahvo_s *s, int reg)
509 #ifdef DEBUG
510 printf("TAHVO read at %02x\n", reg);
511 #endif
513 switch (reg) {
514 case TAHVO_REG_ASICR:
515 return 0x0021 | (s->is_betty ? 0x0b00 : 0x0300); /* 22 in N810 */
517 case TAHVO_REG_IDR:
518 case TAHVO_REG_IDSR: /* XXX: what does this do? */
519 return s->irqst;
521 case TAHVO_REG_IMR:
522 return s->irqen;
524 case TAHVO_REG_CHAPWMR:
525 return s->charger;
527 case TAHVO_REG_LEDPWMR:
528 return s->backlight;
530 case TAHVO_REG_USBR:
531 return s->usbr;
533 case TAHVO_REG_RCR:
534 return s->power;
536 case TAHVO_REG_CCR1:
537 case TAHVO_REG_CCR2:
538 case TAHVO_REG_TESTR1:
539 case TAHVO_REG_TESTR2:
540 case TAHVO_REG_NOPR:
541 case TAHVO_REG_FRR:
542 return 0x0000;
544 default:
545 cpu_abort(cpu_single_env, "%s: bad register %02x\n",
546 __FUNCTION__, reg);
550 static inline void tahvo_write(struct cbus_tahvo_s *s, int reg, uint16_t val)
552 #ifdef DEBUG
553 printf("TAHVO write of %04x at %02x\n", val, reg);
554 #endif
556 switch (reg) {
557 case TAHVO_REG_IDR:
558 s->irqst ^= val;
559 tahvo_interrupt_update(s);
560 break;
562 case TAHVO_REG_IMR:
563 s->irqen = val;
564 tahvo_interrupt_update(s);
565 break;
567 case TAHVO_REG_CHAPWMR:
568 s->charger = val;
569 break;
571 case TAHVO_REG_LEDPWMR:
572 if (s->backlight != (val & 0x7f)) {
573 s->backlight = val & 0x7f;
574 printf("%s: LCD backlight now at %i / 127\n",
575 __FUNCTION__, s->backlight);
577 break;
579 case TAHVO_REG_USBR:
580 s->usbr = val;
581 break;
583 case TAHVO_REG_RCR:
584 s->power = val;
585 break;
587 case TAHVO_REG_CCR1:
588 case TAHVO_REG_CCR2:
589 case TAHVO_REG_TESTR1:
590 case TAHVO_REG_TESTR2:
591 case TAHVO_REG_NOPR:
592 case TAHVO_REG_FRR:
593 break;
595 default:
596 cpu_abort(cpu_single_env, "%s: bad register %02x\n",
597 __FUNCTION__, reg);
601 static void tahvo_io(void *opaque, int rw, int reg, uint16_t *val)
603 struct cbus_tahvo_s *s = (struct cbus_tahvo_s *) opaque;
605 if (rw)
606 *val = tahvo_read(s, reg);
607 else
608 tahvo_write(s, reg, *val);
611 void *tahvo_init(qemu_irq irq, int betty)
613 struct cbus_tahvo_s *s = (struct cbus_tahvo_s *) qemu_mallocz(sizeof(*s));
615 s->irq = irq;
616 s->irqen = 0xffff;
617 s->irqst = 0x0000;
618 s->is_betty = !!betty;
620 s->cbus.opaque = s;
621 s->cbus.io = tahvo_io;
622 s->cbus.addr = 2;
624 return &s->cbus;