406 lines · 10.5 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0+/* Siemens ID Mouse driver v0.6   Copyright (C) 2004-5 by Florian 'Floe' Echtler  <echtler@fs.tum.de>                      and Andreas  'ad'  Deresch <aderesch@fs.tum.de>   Derived from the USB Skeleton driver 1.1,  Copyright (C) 2003 Greg Kroah-Hartman (greg@kroah.com)   Additional information provided by Martin Reising  <Martin.Reising@natural-computing.de> */ #include <linux/kernel.h>#include <linux/sched/signal.h>#include <linux/errno.h>#include <linux/delay.h>#include <linux/slab.h>#include <linux/module.h>#include <linux/completion.h>#include <linux/mutex.h>#include <linux/uaccess.h>#include <linux/usb.h> /* image constants */#define WIDTH 225#define HEIGHT 289#define HEADER "P5 225 289 255 "#define IMGSIZE ((WIDTH * HEIGHT) + sizeof(HEADER)-1) #define DRIVER_SHORT   "idmouse"#define DRIVER_AUTHOR  "Florian 'Floe' Echtler <echtler@fs.tum.de>"#define DRIVER_DESC    "Siemens ID Mouse FingerTIP Sensor Driver" /* minor number for misc USB devices */#define USB_IDMOUSE_MINOR_BASE 132 /* vendor and device IDs */#define ID_SIEMENS 0x0681#define ID_IDMOUSE 0x0005#define ID_CHERRY  0x0010 /* device ID table */static const struct usb_device_id idmouse_table[] = {	{USB_DEVICE(ID_SIEMENS, ID_IDMOUSE)}, /* Siemens ID Mouse (Professional) */	{USB_DEVICE(ID_SIEMENS, ID_CHERRY )}, /* Cherry FingerTIP ID Board       */	{}                                    /* terminating null entry          */}; /* sensor commands */#define FTIP_RESET   0x20#define FTIP_ACQUIRE 0x21#define FTIP_RELEASE 0x22#define FTIP_BLINK   0x23  /* LSB of value = blink pulse width */#define FTIP_SCROLL  0x24 #define ftip_command(dev, command, value, index) \	usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), command, \	USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, value, index, NULL, 0, 1000) MODULE_DEVICE_TABLE(usb, idmouse_table); /* structure to hold all of our device specific stuff */struct usb_idmouse {	struct kref kref; 	struct usb_device *udev; /* save off the usb device pointer */	struct usb_interface *interface; /* the interface for this device */ 	unsigned char *bulk_in_buffer; /* the buffer to receive data */	size_t bulk_in_size; /* the maximum bulk packet size */	size_t orig_bi_size; /* same as above, but reported by the device */	__u8 bulk_in_endpointAddr; /* the address of the bulk in endpoint */ 	int open; /* if the port is open or not */	int present; /* if the device is not disconnected */	struct mutex lock; /* locks this structure */ }; /* local function prototypes */static ssize_t idmouse_read(struct file *file, char __user *buffer,				size_t count, loff_t * ppos); static int idmouse_open(struct inode *inode, struct file *file);static int idmouse_release(struct inode *inode, struct file *file); static int idmouse_probe(struct usb_interface *interface,				const struct usb_device_id *id); static void idmouse_disconnect(struct usb_interface *interface);static int idmouse_suspend(struct usb_interface *intf, pm_message_t message);static int idmouse_resume(struct usb_interface *intf); /* file operation pointers */static const struct file_operations idmouse_fops = {	.owner = THIS_MODULE,	.read = idmouse_read,	.open = idmouse_open,	.release = idmouse_release,	.llseek = default_llseek,}; /* class driver information */static struct usb_class_driver idmouse_class = {	.name = "idmouse%d",	.fops = &idmouse_fops,	.minor_base = USB_IDMOUSE_MINOR_BASE,}; /* usb specific object needed to register this driver with the usb subsystem */static struct usb_driver idmouse_driver = {	.name = DRIVER_SHORT,	.probe = idmouse_probe,	.disconnect = idmouse_disconnect,	.suspend = idmouse_suspend,	.resume = idmouse_resume,	.reset_resume = idmouse_resume,	.id_table = idmouse_table,	.supports_autosuspend = 1,}; static int idmouse_create_image(struct usb_idmouse *dev){	int bytes_read;	int bulk_read;	int result; 	memcpy(dev->bulk_in_buffer, HEADER, sizeof(HEADER)-1);	bytes_read = sizeof(HEADER)-1; 	/* reset the device and set a fast blink rate */	result = ftip_command(dev, FTIP_RELEASE, 0, 0);	if (result < 0)		goto reset;	result = ftip_command(dev, FTIP_BLINK,   1, 0);	if (result < 0)		goto reset; 	/* initialize the sensor - sending this command twice */	/* significantly reduces the rate of failed reads     */	result = ftip_command(dev, FTIP_ACQUIRE, 0, 0);	if (result < 0)		goto reset;	result = ftip_command(dev, FTIP_ACQUIRE, 0, 0);	if (result < 0)		goto reset; 	/* start the readout - sending this command twice */	/* presumably enables the high dynamic range mode */	result = ftip_command(dev, FTIP_RESET,   0, 0);	if (result < 0)		goto reset;	result = ftip_command(dev, FTIP_RESET,   0, 0);	if (result < 0)		goto reset; 	/* loop over a blocking bulk read to get data from the device */	while (bytes_read < IMGSIZE) {		result = usb_bulk_msg(dev->udev,				usb_rcvbulkpipe(dev->udev, dev->bulk_in_endpointAddr),				dev->bulk_in_buffer + bytes_read,				dev->bulk_in_size, &bulk_read, 5000);		if (result < 0) {			/* Maybe this error was caused by the increased packet size? */			/* Reset to the original value and tell userspace to retry.  */			if (dev->bulk_in_size != dev->orig_bi_size) {				dev->bulk_in_size = dev->orig_bi_size;				result = -EAGAIN;			}			break;		}		if (signal_pending(current)) {			result = -EINTR;			break;		}		bytes_read += bulk_read;	} 	/* check for valid image */	/* right border should be black (0x00) */	for (bytes_read = sizeof(HEADER)-1 + WIDTH-1; bytes_read < IMGSIZE; bytes_read += WIDTH)		if (dev->bulk_in_buffer[bytes_read] != 0x00)			return -EAGAIN; 	/* lower border should be white (0xFF) */	for (bytes_read = IMGSIZE-WIDTH; bytes_read < IMGSIZE-1; bytes_read++)		if (dev->bulk_in_buffer[bytes_read] != 0xFF)			return -EAGAIN; 	/* reset the device */reset:	ftip_command(dev, FTIP_RELEASE, 0, 0); 	/* should be IMGSIZE == 65040 */	dev_dbg(&dev->interface->dev, "read %d bytes fingerprint data\n",		bytes_read);	return result;} /* PM operations are nops as this driver does IO only during open() */static int idmouse_suspend(struct usb_interface *intf, pm_message_t message){	return 0;} static int idmouse_resume(struct usb_interface *intf){	return 0;} static inline void idmouse_delete(struct kref *kref){	struct usb_idmouse *dev = container_of(kref, struct usb_idmouse, kref); 	kfree(dev->bulk_in_buffer);	kfree(dev);} static int idmouse_open(struct inode *inode, struct file *file){	struct usb_idmouse *dev;	struct usb_interface *interface;	int result; 	/* get the interface from minor number and driver information */	interface = usb_find_interface(&idmouse_driver, iminor(inode));	if (!interface)		return -ENODEV; 	/* get the device information block from the interface */	dev = usb_get_intfdata(interface);	if (!dev)		return -ENODEV; 	/* lock this device */	mutex_lock(&dev->lock); 	/* check if already open */	if (dev->open) { 		/* already open, so fail */		result = -EBUSY; 	} else { 		/* create a new image and check for success */		result = usb_autopm_get_interface(interface);		if (result)			goto error;		result = idmouse_create_image(dev);		usb_autopm_put_interface(interface);		if (result)			goto error; 		/* increment our usage count for the driver */		++dev->open; 		kref_get(&dev->kref); 		/* save our object in the file's private structure */		file->private_data = dev; 	}  error: 	/* unlock this device */	mutex_unlock(&dev->lock);	return result;} static int idmouse_release(struct inode *inode, struct file *file){	struct usb_idmouse *dev; 	dev = file->private_data; 	if (dev == NULL)		return -ENODEV; 	/* lock our device */	mutex_lock(&dev->lock);	--dev->open;	mutex_unlock(&dev->lock); 	kref_put(&dev->kref, idmouse_delete); 	return 0;} static ssize_t idmouse_read(struct file *file, char __user *buffer, size_t count,				loff_t * ppos){	struct usb_idmouse *dev = file->private_data;	int result; 	/* lock this object */	mutex_lock(&dev->lock); 	/* verify that the device wasn't unplugged */	if (!dev->present) {		mutex_unlock(&dev->lock);		return -ENODEV;	} 	result = simple_read_from_buffer(buffer, count, ppos,					dev->bulk_in_buffer, IMGSIZE);	/* unlock the device */	mutex_unlock(&dev->lock);	return result;} static int idmouse_probe(struct usb_interface *interface,				const struct usb_device_id *id){	struct usb_device *udev = interface_to_usbdev(interface);	struct usb_idmouse *dev;	struct usb_host_interface *iface_desc;	struct usb_endpoint_descriptor *endpoint;	int result; 	/* check if we have gotten the data or the hid interface */	iface_desc = interface->cur_altsetting;	if (iface_desc->desc.bInterfaceClass != 0x0A)		return -ENODEV; 	if (iface_desc->desc.bNumEndpoints < 1)		return -ENODEV; 	/* allocate memory for our device state and initialize it */	dev = kzalloc_obj(*dev);	if (dev == NULL)		return -ENOMEM; 	kref_init(&dev->kref);	mutex_init(&dev->lock);	dev->udev = udev;	dev->interface = interface; 	/* set up the endpoint information - use only the first bulk-in endpoint */	result = usb_find_bulk_in_endpoint(iface_desc, &endpoint);	if (result) {		dev_err(&interface->dev, "Unable to find bulk-in endpoint.\n");		goto err_put_kref;	} 	dev->orig_bi_size = usb_endpoint_maxp(endpoint);	dev->bulk_in_size = 0x200; /* works _much_ faster */	dev->bulk_in_endpointAddr = endpoint->bEndpointAddress;	dev->bulk_in_buffer = kmalloc(IMGSIZE + dev->bulk_in_size, GFP_KERNEL);	if (!dev->bulk_in_buffer) {		result = -ENOMEM;		goto err_put_kref;	} 	/* allow device read, write and ioctl */	dev->present = 1; 	/* we can register the device now, as it is ready */	usb_set_intfdata(interface, dev);	result = usb_register_dev(interface, &idmouse_class);	if (result) {		/* something prevented us from registering this device */		dev_err(&interface->dev, "Unable to allocate minor number.\n");		goto err_put_kref;	} 	/* be noisy */	dev_info(&interface->dev,"%s now attached\n",DRIVER_DESC); 	return 0; err_put_kref:	kref_put(&dev->kref, idmouse_delete); 	return result;} static void idmouse_disconnect(struct usb_interface *interface){	struct usb_idmouse *dev = usb_get_intfdata(interface); 	/* give back our minor */	usb_deregister_dev(interface, &idmouse_class); 	/* lock the device */	mutex_lock(&dev->lock); 	/* prevent device read, write and ioctl */	dev->present = 0; 	mutex_unlock(&dev->lock); 	kref_put(&dev->kref, idmouse_delete); 	dev_info(&interface->dev, "disconnected\n");} module_usb_driver(idmouse_driver); MODULE_AUTHOR(DRIVER_AUTHOR);MODULE_DESCRIPTION(DRIVER_DESC);MODULE_LICENSE("GPL");