root / hw / max111x.c @ 5dcb6b91
History | View | Annotate | Download (2.7 kB)
1 | c824cacd | balrog | /*
|
---|---|---|---|
2 | c824cacd | balrog | * Maxim MAX1110/1111 ADC chip emulation.
|
3 | c824cacd | balrog | *
|
4 | c824cacd | balrog | * Copyright (c) 2006 Openedhand Ltd.
|
5 | c824cacd | balrog | * Written by Andrzej Zaborowski <balrog@zabor.org>
|
6 | c824cacd | balrog | *
|
7 | c824cacd | balrog | * This code is licensed under the GNU GPLv2.
|
8 | c824cacd | balrog | */
|
9 | c824cacd | balrog | |
10 | c824cacd | balrog | #include <vl.h> |
11 | c824cacd | balrog | |
12 | c824cacd | balrog | struct max111x_s {
|
13 | c824cacd | balrog | qemu_irq interrupt; |
14 | c824cacd | balrog | uint8_t tb1, rb2, rb3; |
15 | c824cacd | balrog | int cycle;
|
16 | c824cacd | balrog | |
17 | c824cacd | balrog | int input[8]; |
18 | c824cacd | balrog | int inputs, com;
|
19 | c824cacd | balrog | }; |
20 | c824cacd | balrog | |
21 | c824cacd | balrog | /* Control-byte bitfields */
|
22 | c824cacd | balrog | #define CB_PD0 (1 << 0) |
23 | c824cacd | balrog | #define CB_PD1 (1 << 1) |
24 | c824cacd | balrog | #define CB_SGL (1 << 2) |
25 | c824cacd | balrog | #define CB_UNI (1 << 3) |
26 | c824cacd | balrog | #define CB_SEL0 (1 << 4) |
27 | c824cacd | balrog | #define CB_SEL1 (1 << 5) |
28 | c824cacd | balrog | #define CB_SEL2 (1 << 6) |
29 | c824cacd | balrog | #define CB_START (1 << 7) |
30 | c824cacd | balrog | |
31 | c824cacd | balrog | #define CHANNEL_NUM(v, b0, b1, b2) \
|
32 | c824cacd | balrog | ((((v) >> (2 + (b0))) & 4) | \ |
33 | c824cacd | balrog | (((v) >> (3 + (b1))) & 2) | \ |
34 | c824cacd | balrog | (((v) >> (4 + (b2))) & 1)) |
35 | c824cacd | balrog | |
36 | c824cacd | balrog | uint32_t max111x_read(void *opaque)
|
37 | c824cacd | balrog | { |
38 | c824cacd | balrog | struct max111x_s *s = (struct max111x_s *) opaque; |
39 | c824cacd | balrog | |
40 | c824cacd | balrog | if (!s->tb1)
|
41 | c824cacd | balrog | return 0; |
42 | c824cacd | balrog | |
43 | c824cacd | balrog | switch (s->cycle ++) {
|
44 | c824cacd | balrog | case 1: |
45 | c824cacd | balrog | return s->rb2;
|
46 | c824cacd | balrog | case 2: |
47 | c824cacd | balrog | return s->rb3;
|
48 | c824cacd | balrog | } |
49 | c824cacd | balrog | |
50 | c824cacd | balrog | return 0; |
51 | c824cacd | balrog | } |
52 | c824cacd | balrog | |
53 | c824cacd | balrog | /* Interpret a control-byte */
|
54 | c824cacd | balrog | void max111x_write(void *opaque, uint32_t value) |
55 | c824cacd | balrog | { |
56 | c824cacd | balrog | struct max111x_s *s = (struct max111x_s *) opaque; |
57 | c824cacd | balrog | int measure, chan;
|
58 | c824cacd | balrog | |
59 | c824cacd | balrog | /* Ignore the value if START bit is zero */
|
60 | c824cacd | balrog | if (!(value & CB_START))
|
61 | c824cacd | balrog | return;
|
62 | c824cacd | balrog | |
63 | c824cacd | balrog | s->cycle = 0;
|
64 | c824cacd | balrog | |
65 | c824cacd | balrog | if (!(value & CB_PD1)) {
|
66 | c824cacd | balrog | s->tb1 = 0;
|
67 | c824cacd | balrog | return;
|
68 | c824cacd | balrog | } |
69 | c824cacd | balrog | |
70 | c824cacd | balrog | s->tb1 = value; |
71 | c824cacd | balrog | |
72 | c824cacd | balrog | if (s->inputs == 8) |
73 | c824cacd | balrog | chan = CHANNEL_NUM(value, 1, 0, 2); |
74 | c824cacd | balrog | else
|
75 | c824cacd | balrog | chan = CHANNEL_NUM(value & ~CB_SEL0, 0, 1, 2); |
76 | c824cacd | balrog | |
77 | c824cacd | balrog | if (value & CB_SGL)
|
78 | c824cacd | balrog | measure = s->input[chan] - s->com; |
79 | c824cacd | balrog | else
|
80 | c824cacd | balrog | measure = s->input[chan] - s->input[chan ^ 1];
|
81 | c824cacd | balrog | |
82 | c824cacd | balrog | if (!(value & CB_UNI))
|
83 | c824cacd | balrog | measure ^= 0x80;
|
84 | c824cacd | balrog | |
85 | c824cacd | balrog | s->rb2 = (measure >> 2) & 0x3f; |
86 | c824cacd | balrog | s->rb3 = (measure << 6) & 0xc0; |
87 | c824cacd | balrog | |
88 | c824cacd | balrog | if (s->interrupt)
|
89 | c824cacd | balrog | qemu_irq_raise(s->interrupt); |
90 | c824cacd | balrog | } |
91 | c824cacd | balrog | |
92 | c824cacd | balrog | static struct max111x_s *max111x_init(qemu_irq cb) |
93 | c824cacd | balrog | { |
94 | c824cacd | balrog | struct max111x_s *s;
|
95 | c824cacd | balrog | s = (struct max111x_s *)
|
96 | c824cacd | balrog | qemu_mallocz(sizeof(struct max111x_s)); |
97 | c824cacd | balrog | memset(s, 0, sizeof(struct max111x_s)); |
98 | c824cacd | balrog | |
99 | c824cacd | balrog | s->interrupt = cb; |
100 | c824cacd | balrog | |
101 | c824cacd | balrog | /* TODO: add a user interface for setting these */
|
102 | c824cacd | balrog | s->input[0] = 0xf0; |
103 | c824cacd | balrog | s->input[1] = 0xe0; |
104 | c824cacd | balrog | s->input[2] = 0xd0; |
105 | c824cacd | balrog | s->input[3] = 0xc0; |
106 | c824cacd | balrog | s->input[4] = 0xb0; |
107 | c824cacd | balrog | s->input[5] = 0xa0; |
108 | c824cacd | balrog | s->input[6] = 0x90; |
109 | c824cacd | balrog | s->input[7] = 0x80; |
110 | c824cacd | balrog | s->com = 0;
|
111 | c824cacd | balrog | return s;
|
112 | c824cacd | balrog | } |
113 | c824cacd | balrog | |
114 | c824cacd | balrog | struct max111x_s *max1110_init(qemu_irq cb)
|
115 | c824cacd | balrog | { |
116 | c824cacd | balrog | struct max111x_s *s = max111x_init(cb);
|
117 | c824cacd | balrog | s->inputs = 8;
|
118 | c824cacd | balrog | return s;
|
119 | c824cacd | balrog | } |
120 | c824cacd | balrog | |
121 | c824cacd | balrog | struct max111x_s *max1111_init(qemu_irq cb)
|
122 | c824cacd | balrog | { |
123 | c824cacd | balrog | struct max111x_s *s = max111x_init(cb);
|
124 | c824cacd | balrog | s->inputs = 4;
|
125 | c824cacd | balrog | return s;
|
126 | c824cacd | balrog | } |
127 | c824cacd | balrog | |
128 | c824cacd | balrog | void max111x_set_input(struct max111x_s *s, int line, uint8_t value) |
129 | c824cacd | balrog | { |
130 | c824cacd | balrog | if (line >= s->inputs) {
|
131 | c824cacd | balrog | printf("%s: There's no input %i\n", __FUNCTION__, line);
|
132 | c824cacd | balrog | return;
|
133 | c824cacd | balrog | } |
134 | c824cacd | balrog | |
135 | c824cacd | balrog | s->input[line] = value; |
136 | c824cacd | balrog | } |