1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "qemu/osdep.h"
26#include "hw/input/adb.h"
27#include "hw/qdev-properties.h"
28#include "migration/vmstate.h"
29#include "qemu/module.h"
30#include "adb-internal.h"
31
32
33#define ADB_RET_NOTPRESENT (-2)
34
35static void adb_device_reset(ADBDevice *d)
36{
37 qdev_reset_all(DEVICE(d));
38}
39
40int adb_request(ADBBusState *s, uint8_t *obuf, const uint8_t *buf, int len)
41{
42 ADBDevice *d;
43 int devaddr, cmd, i;
44
45 cmd = buf[0] & 0xf;
46 if (cmd == ADB_BUSRESET) {
47 for(i = 0; i < s->nb_devices; i++) {
48 d = s->devices[i];
49 adb_device_reset(d);
50 }
51 return 0;
52 }
53 devaddr = buf[0] >> 4;
54 for(i = 0; i < s->nb_devices; i++) {
55 d = s->devices[i];
56 if (d->devaddr == devaddr) {
57 ADBDeviceClass *adc = ADB_DEVICE_GET_CLASS(d);
58 return adc->devreq(d, obuf, buf, len);
59 }
60 }
61 return ADB_RET_NOTPRESENT;
62}
63
64
65int adb_poll(ADBBusState *s, uint8_t *obuf, uint16_t poll_mask)
66{
67 ADBDevice *d;
68 int olen, i;
69 uint8_t buf[1];
70
71 olen = 0;
72 for(i = 0; i < s->nb_devices; i++) {
73 if (s->poll_index >= s->nb_devices)
74 s->poll_index = 0;
75 d = s->devices[s->poll_index];
76 if ((1 << d->devaddr) & poll_mask) {
77 buf[0] = ADB_READREG | (d->devaddr << 4);
78 olen = adb_request(s, obuf + 1, buf, 1);
79
80 if (olen > 0) {
81 obuf[0] = buf[0];
82 olen++;
83 break;
84 }
85 }
86 s->poll_index++;
87 }
88 return olen;
89}
90
91static const TypeInfo adb_bus_type_info = {
92 .name = TYPE_ADB_BUS,
93 .parent = TYPE_BUS,
94 .instance_size = sizeof(ADBBusState),
95};
96
97const VMStateDescription vmstate_adb_device = {
98 .name = "adb_device",
99 .version_id = 0,
100 .minimum_version_id = 0,
101 .fields = (VMStateField[]) {
102 VMSTATE_INT32(devaddr, ADBDevice),
103 VMSTATE_INT32(handler, ADBDevice),
104 VMSTATE_END_OF_LIST()
105 }
106};
107
108static void adb_device_realizefn(DeviceState *dev, Error **errp)
109{
110 ADBDevice *d = ADB_DEVICE(dev);
111 ADBBusState *bus = ADB_BUS(qdev_get_parent_bus(dev));
112
113 if (bus->nb_devices >= MAX_ADB_DEVICES) {
114 return;
115 }
116
117 bus->devices[bus->nb_devices++] = d;
118}
119
120static Property adb_device_properties[] = {
121 DEFINE_PROP_BOOL("disable-direct-reg3-writes", ADBDevice,
122 disable_direct_reg3_writes, false),
123 DEFINE_PROP_END_OF_LIST(),
124};
125
126static void adb_device_class_init(ObjectClass *oc, void *data)
127{
128 DeviceClass *dc = DEVICE_CLASS(oc);
129
130 dc->realize = adb_device_realizefn;
131 dc->props = adb_device_properties;
132 dc->bus_type = TYPE_ADB_BUS;
133}
134
135static const TypeInfo adb_device_type_info = {
136 .name = TYPE_ADB_DEVICE,
137 .parent = TYPE_DEVICE,
138 .instance_size = sizeof(ADBDevice),
139 .abstract = true,
140 .class_init = adb_device_class_init,
141};
142
143static void adb_register_types(void)
144{
145 type_register_static(&adb_bus_type_info);
146 type_register_static(&adb_device_type_info);
147}
148
149type_init(adb_register_types)
150