• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 #include <linux/kernel.h>
2 #include <linux/slab.h>
3 #include <linux/module.h>
4 #include <linux/usb/input.h>
5 #include <asm/unaligned.h>
6 
7 /*
8  * Pressure-threshold modules param code from Alex Perry <alex.perry@ieee.org>
9  */
10 
11 MODULE_AUTHOR("Josh Myer <josh@joshisanerd.com>");
12 MODULE_DESCRIPTION("USB KB Gear JamStudio Tablet driver");
13 MODULE_LICENSE("GPL");
14 
15 #define USB_VENDOR_ID_KBGEAR	0x084e
16 
17 static int kb_pressure_click = 0x10;
18 module_param(kb_pressure_click, int, 0);
19 MODULE_PARM_DESC(kb_pressure_click, "pressure threshold for clicks");
20 
21 struct kbtab {
22 	unsigned char *data;
23 	dma_addr_t data_dma;
24 	struct input_dev *dev;
25 	struct usb_interface *intf;
26 	struct urb *irq;
27 	char phys[32];
28 };
29 
kbtab_irq(struct urb * urb)30 static void kbtab_irq(struct urb *urb)
31 {
32 	struct kbtab *kbtab = urb->context;
33 	unsigned char *data = kbtab->data;
34 	struct input_dev *dev = kbtab->dev;
35 	int pressure;
36 	int retval;
37 
38 	switch (urb->status) {
39 	case 0:
40 		/* success */
41 		break;
42 	case -ECONNRESET:
43 	case -ENOENT:
44 	case -ESHUTDOWN:
45 		/* this urb is terminated, clean up */
46 		dev_dbg(&kbtab->intf->dev,
47 			"%s - urb shutting down with status: %d\n",
48 			__func__, urb->status);
49 		return;
50 	default:
51 		dev_dbg(&kbtab->intf->dev,
52 			"%s - nonzero urb status received: %d\n",
53 			__func__, urb->status);
54 		goto exit;
55 	}
56 
57 
58 	input_report_key(dev, BTN_TOOL_PEN, 1);
59 
60 	input_report_abs(dev, ABS_X, get_unaligned_le16(&data[1]));
61 	input_report_abs(dev, ABS_Y, get_unaligned_le16(&data[3]));
62 
63 	/*input_report_key(dev, BTN_TOUCH , data[0] & 0x01);*/
64 	input_report_key(dev, BTN_RIGHT, data[0] & 0x02);
65 
66 	pressure = data[5];
67 	if (kb_pressure_click == -1)
68 		input_report_abs(dev, ABS_PRESSURE, pressure);
69 	else
70 		input_report_key(dev, BTN_LEFT, pressure > kb_pressure_click ? 1 : 0);
71 
72 	input_sync(dev);
73 
74  exit:
75 	retval = usb_submit_urb(urb, GFP_ATOMIC);
76 	if (retval)
77 		dev_err(&kbtab->intf->dev,
78 			"%s - usb_submit_urb failed with result %d\n",
79 			__func__, retval);
80 }
81 
82 static const struct usb_device_id kbtab_ids[] = {
83 	{ USB_DEVICE(USB_VENDOR_ID_KBGEAR, 0x1001), .driver_info = 0 },
84 	{ }
85 };
86 
87 MODULE_DEVICE_TABLE(usb, kbtab_ids);
88 
kbtab_open(struct input_dev * dev)89 static int kbtab_open(struct input_dev *dev)
90 {
91 	struct kbtab *kbtab = input_get_drvdata(dev);
92 	struct usb_device *udev = interface_to_usbdev(kbtab->intf);
93 
94 	kbtab->irq->dev = udev;
95 	if (usb_submit_urb(kbtab->irq, GFP_KERNEL))
96 		return -EIO;
97 
98 	return 0;
99 }
100 
kbtab_close(struct input_dev * dev)101 static void kbtab_close(struct input_dev *dev)
102 {
103 	struct kbtab *kbtab = input_get_drvdata(dev);
104 
105 	usb_kill_urb(kbtab->irq);
106 }
107 
kbtab_probe(struct usb_interface * intf,const struct usb_device_id * id)108 static int kbtab_probe(struct usb_interface *intf, const struct usb_device_id *id)
109 {
110 	struct usb_device *dev = interface_to_usbdev(intf);
111 	struct usb_endpoint_descriptor *endpoint;
112 	struct kbtab *kbtab;
113 	struct input_dev *input_dev;
114 	int error = -ENOMEM;
115 
116 	if (intf->cur_altsetting->desc.bNumEndpoints < 1)
117 		return -ENODEV;
118 
119 	endpoint = &intf->cur_altsetting->endpoint[0].desc;
120 	if (!usb_endpoint_is_int_in(endpoint))
121 		return -ENODEV;
122 
123 	kbtab = kzalloc(sizeof(struct kbtab), GFP_KERNEL);
124 	input_dev = input_allocate_device();
125 	if (!kbtab || !input_dev)
126 		goto fail1;
127 
128 	kbtab->data = usb_alloc_coherent(dev, 8, GFP_KERNEL, &kbtab->data_dma);
129 	if (!kbtab->data)
130 		goto fail1;
131 
132 	kbtab->irq = usb_alloc_urb(0, GFP_KERNEL);
133 	if (!kbtab->irq)
134 		goto fail2;
135 
136 	kbtab->intf = intf;
137 	kbtab->dev = input_dev;
138 
139 	usb_make_path(dev, kbtab->phys, sizeof(kbtab->phys));
140 	strlcat(kbtab->phys, "/input0", sizeof(kbtab->phys));
141 
142 	input_dev->name = "KB Gear Tablet";
143 	input_dev->phys = kbtab->phys;
144 	usb_to_input_id(dev, &input_dev->id);
145 	input_dev->dev.parent = &intf->dev;
146 
147 	input_set_drvdata(input_dev, kbtab);
148 
149 	input_dev->open = kbtab_open;
150 	input_dev->close = kbtab_close;
151 
152 	input_dev->evbit[0] |= BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
153 	input_dev->keybit[BIT_WORD(BTN_LEFT)] |=
154 		BIT_MASK(BTN_LEFT) | BIT_MASK(BTN_RIGHT);
155 	input_dev->keybit[BIT_WORD(BTN_DIGI)] |=
156 		BIT_MASK(BTN_TOOL_PEN) | BIT_MASK(BTN_TOUCH);
157 	input_set_abs_params(input_dev, ABS_X, 0, 0x2000, 4, 0);
158 	input_set_abs_params(input_dev, ABS_Y, 0, 0x1750, 4, 0);
159 	input_set_abs_params(input_dev, ABS_PRESSURE, 0, 0xff, 0, 0);
160 
161 	usb_fill_int_urb(kbtab->irq, dev,
162 			 usb_rcvintpipe(dev, endpoint->bEndpointAddress),
163 			 kbtab->data, 8,
164 			 kbtab_irq, kbtab, endpoint->bInterval);
165 	kbtab->irq->transfer_dma = kbtab->data_dma;
166 	kbtab->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
167 
168 	error = input_register_device(kbtab->dev);
169 	if (error)
170 		goto fail3;
171 
172 	usb_set_intfdata(intf, kbtab);
173 
174 	return 0;
175 
176  fail3:	usb_free_urb(kbtab->irq);
177  fail2:	usb_free_coherent(dev, 8, kbtab->data, kbtab->data_dma);
178  fail1:	input_free_device(input_dev);
179 	kfree(kbtab);
180 	return error;
181 }
182 
kbtab_disconnect(struct usb_interface * intf)183 static void kbtab_disconnect(struct usb_interface *intf)
184 {
185 	struct kbtab *kbtab = usb_get_intfdata(intf);
186 	struct usb_device *udev = interface_to_usbdev(intf);
187 
188 	usb_set_intfdata(intf, NULL);
189 
190 	input_unregister_device(kbtab->dev);
191 	usb_free_urb(kbtab->irq);
192 	usb_free_coherent(udev, 8, kbtab->data, kbtab->data_dma);
193 	kfree(kbtab);
194 }
195 
196 static struct usb_driver kbtab_driver = {
197 	.name =		"kbtab",
198 	.probe =	kbtab_probe,
199 	.disconnect =	kbtab_disconnect,
200 	.id_table =	kbtab_ids,
201 };
202 
203 module_usb_driver(kbtab_driver);
204