| /* |
| * QEMU Wacom Penpartner serial tablet emulation |
| * |
| * some protocol details: |
| * http://linuxwacom.sourceforge.net/wiki/index.php/Serial_Protocol_IV |
| * |
| * Copyright (c) 2016 Anatoli Huseu1 |
| * Copyright (c) 2016,17 Gerd Hoffmann |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a copy |
| * of this software and associated documentation files (the "Software"), to |
| * deal in the Software without restriction, including without limitation |
| * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
| * and/or sell copies of the Software, and to permit persons to whom the |
| * Software is furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in |
| * all copies or substantial portions of the Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM |
| * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| * THE SOFTWARE. |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "qemu/module.h" |
| #include "chardev/char-serial.h" |
| #include "ui/console.h" |
| #include "ui/input.h" |
| #include "trace.h" |
| |
| |
| #define WC_OUTPUT_BUF_MAX_LEN 512 |
| #define WC_COMMAND_MAX_LEN 60 |
| |
| #define WC_L7(n) ((n) & 127) |
| #define WC_M7(n) (((n) >> 7) & 127) |
| #define WC_H2(n) ((n) >> 14) |
| |
| #define WC_L4(n) ((n) & 15) |
| #define WC_H4(n) (((n) >> 4) & 15) |
| |
| /* Model string and config string */ |
| #define WC_MODEL_STRING_LENGTH 18 |
| uint8_t WC_MODEL_STRING[WC_MODEL_STRING_LENGTH + 1] = "~#CT-0045R,V1.3-5,"; |
| |
| #define WC_CONFIG_STRING_LENGTH 8 |
| uint8_t WC_CONFIG_STRING[WC_CONFIG_STRING_LENGTH + 1] = "96,N,8,0"; |
| |
| #define WC_FULL_CONFIG_STRING_LENGTH 61 |
| uint8_t WC_FULL_CONFIG_STRING[WC_FULL_CONFIG_STRING_LENGTH + 1] = { |
| 0x5c, 0x39, 0x36, 0x2c, 0x4e, 0x2c, 0x38, 0x2c, |
| 0x31, 0x28, 0x01, 0x24, 0x57, 0x41, 0x43, 0x30, |
| 0x30, 0x34, 0x35, 0x5c, 0x5c, 0x50, 0x45, 0x4e, 0x5c, |
| 0x57, 0x41, 0x43, 0x30, 0x30, 0x30, 0x30, 0x5c, |
| 0x54, 0x61, 0x62, 0x6c, 0x65, 0x74, 0x0d, 0x0a, |
| 0x43, 0x54, 0x2d, 0x30, 0x30, 0x34, 0x35, 0x52, |
| 0x2c, 0x56, 0x31, 0x2e, 0x33, 0x2d, 0x35, 0x0d, |
| 0x0a, 0x45, 0x37, 0x29 |
| }; |
| |
| /* This structure is used to save private info for Wacom Tablet. */ |
| typedef struct { |
| Chardev parent; |
| QemuInputHandlerState *hs; |
| |
| /* Query string from serial */ |
| uint8_t query[100]; |
| int query_index; |
| |
| /* Command to be sent to serial port */ |
| uint8_t outbuf[WC_OUTPUT_BUF_MAX_LEN]; |
| int outlen; |
| |
| int line_speed; |
| bool send_events; |
| int axis[INPUT_AXIS__MAX]; |
| bool btns[INPUT_BUTTON__MAX]; |
| |
| } TabletChardev; |
| |
| #define TYPE_CHARDEV_WCTABLET "chardev-wctablet" |
| #define WCTABLET_CHARDEV(obj) \ |
| OBJECT_CHECK(TabletChardev, (obj), TYPE_CHARDEV_WCTABLET) |
| |
| |
| static void wctablet_chr_accept_input(Chardev *chr); |
| |
| static void wctablet_shift_input(TabletChardev *tablet, int count) |
| { |
| tablet->query_index -= count; |
| memmove(tablet->query, tablet->query + count, tablet->query_index); |
| tablet->query[tablet->query_index] = 0; |
| } |
| |
| static void wctablet_queue_output(TabletChardev *tablet, uint8_t *buf, int count) |
| { |
| if (tablet->outlen + count > sizeof(tablet->outbuf)) { |
| return; |
| } |
| |
| memcpy(tablet->outbuf + tablet->outlen, buf, count); |
| tablet->outlen += count; |
| wctablet_chr_accept_input(CHARDEV(tablet)); |
| } |
| |
| static void wctablet_reset(TabletChardev *tablet) |
| { |
| /* clear buffers */ |
| tablet->query_index = 0; |
| tablet->outlen = 0; |
| /* reset state */ |
| tablet->send_events = false; |
| } |
| |
| static void wctablet_queue_event(TabletChardev *tablet) |
| { |
| uint8_t codes[8] = { 0xe0, 0, 0, 0, 0, 0, 0 }; |
| |
| if (tablet->line_speed != 9600) { |
| return; |
| } |
| |
| int newX = tablet->axis[INPUT_AXIS_X] * 0.1537; |
| int nexY = tablet->axis[INPUT_AXIS_Y] * 0.1152; |
| |
| codes[0] = codes[0] | WC_H2(newX); |
| codes[1] = codes[1] | WC_M7(newX); |
| codes[2] = codes[2] | WC_L7(newX); |
| |
| codes[3] = codes[3] | WC_H2(nexY); |
| codes[4] = codes[4] | WC_M7(nexY); |
| codes[5] = codes[5] | WC_L7(nexY); |
| |
| if (tablet->btns[INPUT_BUTTON_LEFT]) { |
| codes[0] = 0xa0; |
| } |
| |
| wctablet_queue_output(tablet, codes, 7); |
| } |
| |
| static void wctablet_input_event(DeviceState *dev, QemuConsole *src, |
| InputEvent *evt) |
| { |
| TabletChardev *tablet = (TabletChardev *)dev; |
| InputMoveEvent *move; |
| InputBtnEvent *btn; |
| |
| switch (evt->type) { |
| case INPUT_EVENT_KIND_ABS: |
| move = evt->u.abs.data; |
| tablet->axis[move->axis] = move->value; |
| break; |
| |
| case INPUT_EVENT_KIND_BTN: |
| btn = evt->u.btn.data; |
| tablet->btns[btn->button] = btn->down; |
| break; |
| |
| default: |
| /* keep gcc happy */ |
| break; |
| } |
| } |
| |
| static void wctablet_input_sync(DeviceState *dev) |
| { |
| TabletChardev *tablet = (TabletChardev *)dev; |
| |
| if (tablet->send_events) { |
| wctablet_queue_event(tablet); |
| } |
| } |
| |
| static QemuInputHandler wctablet_handler = { |
| .name = "QEMU Wacom Pen Tablet", |
| .mask = INPUT_EVENT_MASK_BTN | INPUT_EVENT_MASK_ABS, |
| .event = wctablet_input_event, |
| .sync = wctablet_input_sync, |
| }; |
| |
| static void wctablet_chr_accept_input(Chardev *chr) |
| { |
| TabletChardev *tablet = WCTABLET_CHARDEV(chr); |
| int len, canWrite; |
| |
| canWrite = qemu_chr_be_can_write(chr); |
| len = canWrite; |
| if (len > tablet->outlen) { |
| len = tablet->outlen; |
| } |
| |
| if (len) { |
| qemu_chr_be_write(chr, tablet->outbuf, len); |
| tablet->outlen -= len; |
| if (tablet->outlen) { |
| memmove(tablet->outbuf, tablet->outbuf + len, tablet->outlen); |
| } |
| } |
| } |
| |
| static int wctablet_chr_write(struct Chardev *chr, |
| const uint8_t *buf, int len) |
| { |
| TabletChardev *tablet = WCTABLET_CHARDEV(chr); |
| unsigned int i, clen; |
| char *pos; |
| |
| if (tablet->line_speed != 9600) { |
| return len; |
| } |
| for (i = 0; i < len && tablet->query_index < sizeof(tablet->query) - 1; i++) { |
| tablet->query[tablet->query_index++] = buf[i]; |
| } |
| tablet->query[tablet->query_index] = 0; |
| |
| while (tablet->query_index > 0 && (tablet->query[0] == '@' || |
| tablet->query[0] == '\r' || |
| tablet->query[0] == '\n')) { |
| wctablet_shift_input(tablet, 1); |
| } |
| if (!tablet->query_index) { |
| return len; |
| } |
| |
| if (strncmp((char *)tablet->query, "~#", 2) == 0) { |
| /* init / detect sequence */ |
| trace_wct_init(); |
| wctablet_shift_input(tablet, 2); |
| wctablet_queue_output(tablet, WC_MODEL_STRING, |
| WC_MODEL_STRING_LENGTH); |
| return len; |
| } |
| |
| /* detect line */ |
| pos = strchr((char *)tablet->query, '\r'); |
| if (!pos) { |
| pos = strchr((char *)tablet->query, '\n'); |
| } |
| if (!pos) { |
| return len; |
| } |
| clen = pos - (char *)tablet->query; |
| |
| /* process commands */ |
| if (strncmp((char *)tablet->query, "RE", 2) == 0 && |
| clen == 2) { |
| trace_wct_cmd_re(); |
| wctablet_shift_input(tablet, 3); |
| wctablet_queue_output(tablet, WC_CONFIG_STRING, |
| WC_CONFIG_STRING_LENGTH); |
| |
| } else if (strncmp((char *)tablet->query, "ST", 2) == 0 && |
| clen == 2) { |
| trace_wct_cmd_st(); |
| wctablet_shift_input(tablet, 3); |
| tablet->send_events = true; |
| wctablet_queue_event(tablet); |
| |
| } else if (strncmp((char *)tablet->query, "SP", 2) == 0 && |
| clen == 2) { |
| trace_wct_cmd_sp(); |
| wctablet_shift_input(tablet, 3); |
| tablet->send_events = false; |
| |
| } else if (strncmp((char *)tablet->query, "TS", 2) == 0 && |
| clen == 3) { |
| unsigned int input = tablet->query[2]; |
| uint8_t codes[7] = { |
| 0xa3, |
| ((input & 0x80) == 0) ? 0x7e : 0x7f, |
| (((WC_H4(input) & 0x7) ^ 0x5) << 4) | (WC_L4(input) ^ 0x7), |
| 0x03, |
| 0x7f, |
| 0x7f, |
| 0x00, |
| }; |
| trace_wct_cmd_ts(input); |
| wctablet_shift_input(tablet, 4); |
| wctablet_queue_output(tablet, codes, 7); |
| |
| } else { |
| tablet->query[clen] = 0; /* terminate line for printing */ |
| trace_wct_cmd_other((char *)tablet->query); |
| wctablet_shift_input(tablet, clen + 1); |
| |
| } |
| |
| return len; |
| } |
| |
| static int wctablet_chr_ioctl(Chardev *chr, int cmd, void *arg) |
| { |
| TabletChardev *tablet = WCTABLET_CHARDEV(chr); |
| QEMUSerialSetParams *ssp; |
| |
| switch (cmd) { |
| case CHR_IOCTL_SERIAL_SET_PARAMS: |
| ssp = arg; |
| if (tablet->line_speed != ssp->speed) { |
| trace_wct_speed(ssp->speed); |
| wctablet_reset(tablet); |
| tablet->line_speed = ssp->speed; |
| } |
| break; |
| default: |
| return -ENOTSUP; |
| } |
| return 0; |
| } |
| |
| static void wctablet_chr_finalize(Object *obj) |
| { |
| TabletChardev *tablet = WCTABLET_CHARDEV(obj); |
| |
| qemu_input_handler_unregister(tablet->hs); |
| g_free(tablet); |
| } |
| |
| static void wctablet_chr_open(Chardev *chr, |
| ChardevBackend *backend, |
| bool *be_opened, |
| Error **errp) |
| { |
| TabletChardev *tablet = WCTABLET_CHARDEV(chr); |
| |
| *be_opened = true; |
| |
| /* init state machine */ |
| memcpy(tablet->outbuf, WC_FULL_CONFIG_STRING, WC_FULL_CONFIG_STRING_LENGTH); |
| tablet->outlen = WC_FULL_CONFIG_STRING_LENGTH; |
| tablet->query_index = 0; |
| |
| tablet->hs = qemu_input_handler_register((DeviceState *)tablet, |
| &wctablet_handler); |
| } |
| |
| static void wctablet_chr_class_init(ObjectClass *oc, void *data) |
| { |
| ChardevClass *cc = CHARDEV_CLASS(oc); |
| |
| cc->open = wctablet_chr_open; |
| cc->chr_write = wctablet_chr_write; |
| cc->chr_ioctl = wctablet_chr_ioctl; |
| cc->chr_accept_input = wctablet_chr_accept_input; |
| } |
| |
| static const TypeInfo wctablet_type_info = { |
| .name = TYPE_CHARDEV_WCTABLET, |
| .parent = TYPE_CHARDEV, |
| .instance_size = sizeof(TabletChardev), |
| .instance_finalize = wctablet_chr_finalize, |
| .class_init = wctablet_chr_class_init, |
| }; |
| |
| static void register_types(void) |
| { |
| type_register_static(&wctablet_type_info); |
| } |
| |
| type_init(register_types); |