366 lines
10 KiB
C
366 lines
10 KiB
C
|
/*
|
||
|
* 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);
|