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)