Merge tag 'pull-request-2022-09-28' of https://gitlab.com/thuth/qemu into staging
[qemu.git] / hw / input / virtio-input-host.c
1 /*
2 * This work is licensed under the terms of the GNU GPL, version 2 or
3 * (at your option) any later version. See the COPYING file in the
4 * top-level directory.
5 */
6
7 #include "qemu/osdep.h"
8 #include "qapi/error.h"
9 #include "qemu/module.h"
10 #include "qemu/sockets.h"
11
12 #include "hw/virtio/virtio.h"
13 #include "hw/qdev-properties.h"
14 #include "hw/virtio/virtio-input.h"
15
16 #include <sys/ioctl.h>
17 #include "standard-headers/linux/input.h"
18
19 /* ----------------------------------------------------------------- */
20
21 static struct virtio_input_config virtio_input_host_config[] = {
22 { /* empty list */ },
23 };
24
25 static void virtio_input_host_event(void *opaque)
26 {
27 VirtIOInputHost *vih = opaque;
28 VirtIOInput *vinput = VIRTIO_INPUT(vih);
29 struct virtio_input_event virtio;
30 struct input_event evdev;
31 int rc;
32
33 for (;;) {
34 rc = read(vih->fd, &evdev, sizeof(evdev));
35 if (rc != sizeof(evdev)) {
36 break;
37 }
38
39 virtio.type = cpu_to_le16(evdev.type);
40 virtio.code = cpu_to_le16(evdev.code);
41 virtio.value = cpu_to_le32(evdev.value);
42 virtio_input_send(vinput, &virtio);
43 }
44 }
45
46 static void virtio_input_bits_config(VirtIOInputHost *vih,
47 int type, int count)
48 {
49 virtio_input_config bits;
50 int rc, i, size = 0;
51
52 memset(&bits, 0, sizeof(bits));
53 rc = ioctl(vih->fd, EVIOCGBIT(type, count/8), bits.u.bitmap);
54 if (rc < 0) {
55 return;
56 }
57
58 for (i = 0; i < count/8; i++) {
59 if (bits.u.bitmap[i]) {
60 size = i+1;
61 }
62 }
63 if (size == 0) {
64 return;
65 }
66
67 bits.select = VIRTIO_INPUT_CFG_EV_BITS;
68 bits.subsel = type;
69 bits.size = size;
70 virtio_input_add_config(VIRTIO_INPUT(vih), &bits);
71 }
72
73 static void virtio_input_abs_config(VirtIOInputHost *vih, int axis)
74 {
75 virtio_input_config config;
76 struct input_absinfo absinfo;
77 int rc;
78
79 rc = ioctl(vih->fd, EVIOCGABS(axis), &absinfo);
80 if (rc < 0) {
81 return;
82 }
83
84 memset(&config, 0, sizeof(config));
85 config.select = VIRTIO_INPUT_CFG_ABS_INFO;
86 config.subsel = axis;
87 config.size = sizeof(virtio_input_absinfo);
88
89 config.u.abs.min = cpu_to_le32(absinfo.minimum);
90 config.u.abs.max = cpu_to_le32(absinfo.maximum);
91 config.u.abs.fuzz = cpu_to_le32(absinfo.fuzz);
92 config.u.abs.flat = cpu_to_le32(absinfo.flat);
93 config.u.abs.res = cpu_to_le32(absinfo.resolution);
94
95 virtio_input_add_config(VIRTIO_INPUT(vih), &config);
96 }
97
98 static void virtio_input_host_realize(DeviceState *dev, Error **errp)
99 {
100 VirtIOInputHost *vih = VIRTIO_INPUT_HOST(dev);
101 VirtIOInput *vinput = VIRTIO_INPUT(dev);
102 virtio_input_config id, *abs;
103 struct input_id ids;
104 int rc, ver, i, axis;
105 uint8_t byte;
106
107 if (!vih->evdev) {
108 error_setg(errp, "evdev property is required");
109 return;
110 }
111
112 vih->fd = open(vih->evdev, O_RDWR);
113 if (vih->fd < 0) {
114 error_setg_file_open(errp, errno, vih->evdev);
115 return;
116 }
117 if (!g_unix_set_fd_nonblocking(vih->fd, true, NULL)) {
118 error_setg_errno(errp, errno, "Failed to set FD nonblocking");
119 goto err_close;
120 }
121
122 rc = ioctl(vih->fd, EVIOCGVERSION, &ver);
123 if (rc < 0) {
124 error_setg(errp, "%s: is not an evdev device", vih->evdev);
125 goto err_close;
126 }
127
128 rc = ioctl(vih->fd, EVIOCGRAB, 1);
129 if (rc < 0) {
130 error_setg_errno(errp, errno, "%s: failed to get exclusive access",
131 vih->evdev);
132 goto err_close;
133 }
134
135 memset(&id, 0, sizeof(id));
136 ioctl(vih->fd, EVIOCGNAME(sizeof(id.u.string)-1), id.u.string);
137 id.select = VIRTIO_INPUT_CFG_ID_NAME;
138 id.size = strlen(id.u.string);
139 virtio_input_add_config(vinput, &id);
140
141 if (ioctl(vih->fd, EVIOCGID, &ids) == 0) {
142 memset(&id, 0, sizeof(id));
143 id.select = VIRTIO_INPUT_CFG_ID_DEVIDS;
144 id.size = sizeof(struct virtio_input_devids);
145 id.u.ids.bustype = cpu_to_le16(ids.bustype);
146 id.u.ids.vendor = cpu_to_le16(ids.vendor);
147 id.u.ids.product = cpu_to_le16(ids.product);
148 id.u.ids.version = cpu_to_le16(ids.version);
149 virtio_input_add_config(vinput, &id);
150 }
151
152 virtio_input_bits_config(vih, EV_KEY, KEY_CNT);
153 virtio_input_bits_config(vih, EV_REL, REL_CNT);
154 virtio_input_bits_config(vih, EV_ABS, ABS_CNT);
155 virtio_input_bits_config(vih, EV_MSC, MSC_CNT);
156 virtio_input_bits_config(vih, EV_SW, SW_CNT);
157 virtio_input_bits_config(vih, EV_LED, LED_CNT);
158
159 abs = virtio_input_find_config(VIRTIO_INPUT(vih),
160 VIRTIO_INPUT_CFG_EV_BITS, EV_ABS);
161 if (abs) {
162 for (i = 0; i < abs->size; i++) {
163 byte = abs->u.bitmap[i];
164 axis = 8 * i;
165 while (byte) {
166 if (byte & 1) {
167 virtio_input_abs_config(vih, axis);
168 }
169 axis++;
170 byte >>= 1;
171 }
172 }
173 }
174
175 qemu_set_fd_handler(vih->fd, virtio_input_host_event, NULL, vih);
176 return;
177
178 err_close:
179 close(vih->fd);
180 vih->fd = -1;
181 return;
182 }
183
184 static void virtio_input_host_unrealize(DeviceState *dev)
185 {
186 VirtIOInputHost *vih = VIRTIO_INPUT_HOST(dev);
187
188 if (vih->fd > 0) {
189 qemu_set_fd_handler(vih->fd, NULL, NULL, NULL);
190 close(vih->fd);
191 }
192 }
193
194 static void virtio_input_host_handle_status(VirtIOInput *vinput,
195 virtio_input_event *event)
196 {
197 VirtIOInputHost *vih = VIRTIO_INPUT_HOST(vinput);
198 struct input_event evdev;
199 struct timeval tval;
200 int rc;
201
202 if (gettimeofday(&tval, NULL)) {
203 perror("virtio_input_host_handle_status: gettimeofday");
204 return;
205 }
206
207 evdev.input_event_sec = tval.tv_sec;
208 evdev.input_event_usec = tval.tv_usec;
209 evdev.type = le16_to_cpu(event->type);
210 evdev.code = le16_to_cpu(event->code);
211 evdev.value = le32_to_cpu(event->value);
212
213 rc = write(vih->fd, &evdev, sizeof(evdev));
214 if (rc == -1) {
215 perror("virtio_input_host_handle_status: write");
216 }
217 }
218
219 static const VMStateDescription vmstate_virtio_input_host = {
220 .name = "virtio-input-host",
221 .unmigratable = 1,
222 };
223
224 static Property virtio_input_host_properties[] = {
225 DEFINE_PROP_STRING("evdev", VirtIOInputHost, evdev),
226 DEFINE_PROP_END_OF_LIST(),
227 };
228
229 static void virtio_input_host_class_init(ObjectClass *klass, void *data)
230 {
231 VirtIOInputClass *vic = VIRTIO_INPUT_CLASS(klass);
232 DeviceClass *dc = DEVICE_CLASS(klass);
233
234 dc->vmsd = &vmstate_virtio_input_host;
235 device_class_set_props(dc, virtio_input_host_properties);
236 vic->realize = virtio_input_host_realize;
237 vic->unrealize = virtio_input_host_unrealize;
238 vic->handle_status = virtio_input_host_handle_status;
239 }
240
241 static void virtio_input_host_init(Object *obj)
242 {
243 VirtIOInput *vinput = VIRTIO_INPUT(obj);
244
245 virtio_input_init_config(vinput, virtio_input_host_config);
246 }
247
248 static const TypeInfo virtio_input_host_info = {
249 .name = TYPE_VIRTIO_INPUT_HOST,
250 .parent = TYPE_VIRTIO_INPUT,
251 .instance_size = sizeof(VirtIOInputHost),
252 .instance_init = virtio_input_host_init,
253 .class_init = virtio_input_host_class_init,
254 };
255
256 /* ----------------------------------------------------------------- */
257
258 static void virtio_register_types(void)
259 {
260 type_register_static(&virtio_input_host_info);
261 }
262
263 type_init(virtio_register_types)