1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include "qemu/osdep.h"
24#include "hw/char/bcm2835_aux.h"
25#include "hw/irq.h"
26#include "hw/qdev-properties.h"
27#include "migration/vmstate.h"
28#include "qemu/log.h"
29#include "qemu/module.h"
30
31#define AUX_IRQ 0x0
32#define AUX_ENABLES 0x4
33#define AUX_MU_IO_REG 0x40
34#define AUX_MU_IER_REG 0x44
35#define AUX_MU_IIR_REG 0x48
36#define AUX_MU_LCR_REG 0x4c
37#define AUX_MU_MCR_REG 0x50
38#define AUX_MU_LSR_REG 0x54
39#define AUX_MU_MSR_REG 0x58
40#define AUX_MU_SCRATCH 0x5c
41#define AUX_MU_CNTL_REG 0x60
42#define AUX_MU_STAT_REG 0x64
43#define AUX_MU_BAUD_REG 0x68
44
45
46#define RX_INT 0x1
47#define TX_INT 0x2
48
49static void bcm2835_aux_update(BCM2835AuxState *s)
50{
51
52
53
54
55 s->iir = 0;
56 if ((s->ier & RX_INT) && s->read_count != 0) {
57 s->iir |= RX_INT;
58 }
59 if (s->ier & TX_INT) {
60 s->iir |= TX_INT;
61 }
62 qemu_set_irq(s->irq, s->iir != 0);
63}
64
65static uint64_t bcm2835_aux_read(void *opaque, hwaddr offset, unsigned size)
66{
67 BCM2835AuxState *s = opaque;
68 uint32_t c, res;
69
70 switch (offset) {
71 case AUX_IRQ:
72 return s->iir != 0;
73
74 case AUX_ENABLES:
75 return 1;
76
77 case AUX_MU_IO_REG:
78
79 c = s->read_fifo[s->read_pos];
80 if (s->read_count > 0) {
81 s->read_count--;
82 if (++s->read_pos == BCM2835_AUX_RX_FIFO_LEN) {
83 s->read_pos = 0;
84 }
85 }
86 qemu_chr_fe_accept_input(&s->chr);
87 bcm2835_aux_update(s);
88 return c;
89
90 case AUX_MU_IER_REG:
91
92 return 0xc0 | s->ier;
93
94 case AUX_MU_IIR_REG:
95 res = 0xc0;
96
97
98
99
100 if (s->read_count != 0) {
101 res |= 0x4;
102 } else {
103 res |= 0x2;
104 }
105 if (s->iir == 0) {
106 res |= 0x1;
107 }
108 return res;
109
110 case AUX_MU_LCR_REG:
111 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_LCR_REG unsupported\n", __func__);
112 return 0;
113
114 case AUX_MU_MCR_REG:
115 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_MCR_REG unsupported\n", __func__);
116 return 0;
117
118 case AUX_MU_LSR_REG:
119 res = 0x60;
120 if (s->read_count != 0) {
121 res |= 0x1;
122 }
123 return res;
124
125 case AUX_MU_MSR_REG:
126 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_MSR_REG unsupported\n", __func__);
127 return 0;
128
129 case AUX_MU_SCRATCH:
130 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_SCRATCH unsupported\n", __func__);
131 return 0;
132
133 case AUX_MU_CNTL_REG:
134 return 0x3;
135
136 case AUX_MU_STAT_REG:
137 res = 0x30e;
138 if (s->read_count > 0) {
139 res |= 0x1;
140 assert(s->read_count < BCM2835_AUX_RX_FIFO_LEN);
141 res |= ((uint32_t)s->read_count) << 16;
142 }
143 return res;
144
145 case AUX_MU_BAUD_REG:
146 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_BAUD_REG unsupported\n", __func__);
147 return 0;
148
149 default:
150 qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset %"HWADDR_PRIx"\n",
151 __func__, offset);
152 return 0;
153 }
154}
155
156static void bcm2835_aux_write(void *opaque, hwaddr offset, uint64_t value,
157 unsigned size)
158{
159 BCM2835AuxState *s = opaque;
160 unsigned char ch;
161
162 switch (offset) {
163 case AUX_ENABLES:
164 if (value != 1) {
165 qemu_log_mask(LOG_UNIMP, "%s: unsupported attempt to enable SPI"
166 " or disable UART: 0x%"PRIx64"\n",
167 __func__, value);
168 }
169 break;
170
171 case AUX_MU_IO_REG:
172
173 ch = value;
174
175
176 qemu_chr_fe_write_all(&s->chr, &ch, 1);
177 break;
178
179 case AUX_MU_IER_REG:
180
181 s->ier = value & (TX_INT | RX_INT);
182 bcm2835_aux_update(s);
183 break;
184
185 case AUX_MU_IIR_REG:
186 if (value & 0x2) {
187 s->read_count = 0;
188 }
189 break;
190
191 case AUX_MU_LCR_REG:
192 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_LCR_REG unsupported\n", __func__);
193 break;
194
195 case AUX_MU_MCR_REG:
196 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_MCR_REG unsupported\n", __func__);
197 break;
198
199 case AUX_MU_SCRATCH:
200 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_SCRATCH unsupported\n", __func__);
201 break;
202
203 case AUX_MU_CNTL_REG:
204 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_CNTL_REG unsupported\n", __func__);
205 break;
206
207 case AUX_MU_BAUD_REG:
208 qemu_log_mask(LOG_UNIMP, "%s: AUX_MU_BAUD_REG unsupported\n", __func__);
209 break;
210
211 default:
212 qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset %"HWADDR_PRIx"\n",
213 __func__, offset);
214 }
215
216 bcm2835_aux_update(s);
217}
218
219static int bcm2835_aux_can_receive(void *opaque)
220{
221 BCM2835AuxState *s = opaque;
222
223 return s->read_count < BCM2835_AUX_RX_FIFO_LEN;
224}
225
226static void bcm2835_aux_put_fifo(void *opaque, uint8_t value)
227{
228 BCM2835AuxState *s = opaque;
229 int slot;
230
231 slot = s->read_pos + s->read_count;
232 if (slot >= BCM2835_AUX_RX_FIFO_LEN) {
233 slot -= BCM2835_AUX_RX_FIFO_LEN;
234 }
235 s->read_fifo[slot] = value;
236 s->read_count++;
237 if (s->read_count == BCM2835_AUX_RX_FIFO_LEN) {
238
239 }
240 bcm2835_aux_update(s);
241}
242
243static void bcm2835_aux_receive(void *opaque, const uint8_t *buf, int size)
244{
245 bcm2835_aux_put_fifo(opaque, *buf);
246}
247
248static const MemoryRegionOps bcm2835_aux_ops = {
249 .read = bcm2835_aux_read,
250 .write = bcm2835_aux_write,
251 .endianness = DEVICE_NATIVE_ENDIAN,
252 .valid.min_access_size = 4,
253 .valid.max_access_size = 4,
254};
255
256static const VMStateDescription vmstate_bcm2835_aux = {
257 .name = TYPE_BCM2835_AUX,
258 .version_id = 1,
259 .minimum_version_id = 1,
260 .fields = (VMStateField[]) {
261 VMSTATE_UINT8_ARRAY(read_fifo, BCM2835AuxState,
262 BCM2835_AUX_RX_FIFO_LEN),
263 VMSTATE_UINT8(read_pos, BCM2835AuxState),
264 VMSTATE_UINT8(read_count, BCM2835AuxState),
265 VMSTATE_UINT8(ier, BCM2835AuxState),
266 VMSTATE_UINT8(iir, BCM2835AuxState),
267 VMSTATE_END_OF_LIST()
268 }
269};
270
271static void bcm2835_aux_init(Object *obj)
272{
273 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
274 BCM2835AuxState *s = BCM2835_AUX(obj);
275
276 memory_region_init_io(&s->iomem, OBJECT(s), &bcm2835_aux_ops, s,
277 TYPE_BCM2835_AUX, 0x100);
278 sysbus_init_mmio(sbd, &s->iomem);
279 sysbus_init_irq(sbd, &s->irq);
280}
281
282static void bcm2835_aux_realize(DeviceState *dev, Error **errp)
283{
284 BCM2835AuxState *s = BCM2835_AUX(dev);
285
286 qemu_chr_fe_set_handlers(&s->chr, bcm2835_aux_can_receive,
287 bcm2835_aux_receive, NULL, NULL, s, NULL, true);
288}
289
290static Property bcm2835_aux_props[] = {
291 DEFINE_PROP_CHR("chardev", BCM2835AuxState, chr),
292 DEFINE_PROP_END_OF_LIST(),
293};
294
295static void bcm2835_aux_class_init(ObjectClass *oc, void *data)
296{
297 DeviceClass *dc = DEVICE_CLASS(oc);
298
299 dc->realize = bcm2835_aux_realize;
300 dc->vmsd = &vmstate_bcm2835_aux;
301 set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
302 dc->props = bcm2835_aux_props;
303}
304
305static const TypeInfo bcm2835_aux_info = {
306 .name = TYPE_BCM2835_AUX,
307 .parent = TYPE_SYS_BUS_DEVICE,
308 .instance_size = sizeof(BCM2835AuxState),
309 .instance_init = bcm2835_aux_init,
310 .class_init = bcm2835_aux_class_init,
311};
312
313static void bcm2835_aux_register_types(void)
314{
315 type_register_static(&bcm2835_aux_info);
316}
317
318type_init(bcm2835_aux_register_types)
319