1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/kernel.h>
16#include <linux/sched/signal.h>
17#include <linux/errno.h>
18#include <linux/delay.h>
19#include <linux/slab.h>
20#include <linux/module.h>
21#include <linux/completion.h>
22#include <linux/mutex.h>
23#include <linux/uaccess.h>
24#include <linux/usb.h>
25
26
27#define WIDTH 225
28#define HEIGHT 289
29#define HEADER "P5 225 289 255 "
30#define IMGSIZE ((WIDTH * HEIGHT) + sizeof(HEADER)-1)
31
32#define DRIVER_SHORT "idmouse"
33#define DRIVER_AUTHOR "Florian 'Floe' Echtler <echtler@fs.tum.de>"
34#define DRIVER_DESC "Siemens ID Mouse FingerTIP Sensor Driver"
35
36
37#define USB_IDMOUSE_MINOR_BASE 132
38
39
40#define ID_SIEMENS 0x0681
41#define ID_IDMOUSE 0x0005
42#define ID_CHERRY 0x0010
43
44
45static const struct usb_device_id idmouse_table[] = {
46 {USB_DEVICE(ID_SIEMENS, ID_IDMOUSE)},
47 {USB_DEVICE(ID_SIEMENS, ID_CHERRY )},
48 {}
49};
50
51
52#define FTIP_RESET 0x20
53#define FTIP_ACQUIRE 0x21
54#define FTIP_RELEASE 0x22
55#define FTIP_BLINK 0x23
56#define FTIP_SCROLL 0x24
57
58#define ftip_command(dev, command, value, index) \
59 usb_control_msg (dev->udev, usb_sndctrlpipe (dev->udev, 0), command, \
60 USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, value, index, NULL, 0, 1000)
61
62MODULE_DEVICE_TABLE(usb, idmouse_table);
63static DEFINE_MUTEX(open_disc_mutex);
64
65
66struct usb_idmouse {
67
68 struct usb_device *udev;
69 struct usb_interface *interface;
70
71 unsigned char *bulk_in_buffer;
72 size_t bulk_in_size;
73 size_t orig_bi_size;
74 __u8 bulk_in_endpointAddr;
75
76 int open;
77 int present;
78 struct mutex lock;
79
80};
81
82
83static ssize_t idmouse_read(struct file *file, char __user *buffer,
84 size_t count, loff_t * ppos);
85
86static int idmouse_open(struct inode *inode, struct file *file);
87static int idmouse_release(struct inode *inode, struct file *file);
88
89static int idmouse_probe(struct usb_interface *interface,
90 const struct usb_device_id *id);
91
92static void idmouse_disconnect(struct usb_interface *interface);
93static int idmouse_suspend(struct usb_interface *intf, pm_message_t message);
94static int idmouse_resume(struct usb_interface *intf);
95
96
97static const struct file_operations idmouse_fops = {
98 .owner = THIS_MODULE,
99 .read = idmouse_read,
100 .open = idmouse_open,
101 .release = idmouse_release,
102 .llseek = default_llseek,
103};
104
105
106static struct usb_class_driver idmouse_class = {
107 .name = "idmouse%d",
108 .fops = &idmouse_fops,
109 .minor_base = USB_IDMOUSE_MINOR_BASE,
110};
111
112
113static struct usb_driver idmouse_driver = {
114 .name = DRIVER_SHORT,
115 .probe = idmouse_probe,
116 .disconnect = idmouse_disconnect,
117 .suspend = idmouse_suspend,
118 .resume = idmouse_resume,
119 .reset_resume = idmouse_resume,
120 .id_table = idmouse_table,
121 .supports_autosuspend = 1,
122};
123
124static int idmouse_create_image(struct usb_idmouse *dev)
125{
126 int bytes_read;
127 int bulk_read;
128 int result;
129
130 memcpy(dev->bulk_in_buffer, HEADER, sizeof(HEADER)-1);
131 bytes_read = sizeof(HEADER)-1;
132
133
134 result = ftip_command(dev, FTIP_RELEASE, 0, 0);
135 if (result < 0)
136 goto reset;
137 result = ftip_command(dev, FTIP_BLINK, 1, 0);
138 if (result < 0)
139 goto reset;
140
141
142
143 result = ftip_command(dev, FTIP_ACQUIRE, 0, 0);
144 if (result < 0)
145 goto reset;
146 result = ftip_command(dev, FTIP_ACQUIRE, 0, 0);
147 if (result < 0)
148 goto reset;
149
150
151
152 result = ftip_command(dev, FTIP_RESET, 0, 0);
153 if (result < 0)
154 goto reset;
155 result = ftip_command(dev, FTIP_RESET, 0, 0);
156 if (result < 0)
157 goto reset;
158
159
160 while (bytes_read < IMGSIZE) {
161 result = usb_bulk_msg (dev->udev,
162 usb_rcvbulkpipe (dev->udev, dev->bulk_in_endpointAddr),
163 dev->bulk_in_buffer + bytes_read,
164 dev->bulk_in_size, &bulk_read, 5000);
165 if (result < 0) {
166
167
168 if (dev->bulk_in_size != dev->orig_bi_size) {
169 dev->bulk_in_size = dev->orig_bi_size;
170 result = -EAGAIN;
171 }
172 break;
173 }
174 if (signal_pending(current)) {
175 result = -EINTR;
176 break;
177 }
178 bytes_read += bulk_read;
179 }
180
181
182reset:
183 ftip_command(dev, FTIP_RELEASE, 0, 0);
184
185
186
187 for (bytes_read = sizeof(HEADER)-1 + WIDTH-1; bytes_read < IMGSIZE; bytes_read += WIDTH)
188 if (dev->bulk_in_buffer[bytes_read] != 0x00)
189 return -EAGAIN;
190
191
192 for (bytes_read = IMGSIZE-WIDTH; bytes_read < IMGSIZE-1; bytes_read++)
193 if (dev->bulk_in_buffer[bytes_read] != 0xFF)
194 return -EAGAIN;
195
196
197 dev_dbg(&dev->interface->dev, "read %d bytes fingerprint data\n",
198 bytes_read);
199 return result;
200}
201
202
203static int idmouse_suspend(struct usb_interface *intf, pm_message_t message)
204{
205 return 0;
206}
207
208static int idmouse_resume(struct usb_interface *intf)
209{
210 return 0;
211}
212
213static inline void idmouse_delete(struct usb_idmouse *dev)
214{
215 kfree(dev->bulk_in_buffer);
216 kfree(dev);
217}
218
219static int idmouse_open(struct inode *inode, struct file *file)
220{
221 struct usb_idmouse *dev;
222 struct usb_interface *interface;
223 int result;
224
225
226 interface = usb_find_interface (&idmouse_driver, iminor (inode));
227 if (!interface)
228 return -ENODEV;
229
230 mutex_lock(&open_disc_mutex);
231
232 dev = usb_get_intfdata(interface);
233 if (!dev) {
234 mutex_unlock(&open_disc_mutex);
235 return -ENODEV;
236 }
237
238
239 mutex_lock(&dev->lock);
240 mutex_unlock(&open_disc_mutex);
241
242
243 if (dev->open) {
244
245
246 result = -EBUSY;
247
248 } else {
249
250
251 result = usb_autopm_get_interface(interface);
252 if (result)
253 goto error;
254 result = idmouse_create_image (dev);
255 usb_autopm_put_interface(interface);
256 if (result)
257 goto error;
258
259
260 ++dev->open;
261
262
263 file->private_data = dev;
264
265 }
266
267error:
268
269
270 mutex_unlock(&dev->lock);
271 return result;
272}
273
274static int idmouse_release(struct inode *inode, struct file *file)
275{
276 struct usb_idmouse *dev;
277
278 dev = file->private_data;
279
280 if (dev == NULL)
281 return -ENODEV;
282
283 mutex_lock(&open_disc_mutex);
284
285 mutex_lock(&dev->lock);
286
287
288 if (dev->open <= 0) {
289 mutex_unlock(&dev->lock);
290 mutex_unlock(&open_disc_mutex);
291 return -ENODEV;
292 }
293
294 --dev->open;
295
296 if (!dev->present) {
297
298 mutex_unlock(&dev->lock);
299 mutex_unlock(&open_disc_mutex);
300 idmouse_delete(dev);
301 } else {
302 mutex_unlock(&dev->lock);
303 mutex_unlock(&open_disc_mutex);
304 }
305 return 0;
306}
307
308static ssize_t idmouse_read(struct file *file, char __user *buffer, size_t count,
309 loff_t * ppos)
310{
311 struct usb_idmouse *dev = file->private_data;
312 int result;
313
314
315 mutex_lock(&dev->lock);
316
317
318 if (!dev->present) {
319 mutex_unlock(&dev->lock);
320 return -ENODEV;
321 }
322
323 result = simple_read_from_buffer(buffer, count, ppos,
324 dev->bulk_in_buffer, IMGSIZE);
325
326 mutex_unlock(&dev->lock);
327 return result;
328}
329
330static int idmouse_probe(struct usb_interface *interface,
331 const struct usb_device_id *id)
332{
333 struct usb_device *udev = interface_to_usbdev(interface);
334 struct usb_idmouse *dev;
335 struct usb_host_interface *iface_desc;
336 struct usb_endpoint_descriptor *endpoint;
337 int result;
338
339
340 iface_desc = &interface->altsetting[0];
341 if (iface_desc->desc.bInterfaceClass != 0x0A)
342 return -ENODEV;
343
344 if (iface_desc->desc.bNumEndpoints < 1)
345 return -ENODEV;
346
347
348 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
349 if (dev == NULL)
350 return -ENOMEM;
351
352 mutex_init(&dev->lock);
353 dev->udev = udev;
354 dev->interface = interface;
355
356
357 result = usb_find_bulk_in_endpoint(iface_desc, &endpoint);
358 if (result) {
359 dev_err(&interface->dev, "Unable to find bulk-in endpoint.\n");
360 idmouse_delete(dev);
361 return result;
362 }
363
364 dev->orig_bi_size = usb_endpoint_maxp(endpoint);
365 dev->bulk_in_size = 0x200;
366 dev->bulk_in_endpointAddr = endpoint->bEndpointAddress;
367 dev->bulk_in_buffer = kmalloc(IMGSIZE + dev->bulk_in_size, GFP_KERNEL);
368 if (!dev->bulk_in_buffer) {
369 idmouse_delete(dev);
370 return -ENOMEM;
371 }
372
373
374 dev->present = 1;
375
376
377 usb_set_intfdata(interface, dev);
378 result = usb_register_dev(interface, &idmouse_class);
379 if (result) {
380
381 dev_err(&interface->dev, "Unable to allocate minor number.\n");
382 usb_set_intfdata(interface, NULL);
383 idmouse_delete(dev);
384 return result;
385 }
386
387
388 dev_info(&interface->dev,"%s now attached\n",DRIVER_DESC);
389
390 return 0;
391}
392
393static void idmouse_disconnect(struct usb_interface *interface)
394{
395 struct usb_idmouse *dev;
396
397
398 dev = usb_get_intfdata(interface);
399
400
401 usb_deregister_dev(interface, &idmouse_class);
402
403 mutex_lock(&open_disc_mutex);
404 usb_set_intfdata(interface, NULL);
405
406 mutex_lock(&dev->lock);
407 mutex_unlock(&open_disc_mutex);
408
409
410 dev->present = 0;
411
412
413 if (!dev->open) {
414 mutex_unlock(&dev->lock);
415 idmouse_delete(dev);
416 } else {
417
418 mutex_unlock(&dev->lock);
419 }
420
421 dev_info(&interface->dev, "disconnected\n");
422}
423
424module_usb_driver(idmouse_driver);
425
426MODULE_AUTHOR(DRIVER_AUTHOR);
427MODULE_DESCRIPTION(DRIVER_DESC);
428MODULE_LICENSE("GPL");
429
430