637 lines
17 KiB
Diff
637 lines
17 KiB
Diff
From 0000000000000000000000000000000000000000 Mon Sep 17 00:00:00 2001
|
|
From: Hyeonki Hong <hhk7734@gmail.com>
|
|
Date: Thu, 5 Mar 2020 19:01:43 +0900
|
|
Subject: ODROID-COMMON: input/touchscreen: Add D-WAV Multitouch driver.
|
|
|
|
Change-Id: Ia1c8c29d3f69c6ba5d630279c4cc98119b68ab71
|
|
---
|
|
drivers/hid/hid-ids.h | 6 +
|
|
drivers/hid/hid-quirks.c | 3 +
|
|
drivers/input/touchscreen/Kconfig | 10 +
|
|
drivers/input/touchscreen/Makefile | 1 +
|
|
drivers/input/touchscreen/dwav-usb-mt.c | 554 ++++++++++
|
|
5 files changed, 574 insertions(+)
|
|
|
|
diff --git a/drivers/hid/hid-ids.h b/drivers/hid/hid-ids.h
|
|
index 8a310f8ff20f..8c1b931810c1 100644
|
|
--- a/drivers/hid/hid-ids.h
|
|
+++ b/drivers/hid/hid-ids.h
|
|
@@ -1454,4 +1454,10 @@
|
|
#define USB_VENDOR_ID_SIGNOTEC 0x2133
|
|
#define USB_DEVICE_ID_SIGNOTEC_VIEWSONIC_PD1011 0x0018
|
|
|
|
+#define USB_DEVICE_ID_DWAV_MULTITOUCH 0x0005
|
|
+
|
|
+#define USB_VENDOR_ID_ODROID 0x16b4
|
|
+#define USB_DEVICE_ID_VU5 0x0704
|
|
+#define USB_DEVICE_ID_VU7PLUS 0x0705
|
|
+
|
|
#endif
|
|
diff --git a/drivers/hid/hid-quirks.c b/drivers/hid/hid-quirks.c
|
|
index 3983b4f282f8..38217748b1ec 100644
|
|
--- a/drivers/hid/hid-quirks.c
|
|
+++ b/drivers/hid/hid-quirks.c
|
|
@@ -888,6 +888,9 @@ static const struct hid_device_id hid_ignore_list[] = {
|
|
{ HID_USB_DEVICE(USB_VENDOR_ID_SYNAPTICS, USB_DEVICE_ID_SYNAPTICS_DPAD) },
|
|
#endif
|
|
{ HID_USB_DEVICE(USB_VENDOR_ID_YEALINK, USB_DEVICE_ID_YEALINK_P1K_P4K_B2K) },
|
|
+
|
|
+ { HID_USB_DEVICE(USB_VENDOR_ID_ODROID, USB_DEVICE_ID_VU5) },
|
|
+ { HID_USB_DEVICE(USB_VENDOR_ID_ODROID, USB_DEVICE_ID_VU7PLUS) },
|
|
{ }
|
|
};
|
|
|
|
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
|
|
index c2cbd332af1d..c021d7b85fe0 100644
|
|
--- a/drivers/input/touchscreen/Kconfig
|
|
+++ b/drivers/input/touchscreen/Kconfig
|
|
@@ -1389,4 +1389,14 @@ config TOUCHSCREEN_HIMAX_HX83112B
|
|
To compile this driver as a module, choose M here: the
|
|
module will be called himax_hx83112b.
|
|
|
|
+config TOUCHSCREEN_DWAV_USB_MT
|
|
+ tristate "D-WAV Scientific USB MultiTouch"
|
|
+ depends on USB_ARCH_HAS_HCD
|
|
+ select USB
|
|
+ help
|
|
+ Say Y here if you have a D-WAV Scientific USB(HID) based MultiTouch
|
|
+ controller.
|
|
+
|
|
+ module will be called dwav-usb-mt.
|
|
+
|
|
endif
|
|
diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen/Makefile
|
|
index 159cd5136fdb..5215924379d5 100644
|
|
--- a/drivers/input/touchscreen/Makefile
|
|
+++ b/drivers/input/touchscreen/Makefile
|
|
@@ -116,4 +116,5 @@ obj-$(CONFIG_TOUCHSCREEN_ROHM_BU21023) += rohm_bu21023.o
|
|
obj-$(CONFIG_TOUCHSCREEN_RASPBERRYPI_FW) += raspberrypi-ts.o
|
|
obj-$(CONFIG_TOUCHSCREEN_IQS5XX) += iqs5xx.o
|
|
obj-$(CONFIG_TOUCHSCREEN_ZINITIX) += zinitix.o
|
|
+obj-$(CONFIG_TOUCHSCREEN_DWAV_USB_MT) += dwav-usb-mt.o
|
|
obj-$(CONFIG_TOUCHSCREEN_HIMAX_HX83112B) += himax_hx83112b.o
|
|
diff --git a/drivers/input/touchscreen/dwav-usb-mt.c b/drivers/input/touchscreen/dwav-usb-mt.c
|
|
new file mode 100644
|
|
index 000000000000..7ec8b6dd15fd
|
|
--- /dev/null
|
|
+++ b/drivers/input/touchscreen/dwav-usb-mt.c
|
|
@@ -0,0 +1,554 @@
|
|
+// SPDX-License-Identifier: GPL-2.0+
|
|
+/*
|
|
+ * D-WAV Scientific USB(HID) MultiTouch Screen Driver(Based on usbtouchscreen.c)
|
|
+ *
|
|
+ * Copyright (C) Hardkernel, 2015
|
|
+ */
|
|
+
|
|
+#include <linux/kernel.h>
|
|
+#include <linux/slab.h>
|
|
+#include <linux/input.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/init.h>
|
|
+#include <linux/usb.h>
|
|
+#include <linux/usb/input.h>
|
|
+#include <linux/hid.h>
|
|
+
|
|
+#include <linux/input/mt.h>
|
|
+
|
|
+#define USB_VENDOR_ID_DWAV 0x0eef /* 800 x 480, 7" DWAV touch */
|
|
+#define USB_DEVICE_ID_VU7 0x0005
|
|
+
|
|
+#define USB_VENDOR_ID_ODROID 0x16b4
|
|
+#define USB_DEVICE_ID_VU5 0x0704
|
|
+#define USB_DEVICE_ID_VU7PLUS 0x0705
|
|
+
|
|
+enum {
|
|
+ ODROID_VU7 = 0, /* 800 x 480, 7" Touch */
|
|
+ ODROID_VU5, /* 800 x 480, 5" Touch */
|
|
+ ODROID_VU7PLUS, /* 1024 x 600, 7" Touch */
|
|
+};
|
|
+
|
|
+struct usbtouch_device_info {
|
|
+ char name[64];
|
|
+ int max_x;
|
|
+ int max_y;
|
|
+ int max_press;
|
|
+ int max_finger;
|
|
+};
|
|
+
|
|
+const struct usbtouch_device_info DEV_INFO[] = {
|
|
+ [ODROID_VU7] = {
|
|
+ .name = "ODROID VU7 MultiTouch(800x480)",
|
|
+ .max_x = 800,
|
|
+ .max_y = 480,
|
|
+ .max_press = 255,
|
|
+ .max_finger = 5,
|
|
+ },
|
|
+ [ODROID_VU5] = {
|
|
+ .name = "ODROID VU5 MultiTouch(800x480)",
|
|
+ .max_x = 800,
|
|
+ .max_y = 480,
|
|
+ .max_press = 255,
|
|
+ .max_finger = 5,
|
|
+ },
|
|
+ [ODROID_VU7PLUS] = {
|
|
+ .name = "ODROID VU7 Plus MultiTouch(1024x600)",
|
|
+ .max_x = 1024,
|
|
+ .max_y = 600,
|
|
+ .max_press = 255,
|
|
+ .max_finger = 5,
|
|
+ },
|
|
+};
|
|
+
|
|
+static const struct usb_device_id dwav_usb_mt_devices[] = {
|
|
+ {USB_DEVICE(USB_VENDOR_ID_DWAV, USB_DEVICE_ID_VU7),
|
|
+ .driver_info = ODROID_VU7},
|
|
+ {USB_DEVICE(USB_VENDOR_ID_ODROID, USB_DEVICE_ID_VU5),
|
|
+ .driver_info = ODROID_VU5},
|
|
+ {USB_DEVICE(USB_VENDOR_ID_ODROID, USB_DEVICE_ID_VU7PLUS),
|
|
+ .driver_info = ODROID_VU7PLUS},
|
|
+ {}
|
|
+};
|
|
+
|
|
+struct dwav_raw { /* Total 25 bytes */
|
|
+ unsigned char header; /* frame header 0xAA*/
|
|
+ unsigned char press;
|
|
+ /* Touch flag (1:valid touch data, 0:touch finished) */
|
|
+ unsigned short x1; /* 1st x */
|
|
+ unsigned short y1; /* 1st y */
|
|
+ unsigned char end;
|
|
+ /* 1st touch finish flags 0xBB, RPI only uses the first 7 bytes */
|
|
+ unsigned char ids; /* touch ID(bit field) */
|
|
+ unsigned short y2;
|
|
+ unsigned short x2;
|
|
+ unsigned short y3;
|
|
+ unsigned short x3;
|
|
+ unsigned short y4;
|
|
+ unsigned short x4;
|
|
+ unsigned short y5;
|
|
+ unsigned short x5;
|
|
+ unsigned char tail; /* frame end 0xCC */
|
|
+};
|
|
+
|
|
+#define TS_EVENT_UNKNOWN 0x00
|
|
+#define TS_EVENT_PRESS 0x01
|
|
+#define TS_EVENT_RELEASE 0x02
|
|
+
|
|
+struct finger_t {
|
|
+ unsigned int status; /* ts event type */
|
|
+ unsigned int x; /* ts data x */
|
|
+ unsigned int y; /* ts data y */
|
|
+} __packed;
|
|
+
|
|
+struct dwav_usb_mt {
|
|
+ char name[128], phys[64];
|
|
+
|
|
+ int dev_id;
|
|
+ /* for URB Data DMA */
|
|
+ dma_addr_t data_dma;
|
|
+ unsigned char *data;
|
|
+ int data_size;
|
|
+
|
|
+ struct urb *irq;
|
|
+ struct usb_interface *interface;
|
|
+ struct input_dev *input;
|
|
+
|
|
+ struct finger_t *finger;
|
|
+};
|
|
+
|
|
+static void dwav_usb_mt_report(struct dwav_usb_mt *dwav_usb_mt)
|
|
+{
|
|
+ int id, max_x, max_y, max_press, max_finger;
|
|
+
|
|
+ max_x = DEV_INFO[dwav_usb_mt->dev_id].max_x;
|
|
+ max_y = DEV_INFO[dwav_usb_mt->dev_id].max_y;
|
|
+ max_press = DEV_INFO[dwav_usb_mt->dev_id].max_press;
|
|
+ max_finger = DEV_INFO[dwav_usb_mt->dev_id].max_finger;
|
|
+
|
|
+ for (id = 0; id < max_finger; id++) {
|
|
+
|
|
+ if (dwav_usb_mt->finger[id].status == TS_EVENT_UNKNOWN)
|
|
+ continue;
|
|
+
|
|
+ if (dwav_usb_mt->finger[id].x >= max_x ||
|
|
+ dwav_usb_mt->finger[id].y >= max_y)
|
|
+ continue;
|
|
+
|
|
+ input_mt_slot(dwav_usb_mt->input, id);
|
|
+
|
|
+ if (dwav_usb_mt->finger[id].status != TS_EVENT_RELEASE) {
|
|
+ input_mt_report_slot_state(dwav_usb_mt->input,
|
|
+ MT_TOOL_FINGER, true);
|
|
+ input_report_abs(dwav_usb_mt->input,
|
|
+ ABS_MT_POSITION_X,
|
|
+ dwav_usb_mt->finger[id].x);
|
|
+ input_report_abs(dwav_usb_mt->input,
|
|
+ ABS_MT_POSITION_Y,
|
|
+ dwav_usb_mt->finger[id].y);
|
|
+ input_report_abs(dwav_usb_mt->input,
|
|
+ ABS_MT_PRESSURE,
|
|
+ max_press);
|
|
+ } else {
|
|
+ input_mt_report_slot_state(dwav_usb_mt->input,
|
|
+ MT_TOOL_FINGER, false);
|
|
+ dwav_usb_mt->finger[id].status = TS_EVENT_UNKNOWN;
|
|
+ }
|
|
+ input_mt_report_pointer_emulation(dwav_usb_mt->input, true);
|
|
+ input_sync(dwav_usb_mt->input);
|
|
+ }
|
|
+}
|
|
+
|
|
+static void dwav_usb_mt_process(struct dwav_usb_mt *dwav_usb_mt,
|
|
+ unsigned char *pkt, int len)
|
|
+{
|
|
+ struct dwav_raw *dwav_raw = (struct dwav_raw *)pkt;
|
|
+ unsigned char bit_mask, cnt;
|
|
+
|
|
+ for (cnt = 0, bit_mask = 0x01;
|
|
+ cnt < DEV_INFO[dwav_usb_mt->dev_id].max_finger;
|
|
+ cnt++, bit_mask <<= 1) {
|
|
+ if ((dwav_raw->ids & bit_mask) && dwav_raw->press) {
|
|
+ dwav_usb_mt->finger[cnt].status = TS_EVENT_PRESS;
|
|
+ switch (cnt) {
|
|
+ case 0:
|
|
+ dwav_usb_mt->finger[cnt].x
|
|
+ = cpu_to_be16(dwav_raw->x1);
|
|
+ dwav_usb_mt->finger[cnt].y
|
|
+ = cpu_to_be16(dwav_raw->y1);
|
|
+ break;
|
|
+ case 1:
|
|
+ dwav_usb_mt->finger[cnt].x
|
|
+ = cpu_to_be16(dwav_raw->x2);
|
|
+ dwav_usb_mt->finger[cnt].y
|
|
+ = cpu_to_be16(dwav_raw->y2);
|
|
+ break;
|
|
+ case 2:
|
|
+ dwav_usb_mt->finger[cnt].x
|
|
+ = cpu_to_be16(dwav_raw->x3);
|
|
+ dwav_usb_mt->finger[cnt].y
|
|
+ = cpu_to_be16(dwav_raw->y3);
|
|
+ break;
|
|
+ case 3:
|
|
+ dwav_usb_mt->finger[cnt].x
|
|
+ = cpu_to_be16(dwav_raw->x4);
|
|
+ dwav_usb_mt->finger[cnt].y
|
|
+ = cpu_to_be16(dwav_raw->y4);
|
|
+ break;
|
|
+ case 4:
|
|
+ dwav_usb_mt->finger[cnt].x
|
|
+ = cpu_to_be16(dwav_raw->x5);
|
|
+ dwav_usb_mt->finger[cnt].y
|
|
+ = cpu_to_be16(dwav_raw->y5);
|
|
+ break;
|
|
+ default:
|
|
+ break;
|
|
+ }
|
|
+ } else {
|
|
+ if (dwav_usb_mt->finger[cnt].status == TS_EVENT_PRESS)
|
|
+ dwav_usb_mt->finger[cnt].status
|
|
+ = TS_EVENT_RELEASE;
|
|
+ else
|
|
+ dwav_usb_mt->finger[cnt].status
|
|
+ = TS_EVENT_UNKNOWN;
|
|
+ }
|
|
+ }
|
|
+ dwav_usb_mt_report(dwav_usb_mt);
|
|
+}
|
|
+
|
|
+static void dwav_usb_mt_irq(struct urb *urb)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = urb->context;
|
|
+ struct device *dev = &dwav_usb_mt->interface->dev;
|
|
+ int retval;
|
|
+
|
|
+ switch (urb->status) {
|
|
+ case 0:
|
|
+ /* success */
|
|
+ break;
|
|
+ case -ETIME:
|
|
+ /* this urb is timing out */
|
|
+ dev_dbg(dev, "%s - urb timed out - was the device unplugged?\n",
|
|
+ __func__);
|
|
+ return;
|
|
+ case -ECONNRESET:
|
|
+ case -ENOENT:
|
|
+ case -ESHUTDOWN:
|
|
+ case -EPIPE:
|
|
+ /* this urb is terminated, clean up */
|
|
+ dev_dbg(dev, "%s - urb shutting down with status: %d\n",
|
|
+ __func__, urb->status);
|
|
+ return;
|
|
+ default:
|
|
+ dev_dbg(dev, "%s - nonzero urb status received: %d\n",
|
|
+ __func__, urb->status);
|
|
+ goto exit;
|
|
+ }
|
|
+
|
|
+ dwav_usb_mt_process(dwav_usb_mt, dwav_usb_mt->data, urb->actual_length);
|
|
+
|
|
+exit:
|
|
+ usb_mark_last_busy(interface_to_usbdev(dwav_usb_mt->interface));
|
|
+ retval = usb_submit_urb(urb, GFP_ATOMIC);
|
|
+ if (retval) {
|
|
+ dev_err(dev, "%s - usb_submit_urb failed with result: %d\n",
|
|
+ __func__, retval);
|
|
+ }
|
|
+}
|
|
+
|
|
+static int dwav_usb_mt_open(struct input_dev *input)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = input_get_drvdata(input);
|
|
+ int r;
|
|
+
|
|
+ dwav_usb_mt->irq->dev = interface_to_usbdev(dwav_usb_mt->interface);
|
|
+
|
|
+ r = usb_autopm_get_interface(dwav_usb_mt->interface) ? -EIO : 0;
|
|
+ if (r < 0)
|
|
+ goto out;
|
|
+
|
|
+ if (usb_submit_urb(dwav_usb_mt->irq, GFP_KERNEL)) {
|
|
+ r = -EIO;
|
|
+ goto out_put;
|
|
+ }
|
|
+
|
|
+ dwav_usb_mt->interface->needs_remote_wakeup = 1;
|
|
+out_put:
|
|
+ usb_autopm_put_interface(dwav_usb_mt->interface);
|
|
+out:
|
|
+ return r;
|
|
+}
|
|
+
|
|
+static void dwav_usb_mt_close(struct input_dev *input)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = input_get_drvdata(input);
|
|
+ int r;
|
|
+
|
|
+ usb_kill_urb(dwav_usb_mt->irq);
|
|
+
|
|
+ r = usb_autopm_get_interface(dwav_usb_mt->interface);
|
|
+
|
|
+ dwav_usb_mt->interface->needs_remote_wakeup = 0;
|
|
+ if (!r)
|
|
+ usb_autopm_put_interface(dwav_usb_mt->interface);
|
|
+}
|
|
+
|
|
+static int dwav_usb_mt_suspend(struct usb_interface *intf, pm_message_t message)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = usb_get_intfdata(intf);
|
|
+
|
|
+ usb_kill_urb(dwav_usb_mt->irq);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int dwav_usb_mt_resume(struct usb_interface *intf)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = usb_get_intfdata(intf);
|
|
+ struct input_dev *input = dwav_usb_mt->input;
|
|
+ int result = 0;
|
|
+
|
|
+ mutex_lock(&input->mutex);
|
|
+ if (input->users)
|
|
+ result = usb_submit_urb(dwav_usb_mt->irq, GFP_NOIO);
|
|
+ mutex_unlock(&input->mutex);
|
|
+
|
|
+ return result;
|
|
+}
|
|
+
|
|
+static int dwav_usb_mt_reset_resume(struct usb_interface *intf)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = usb_get_intfdata(intf);
|
|
+ struct input_dev *input = dwav_usb_mt->input;
|
|
+ int err = 0;
|
|
+
|
|
+ /* restart IO if needed */
|
|
+ mutex_lock(&input->mutex);
|
|
+ if (input->users)
|
|
+ err = usb_submit_urb(dwav_usb_mt->irq, GFP_NOIO);
|
|
+ mutex_unlock(&input->mutex);
|
|
+
|
|
+ return err;
|
|
+}
|
|
+
|
|
+static void dwav_usb_mt_free_buffers(struct usb_device *udev,
|
|
+ struct dwav_usb_mt *dwav_usb_mt)
|
|
+{
|
|
+ usb_free_coherent(udev, dwav_usb_mt->data_size,
|
|
+ dwav_usb_mt->data, dwav_usb_mt->data_dma);
|
|
+}
|
|
+
|
|
+static struct usb_endpoint_descriptor *dwav_usb_mt_get_input_endpoint(
|
|
+ struct usb_host_interface *interface)
|
|
+{
|
|
+ int i;
|
|
+
|
|
+ for (i = 0; i < interface->desc.bNumEndpoints; i++) {
|
|
+ if (usb_endpoint_dir_in(&interface->endpoint[i].desc))
|
|
+ return &interface->endpoint[i].desc;
|
|
+ }
|
|
+
|
|
+ return NULL;
|
|
+}
|
|
+
|
|
+static int dwav_usb_mt_init(struct dwav_usb_mt *dwav_usb_mt, void *dev)
|
|
+{
|
|
+ int err;
|
|
+ struct input_dev *input_dev = (struct input_dev *)dev;
|
|
+
|
|
+ input_dev->name = dwav_usb_mt->name;
|
|
+ input_dev->phys = dwav_usb_mt->phys;
|
|
+
|
|
+ input_set_drvdata(input_dev, dwav_usb_mt);
|
|
+
|
|
+ input_dev->open = dwav_usb_mt_open;
|
|
+ input_dev->close = dwav_usb_mt_close;
|
|
+
|
|
+ input_dev->id.bustype = BUS_USB;
|
|
+
|
|
+ /* single touch */
|
|
+ input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
|
|
+ input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
|
|
+
|
|
+ input_set_abs_params(input_dev, ABS_X, 0,
|
|
+ DEV_INFO[dwav_usb_mt->dev_id].max_x, 0, 0);
|
|
+ input_set_abs_params(input_dev, ABS_Y, 0,
|
|
+ DEV_INFO[dwav_usb_mt->dev_id].max_y, 0, 0);
|
|
+
|
|
+ /* multi touch */
|
|
+ input_set_abs_params(input_dev, ABS_MT_POSITION_X, 0,
|
|
+ DEV_INFO[dwav_usb_mt->dev_id].max_x, 0, 0);
|
|
+ input_set_abs_params(input_dev, ABS_MT_POSITION_Y, 0,
|
|
+ DEV_INFO[dwav_usb_mt->dev_id].max_y, 0, 0);
|
|
+ input_mt_init_slots(input_dev,
|
|
+ DEV_INFO[dwav_usb_mt->dev_id].max_finger, 0);
|
|
+
|
|
+ err = input_register_device(input_dev);
|
|
+ if (err) {
|
|
+ pr_err("%s - input_register_device failed, err: %d\n",
|
|
+ __func__, err);
|
|
+ return err;
|
|
+ }
|
|
+
|
|
+ dwav_usb_mt->input = input_dev;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int dwav_usb_mt_probe(struct usb_interface *intf,
|
|
+ const struct usb_device_id *id)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = NULL;
|
|
+ struct input_dev *input_dev = NULL;
|
|
+ struct usb_endpoint_descriptor *endpoint;
|
|
+ struct usb_device *udev = interface_to_usbdev(intf);
|
|
+
|
|
+ int err = 0;
|
|
+
|
|
+ endpoint = dwav_usb_mt_get_input_endpoint(intf->cur_altsetting);
|
|
+ if (!endpoint)
|
|
+ return -ENXIO;
|
|
+
|
|
+ dwav_usb_mt = kzalloc(sizeof(struct dwav_usb_mt), GFP_KERNEL);
|
|
+ if (!dwav_usb_mt)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ dwav_usb_mt->dev_id = id->driver_info;
|
|
+
|
|
+ dwav_usb_mt->finger = kzalloc(sizeof(struct finger_t) *
|
|
+ DEV_INFO[dwav_usb_mt->dev_id].max_finger,
|
|
+ GFP_KERNEL);
|
|
+
|
|
+ if (!dwav_usb_mt->finger)
|
|
+ goto err_free_mem;
|
|
+
|
|
+ input_dev = input_allocate_device();
|
|
+ if (!input_dev)
|
|
+ goto err_free_mem;
|
|
+
|
|
+ dwav_usb_mt->data_size = sizeof(struct dwav_raw);
|
|
+ dwav_usb_mt->data = usb_alloc_coherent(udev, dwav_usb_mt->data_size,
|
|
+ GFP_KERNEL, &dwav_usb_mt->data_dma);
|
|
+ if (!dwav_usb_mt->data)
|
|
+ goto err_free_mem;
|
|
+
|
|
+ dwav_usb_mt->irq = usb_alloc_urb(0, GFP_KERNEL);
|
|
+ if (!dwav_usb_mt->irq) {
|
|
+ dev_dbg(&intf->dev,
|
|
+ "%s - usb_alloc_urb failed: usbtouch->irq\n",
|
|
+ __func__);
|
|
+ goto err_free_buffers;
|
|
+ }
|
|
+
|
|
+ if (usb_endpoint_type(endpoint) == USB_ENDPOINT_XFER_INT) {
|
|
+ usb_fill_int_urb(dwav_usb_mt->irq, udev,
|
|
+ usb_rcvintpipe(udev, endpoint->bEndpointAddress),
|
|
+ dwav_usb_mt->data, dwav_usb_mt->data_size,
|
|
+ dwav_usb_mt_irq, dwav_usb_mt, endpoint->bInterval);
|
|
+ } else {
|
|
+ usb_fill_bulk_urb(dwav_usb_mt->irq, udev,
|
|
+ usb_rcvbulkpipe(udev, endpoint->bEndpointAddress),
|
|
+ dwav_usb_mt->data, dwav_usb_mt->data_size,
|
|
+ dwav_usb_mt_irq, dwav_usb_mt);
|
|
+ }
|
|
+
|
|
+ dwav_usb_mt->irq->dev = udev;
|
|
+ dwav_usb_mt->irq->transfer_dma = dwav_usb_mt->data_dma;
|
|
+ dwav_usb_mt->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
|
|
+
|
|
+ dwav_usb_mt->interface = intf;
|
|
+
|
|
+ if (udev->manufacturer)
|
|
+ strlcpy(dwav_usb_mt->name,
|
|
+ udev->manufacturer, sizeof(dwav_usb_mt->name));
|
|
+
|
|
+ if (udev->product) {
|
|
+ if (udev->manufacturer)
|
|
+ strlcat(dwav_usb_mt->name,
|
|
+ " ", sizeof(dwav_usb_mt->name));
|
|
+
|
|
+ strlcat(dwav_usb_mt->name,
|
|
+ udev->product, sizeof(dwav_usb_mt->name));
|
|
+ }
|
|
+
|
|
+ if (!strlen(dwav_usb_mt->name)) {
|
|
+ snprintf(dwav_usb_mt->name, sizeof(dwav_usb_mt->name),
|
|
+ "D-WAV Scientific MultiTouch %04x:%04x",
|
|
+ le16_to_cpu(udev->descriptor.idVendor),
|
|
+ le16_to_cpu(udev->descriptor.idProduct));
|
|
+ }
|
|
+
|
|
+ usb_make_path(udev, dwav_usb_mt->phys, sizeof(dwav_usb_mt->phys));
|
|
+ strlcat(dwav_usb_mt->phys, "/input0", sizeof(dwav_usb_mt->phys));
|
|
+
|
|
+ usb_to_input_id(udev, &input_dev->id);
|
|
+
|
|
+ input_dev->dev.parent = &intf->dev;
|
|
+
|
|
+ err = dwav_usb_mt_init(dwav_usb_mt, (void *)input_dev);
|
|
+ if (err)
|
|
+ goto err_free_urb;
|
|
+
|
|
+ usb_set_intfdata(intf, dwav_usb_mt);
|
|
+
|
|
+ dev_info(&intf->dev, "%s\n", DEV_INFO[dwav_usb_mt->dev_id].name);
|
|
+
|
|
+ return 0;
|
|
+
|
|
+err_free_urb:
|
|
+ usb_free_urb(dwav_usb_mt->irq);
|
|
+
|
|
+err_free_buffers:
|
|
+ dwav_usb_mt_free_buffers(udev, dwav_usb_mt);
|
|
+
|
|
+err_free_mem:
|
|
+ if (input_dev)
|
|
+ input_free_device(input_dev);
|
|
+ kfree(dwav_usb_mt);
|
|
+
|
|
+ return err;
|
|
+}
|
|
+
|
|
+static void dwav_usb_mt_disconnect(struct usb_interface *intf)
|
|
+{
|
|
+ struct dwav_usb_mt *dwav_usb_mt = usb_get_intfdata(intf);
|
|
+
|
|
+ if (!dwav_usb_mt)
|
|
+ return;
|
|
+
|
|
+ dev_dbg(&intf->dev,
|
|
+ "%s - dwav_usb_mt is initialized, cleaning up\n",
|
|
+ __func__);
|
|
+
|
|
+ usb_set_intfdata(intf, NULL);
|
|
+
|
|
+ /* this will stop IO via close */
|
|
+ input_unregister_device(dwav_usb_mt->input);
|
|
+
|
|
+ usb_free_urb(dwav_usb_mt->irq);
|
|
+
|
|
+ dwav_usb_mt_free_buffers(interface_to_usbdev(intf), dwav_usb_mt);
|
|
+
|
|
+ kfree(dwav_usb_mt);
|
|
+}
|
|
+
|
|
+MODULE_DEVICE_TABLE(usb, dwav_usb_mt_devices);
|
|
+
|
|
+static struct usb_driver dwav_usb_mt_driver = {
|
|
+ .name = "dwav_usb_mt",
|
|
+ .probe = dwav_usb_mt_probe,
|
|
+ .disconnect = dwav_usb_mt_disconnect,
|
|
+ .suspend = dwav_usb_mt_suspend,
|
|
+ .resume = dwav_usb_mt_resume,
|
|
+ .reset_resume = dwav_usb_mt_reset_resume,
|
|
+ .id_table = dwav_usb_mt_devices,
|
|
+ .supports_autosuspend = 1,
|
|
+};
|
|
+
|
|
+module_usb_driver(dwav_usb_mt_driver);
|
|
+
|
|
+MODULE_AUTHOR("Hardkernel Co.,Ltd");
|
|
+MODULE_DESCRIPTION("D-WAV USB(HID) MultiTouch Driver");
|
|
+MODULE_LICENSE("GPL");
|
|
+
|
|
+MODULE_ALIAS("dwav_usb_mt");
|
|
\ No newline at end of file
|
|
--
|
|
Armbian
|
|
|