[PATCH] USB: add driver for Keyspan Digital Remote
This driver is a basic keypress input driver for the Keyspan Digital Remote with part number UIA-11. Currently there is an older remote with part number UIA-10 which isn't supported by this driver. Support for the older UIA-10 could be added but a binary file is required to be download to the device, and I don't have that file. I also don't have a UIA-10 device so I wouldn't be able to test any of the changes. Signed-off-by: Michael Downey <downey@zymeta.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
		
							parent
							
								
									30e6959866
								
							
						
					
					
						commit
						99f83c9c9a
					
				| @ -259,3 +259,16 @@ config USB_ATI_REMOTE | ||||
| 	  To compile this driver as a module, choose M here: the module will be | ||||
| 	  called ati_remote. | ||||
| 
 | ||||
| config USB_KEYSPAN_REMOTE | ||||
| 	tristate "Keyspan DMR USB remote control (EXPERIMENTAL)" | ||||
| 	depends on USB && INPUT && EXPERIMENTAL | ||||
| 	---help--- | ||||
| 	  Say Y here if you want to use a Keyspan DMR USB remote control. | ||||
| 	  Currently only the UIA-11 type of receiver has been tested.  The tag | ||||
| 	  on the receiver that connects to the USB port should have a P/N that | ||||
| 	  will tell you what type of DMR you have.  The UIA-10 type is not | ||||
| 	  supported at this time.  This driver maps all buttons to keypress | ||||
| 	  events. | ||||
| 
 | ||||
| 	  To compile this driver as a module, choose M here: the module will | ||||
| 	  be called keyspan_remote. | ||||
|  | ||||
| @ -31,6 +31,7 @@ obj-$(CONFIG_USB_ATI_REMOTE)	+= ati_remote.o | ||||
| obj-$(CONFIG_USB_HID)		+= usbhid.o | ||||
| obj-$(CONFIG_USB_KBD)		+= usbkbd.o | ||||
| obj-$(CONFIG_USB_KBTAB)		+= kbtab.o | ||||
| obj-$(CONFIG_USB_KEYSPAN_REMOTE)	+= keyspan_remote.o | ||||
| obj-$(CONFIG_USB_MOUSE)		+= usbmouse.o | ||||
| obj-$(CONFIG_USB_MTOUCH)	+= mtouchusb.o | ||||
| obj-$(CONFIG_USB_ITMTOUCH)	+= itmtouch.o | ||||
|  | ||||
							
								
								
									
										633
									
								
								drivers/usb/input/keyspan_remote.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										633
									
								
								drivers/usb/input/keyspan_remote.c
									
									
									
									
									
										Normal file
									
								
							| @ -0,0 +1,633 @@ | ||||
| /*
 | ||||
|  * keyspan_remote: USB driver for the Keyspan DMR | ||||
|  * | ||||
|  * Copyright (C) 2005 Zymeta Corporation - Michael Downey (downey@zymeta.com) | ||||
|  * | ||||
|  *	This program is free software; you can redistribute it and/or | ||||
|  *	modify it under the terms of the GNU General Public License as | ||||
|  *	published by the Free Software Foundation, version 2. | ||||
|  * | ||||
|  * This driver has been put together with the support of Innosys, Inc. | ||||
|  * and Keyspan, Inc the manufacturers of the Keyspan USB DMR product. | ||||
|  */ | ||||
| 
 | ||||
| #include <linux/config.h> | ||||
| #include <linux/kernel.h> | ||||
| #include <linux/errno.h> | ||||
| #include <linux/init.h> | ||||
| #include <linux/slab.h> | ||||
| #include <linux/module.h> | ||||
| #include <linux/moduleparam.h> | ||||
| #include <linux/input.h> | ||||
| #include <linux/usb.h> | ||||
| 
 | ||||
| #define DRIVER_VERSION	"v0.1" | ||||
| #define DRIVER_AUTHOR	"Michael Downey <downey@zymeta.com>" | ||||
| #define DRIVER_DESC	"Driver for the USB Keyspan remote control." | ||||
| #define DRIVER_LICENSE	"GPL" | ||||
| 
 | ||||
| /* Parameters that can be passed to the driver. */ | ||||
| static int debug; | ||||
| module_param(debug, int, 0444); | ||||
| MODULE_PARM_DESC(debug, "Enable extra debug messages and information"); | ||||
| 
 | ||||
| /* Vendor and product ids */ | ||||
| #define USB_KEYSPAN_VENDOR_ID		0x06CD | ||||
| #define USB_KEYSPAN_PRODUCT_UIA11	0x0202 | ||||
| 
 | ||||
| /* Defines for converting the data from the remote. */ | ||||
| #define ZERO		0x18 | ||||
| #define ZERO_MASK	0x1F	/* 5 bits for a 0 */ | ||||
| #define ONE		0x3C | ||||
| #define ONE_MASK	0x3F	/* 6 bits for a 1 */ | ||||
| #define SYNC		0x3F80 | ||||
| #define SYNC_MASK	0x3FFF	/* 14 bits for a SYNC sequence */ | ||||
| #define STOP		0x00 | ||||
| #define STOP_MASK	0x1F	/* 5 bits for the STOP sequence */ | ||||
| #define GAP		0xFF | ||||
| 
 | ||||
| #define RECV_SIZE	8	/* The UIA-11 type have a 8 byte limit. */ | ||||
| 
 | ||||
| /* table of devices that work with this driver */ | ||||
| static struct usb_device_id keyspan_table[] = { | ||||
| 	{ USB_DEVICE(USB_KEYSPAN_VENDOR_ID, USB_KEYSPAN_PRODUCT_UIA11) }, | ||||
| 	{ }					/* Terminating entry */ | ||||
| }; | ||||
| 
 | ||||
| /* Structure to store all the real stuff that a remote sends to us. */ | ||||
| struct keyspan_message { | ||||
| 	u16	system; | ||||
| 	u8	button; | ||||
| 	u8	toggle; | ||||
| }; | ||||
| 
 | ||||
| /* Structure used for all the bit testing magic needed to be done. */ | ||||
| struct bit_tester { | ||||
| 	u32	tester; | ||||
| 	int	len; | ||||
| 	int	pos; | ||||
| 	int	bits_left; | ||||
| 	u8	buffer[32]; | ||||
| }; | ||||
| 
 | ||||
| /* Structure to hold all of our driver specific stuff */ | ||||
| struct usb_keyspan { | ||||
| 	char				name[128]; | ||||
| 	char				phys[64]; | ||||
| 	struct usb_device*		udev; | ||||
| 	struct input_dev		input; | ||||
| 	struct usb_interface*		interface; | ||||
| 	struct usb_endpoint_descriptor* in_endpoint; | ||||
| 	struct urb*			irq_urb; | ||||
| 	int				open; | ||||
| 	dma_addr_t			in_dma; | ||||
| 	unsigned char*			in_buffer; | ||||
| 
 | ||||
| 	/* variables used to parse messages from remote. */ | ||||
| 	struct bit_tester		data; | ||||
| 	int				stage; | ||||
| 	int				toggle; | ||||
| }; | ||||
| 
 | ||||
| /*
 | ||||
|  * Table that maps the 31 possible keycodes to input keys. | ||||
|  * Currently there are 15 and 17 button models so RESERVED codes | ||||
|  * are blank areas in the mapping. | ||||
|  */ | ||||
| static int keyspan_key_table[] = { | ||||
| 	KEY_RESERVED,		/* 0 is just a place holder. */ | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_STOP, | ||||
| 	KEY_PLAYCD, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_PREVIOUSSONG, | ||||
| 	KEY_REWIND, | ||||
| 	KEY_FORWARD, | ||||
| 	KEY_NEXTSONG, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_PAUSE, | ||||
| 	KEY_VOLUMEUP, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_VOLUMEDOWN, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_UP, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_MUTE, | ||||
| 	KEY_LEFT, | ||||
| 	KEY_ENTER, | ||||
| 	KEY_RIGHT, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_DOWN, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_KPASTERISK, | ||||
| 	KEY_RESERVED, | ||||
| 	KEY_MENU | ||||
| }; | ||||
| 
 | ||||
| static struct usb_driver keyspan_driver; | ||||
| 
 | ||||
| /*
 | ||||
|  * Debug routine that prints out what we've received from the remote. | ||||
|  */ | ||||
| static void keyspan_print(struct usb_keyspan* dev) /*unsigned char* data)*/ | ||||
| { | ||||
| 	char codes[4*RECV_SIZE]; | ||||
| 	int i; | ||||
| 
 | ||||
| 	for (i = 0; i < RECV_SIZE; i++) { | ||||
| 		snprintf(codes+i*3, 4, "%02x ", dev->in_buffer[i]); | ||||
| 	} | ||||
| 
 | ||||
| 	dev_info(&dev->udev->dev, "%s\n", codes); | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Routine that manages the bit_tester structure.  It makes sure that there are | ||||
|  * at least bits_needed bits loaded into the tester. | ||||
|  */ | ||||
| static int keyspan_load_tester(struct usb_keyspan* dev, int bits_needed) | ||||
| { | ||||
| 	if (dev->data.bits_left >= bits_needed) | ||||
| 		return(0); | ||||
| 
 | ||||
| 	/*
 | ||||
| 	 * Somehow we've missed the last message. The message will be repeated | ||||
| 	 * though so it's not too big a deal | ||||
| 	 */ | ||||
| 	if (dev->data.pos >= dev->data.len) { | ||||
| 		dev_dbg(&dev->udev, "%s - Error ran out of data. pos: %d, len: %d\n", | ||||
| 			__FUNCTION__, dev->data.pos, dev->data.len); | ||||
| 		return(-1); | ||||
| 	} | ||||
| 
 | ||||
| 	/* Load as much as we can into the tester. */ | ||||
| 	while ((dev->data.bits_left + 7 < (sizeof(dev->data.tester) * 8)) && | ||||
| 	       (dev->data.pos < dev->data.len)) { | ||||
| 		dev->data.tester += (dev->data.buffer[dev->data.pos++] << dev->data.bits_left); | ||||
| 		dev->data.bits_left += 8; | ||||
| 	} | ||||
| 
 | ||||
| 	return(0); | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Routine that handles all the logic needed to parse out the message from the remote. | ||||
|  */ | ||||
| static void keyspan_check_data(struct usb_keyspan *remote, struct pt_regs *regs) | ||||
| { | ||||
| 	int i; | ||||
| 	int found = 0; | ||||
| 	struct keyspan_message message; | ||||
| 
 | ||||
| 	switch(remote->stage) { | ||||
| 	case 0: | ||||
| 		/*
 | ||||
| 		 * In stage 0 we want to find the start of a message.  The remote sends a 0xFF as filler. | ||||
| 		 * So the first byte that isn't a FF should be the start of a new message. | ||||
| 		 */ | ||||
| 		for (i = 0; i < RECV_SIZE && remote->in_buffer[i] == GAP; ++i); | ||||
| 
 | ||||
| 		if (i < RECV_SIZE) { | ||||
| 			memcpy(remote->data.buffer, remote->in_buffer, RECV_SIZE); | ||||
| 			remote->data.len = RECV_SIZE; | ||||
| 			remote->data.pos = 0; | ||||
| 			remote->data.tester = 0; | ||||
| 			remote->data.bits_left = 0; | ||||
| 			remote->stage = 1; | ||||
| 		} | ||||
| 		break; | ||||
| 
 | ||||
| 	case 1: | ||||
| 		/*
 | ||||
| 		 * Stage 1 we should have 16 bytes and should be able to detect a | ||||
| 		 * SYNC.  The SYNC is 14 bits, 7 0's and then 7 1's. | ||||
| 		 */ | ||||
| 		memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE); | ||||
| 		remote->data.len += RECV_SIZE; | ||||
| 
 | ||||
| 		found = 0; | ||||
| 		while ((remote->data.bits_left >= 14 || remote->data.pos < remote->data.len) && !found) { | ||||
| 			for (i = 0; i < 8; ++i) { | ||||
| 				if (keyspan_load_tester(remote, 14) != 0) { | ||||
| 					remote->stage = 0; | ||||
| 					return; | ||||
| 				} | ||||
| 
 | ||||
| 				if ((remote->data.tester & SYNC_MASK) == SYNC) { | ||||
| 					remote->data.tester = remote->data.tester >> 14; | ||||
| 					remote->data.bits_left -= 14; | ||||
| 					found = 1; | ||||
| 					break; | ||||
| 				} else { | ||||
| 					remote->data.tester = remote->data.tester >> 1; | ||||
| 					--remote->data.bits_left; | ||||
| 				} | ||||
| 			} | ||||
| 		} | ||||
| 
 | ||||
| 		if (!found) { | ||||
| 			remote->stage = 0; | ||||
| 			remote->data.len = 0; | ||||
| 		} else { | ||||
| 			remote->stage = 2; | ||||
| 		} | ||||
| 		break; | ||||
| 
 | ||||
| 	case 2: | ||||
| 		/*
 | ||||
| 		 * Stage 2 we should have 24 bytes which will be enough for a full | ||||
| 		 * message.  We need to parse out the system code, button code, | ||||
| 		 * toggle code, and stop. | ||||
| 		 */ | ||||
| 		memcpy(remote->data.buffer + remote->data.len, remote->in_buffer, RECV_SIZE); | ||||
| 		remote->data.len += RECV_SIZE; | ||||
| 
 | ||||
| 		message.system = 0; | ||||
| 		for (i = 0; i < 9; i++) { | ||||
| 			keyspan_load_tester(remote, 6); | ||||
| 
 | ||||
| 			if ((remote->data.tester & ZERO_MASK) == ZERO) { | ||||
| 				message.system = message.system << 1; | ||||
| 				remote->data.tester = remote->data.tester >> 5; | ||||
| 				remote->data.bits_left -= 5; | ||||
| 			} else if ((remote->data.tester & ONE_MASK) == ONE) { | ||||
| 				message.system = (message.system << 1) + 1; | ||||
| 				remote->data.tester = remote->data.tester >> 6; | ||||
| 				remote->data.bits_left -= 6; | ||||
| 			} else { | ||||
| 				err("%s - Unknown sequence found in system data.\n", __FUNCTION__); | ||||
| 				remote->stage = 0; | ||||
| 				return; | ||||
| 			} | ||||
| 		} | ||||
| 
 | ||||
| 		message.button = 0; | ||||
| 		for (i = 0; i < 5; i++) { | ||||
| 			keyspan_load_tester(remote, 6); | ||||
| 
 | ||||
| 			if ((remote->data.tester & ZERO_MASK) == ZERO) { | ||||
| 				message.button = message.button << 1; | ||||
| 				remote->data.tester = remote->data.tester >> 5; | ||||
| 				remote->data.bits_left -= 5; | ||||
| 			} else if ((remote->data.tester & ONE_MASK) == ONE) { | ||||
| 				message.button = (message.button << 1) + 1; | ||||
| 				remote->data.tester = remote->data.tester >> 6; | ||||
| 				remote->data.bits_left -= 6; | ||||
| 			} else { | ||||
| 				err("%s - Unknown sequence found in button data.\n", __FUNCTION__); | ||||
| 				remote->stage = 0; | ||||
| 				return; | ||||
| 			} | ||||
| 		} | ||||
| 
 | ||||
| 		keyspan_load_tester(remote, 6); | ||||
| 		if ((remote->data.tester & ZERO_MASK) == ZERO) { | ||||
| 			message.toggle = 0; | ||||
| 			remote->data.tester = remote->data.tester >> 5; | ||||
| 			remote->data.bits_left -= 5; | ||||
| 		} else if ((remote->data.tester & ONE_MASK) == ONE) { | ||||
| 			message.toggle = 1; | ||||
| 			remote->data.tester = remote->data.tester >> 6; | ||||
| 			remote->data.bits_left -= 6; | ||||
| 		} else { | ||||
| 			err("%s - Error in message, invalid toggle.\n", __FUNCTION__); | ||||
| 		} | ||||
| 
 | ||||
| 		keyspan_load_tester(remote, 5); | ||||
| 		if ((remote->data.tester & STOP_MASK) == STOP) { | ||||
| 			remote->data.tester = remote->data.tester >> 5; | ||||
| 			remote->data.bits_left -= 5; | ||||
| 		} else { | ||||
| 			err("Bad message recieved, no stop bit found.\n"); | ||||
| 		} | ||||
| 
 | ||||
| 		dev_dbg(&remote->udev, | ||||
| 			"%s found valid message: system: %d, button: %d, toggle: %d\n", | ||||
| 			__FUNCTION__, message.system, message.button, message.toggle); | ||||
| 
 | ||||
| 		if (message.toggle != remote->toggle) { | ||||
| 			input_regs(&remote->input, regs); | ||||
| 			input_report_key(&remote->input, keyspan_key_table[message.button], 1); | ||||
| 			input_report_key(&remote->input, keyspan_key_table[message.button], 0); | ||||
| 			input_sync(&remote->input); | ||||
| 			remote->toggle = message.toggle; | ||||
| 		} | ||||
| 
 | ||||
| 		remote->stage = 0; | ||||
| 		break; | ||||
| 	} | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Routine for sending all the initialization messages to the remote. | ||||
|  */ | ||||
| static int keyspan_setup(struct usb_device* dev) | ||||
| { | ||||
| 	int retval = 0; | ||||
| 
 | ||||
| 	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), | ||||
| 				 0x11, 0x40, 0x5601, 0x0, NULL, 0, 0); | ||||
| 	if (retval) { | ||||
| 		dev_dbg(&dev->dev, "%s - failed to set bit rate due to error: %d\n", | ||||
| 			__FUNCTION__, retval); | ||||
| 		return(retval); | ||||
| 	} | ||||
| 
 | ||||
| 	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), | ||||
| 				 0x44, 0x40, 0x0, 0x0, NULL, 0, 0); | ||||
| 	if (retval) { | ||||
| 		dev_dbg(&dev->dev, "%s - failed to set resume sensitivity due to error: %d\n", | ||||
| 			__FUNCTION__, retval); | ||||
| 		return(retval); | ||||
| 	} | ||||
| 
 | ||||
| 	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), | ||||
| 				 0x22, 0x40, 0x0, 0x0, NULL, 0, 0); | ||||
| 	if (retval) { | ||||
| 		dev_dbg(&dev->dev, "%s - failed to turn receive on due to error: %d\n", | ||||
| 			__FUNCTION__, retval); | ||||
| 		return(retval); | ||||
| 	} | ||||
| 
 | ||||
| 	dev_dbg(&dev->dev, "%s - Setup complete.\n", __FUNCTION__); | ||||
| 	return(retval); | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Routine used to handle a new message that has come in. | ||||
|  */ | ||||
| static void keyspan_irq_recv(struct urb *urb, struct pt_regs *regs) | ||||
| { | ||||
| 	struct usb_keyspan *dev = urb->context; | ||||
| 	int retval; | ||||
| 
 | ||||
| 	/* Check our status in case we need to bail out early. */ | ||||
| 	switch (urb->status) { | ||||
| 	case 0: | ||||
| 		break; | ||||
| 
 | ||||
| 	/* Device went away so don't keep trying to read from it. */ | ||||
| 	case -ECONNRESET: | ||||
| 	case -ENOENT: | ||||
| 	case -ESHUTDOWN: | ||||
| 		return; | ||||
| 
 | ||||
| 	default: | ||||
| 		goto resubmit; | ||||
| 		break; | ||||
| 	} | ||||
| 
 | ||||
| 	if (debug) | ||||
| 		keyspan_print(dev); | ||||
| 
 | ||||
| 	keyspan_check_data(dev, regs); | ||||
| 
 | ||||
| resubmit: | ||||
| 	retval = usb_submit_urb(urb, GFP_ATOMIC); | ||||
| 	if (retval) | ||||
| 		err ("%s - usb_submit_urb failed with result: %d", __FUNCTION__, retval); | ||||
| } | ||||
| 
 | ||||
| static int keyspan_open(struct input_dev *dev) | ||||
| { | ||||
| 	struct usb_keyspan *remote = dev->private; | ||||
| 
 | ||||
| 	if (remote->open++) | ||||
| 		return 0; | ||||
| 
 | ||||
| 	remote->irq_urb->dev = remote->udev; | ||||
| 	if (usb_submit_urb(remote->irq_urb, GFP_KERNEL)) { | ||||
| 		remote->open--; | ||||
| 		return -EIO; | ||||
| 	} | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| static void keyspan_close(struct input_dev *dev) | ||||
| { | ||||
| 	struct usb_keyspan *remote = dev->private; | ||||
| 
 | ||||
| 	if (!--remote->open) | ||||
| 		usb_kill_urb(remote->irq_urb); | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Routine that sets up the driver to handle a specific USB device detected on the bus. | ||||
|  */ | ||||
| static int keyspan_probe(struct usb_interface *interface, const struct usb_device_id *id) | ||||
| { | ||||
| 	int i; | ||||
| 	int retval = -ENOMEM; | ||||
| 	char path[64]; | ||||
| 	char *buf; | ||||
| 	struct usb_keyspan *remote = NULL; | ||||
| 	struct usb_host_interface *iface_desc; | ||||
| 	struct usb_endpoint_descriptor *endpoint; | ||||
| 	struct usb_device *udev = usb_get_dev(interface_to_usbdev(interface)); | ||||
| 
 | ||||
| 	/* See if the offered device matches what we can accept */ | ||||
| 	if ((udev->descriptor.idVendor != USB_KEYSPAN_VENDOR_ID) || | ||||
| 	    (udev->descriptor.idProduct != USB_KEYSPAN_PRODUCT_UIA11) ) | ||||
| 		return -ENODEV; | ||||
| 
 | ||||
| 	/* allocate memory for our device state and initialize it */ | ||||
| 	remote = kmalloc(sizeof(*remote), GFP_KERNEL); | ||||
| 	if (remote == NULL) { | ||||
| 		err("Out of memory\n"); | ||||
| 		goto error; | ||||
| 	} | ||||
| 	memset(remote, 0x00, sizeof(*remote)); | ||||
| 
 | ||||
| 	remote->udev = udev; | ||||
| 	remote->interface = interface; | ||||
| 	remote->toggle = -1;	/* Set to -1 so we will always not match the toggle from the first remote message. */ | ||||
| 
 | ||||
| 	/* set up the endpoint information */ | ||||
| 	/* use only the first in interrupt endpoint */ | ||||
| 	iface_desc = interface->cur_altsetting; | ||||
| 	for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) { | ||||
| 		endpoint = &iface_desc->endpoint[i].desc; | ||||
| 
 | ||||
| 		if (!remote->in_endpoint && | ||||
| 		    (endpoint->bEndpointAddress & USB_DIR_IN) && | ||||
| 		    ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT)) { | ||||
| 			/* we found our interrupt in endpoint */ | ||||
| 			remote->in_endpoint = endpoint; | ||||
| 
 | ||||
| 			remote->in_buffer = usb_buffer_alloc(remote->udev, RECV_SIZE, SLAB_ATOMIC, &remote->in_dma); | ||||
| 			if (!remote->in_buffer) { | ||||
| 				retval = -ENOMEM; | ||||
| 				goto error; | ||||
| 			} | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| 	if (!remote->in_endpoint) { | ||||
| 		err("Could not find interrupt input endpoint.\n"); | ||||
| 		retval = -ENODEV; | ||||
| 		goto error; | ||||
| 	} | ||||
| 
 | ||||
| 	remote->irq_urb = usb_alloc_urb(0, GFP_KERNEL); | ||||
| 	if (!remote->irq_urb) { | ||||
| 		err("Failed to allocate urb.\n"); | ||||
| 		retval = -ENOMEM; | ||||
| 		goto error; | ||||
| 	} | ||||
| 
 | ||||
| 	retval = keyspan_setup(remote->udev); | ||||
| 	if (retval) { | ||||
| 		err("Failed to setup device.\n"); | ||||
| 		retval = -ENODEV; | ||||
| 		goto error; | ||||
| 	} | ||||
| 
 | ||||
| 	/*
 | ||||
| 	 * Setup the input system with the bits we are going to be reporting | ||||
| 	 */ | ||||
| 	remote->input.evbit[0] = BIT(EV_KEY);		/* We will only report KEY events. */ | ||||
| 	for (i = 0; i < 32; ++i) { | ||||
| 		if (keyspan_key_table[i] != KEY_RESERVED) { | ||||
| 			set_bit(keyspan_key_table[i], remote->input.keybit); | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| 	remote->input.private = remote; | ||||
| 	remote->input.open = keyspan_open; | ||||
| 	remote->input.close = keyspan_close; | ||||
| 
 | ||||
| 	usb_make_path(remote->udev, path, 64); | ||||
| 	sprintf(remote->phys, "%s/input0", path); | ||||
| 
 | ||||
| 	remote->input.name = remote->name; | ||||
| 	remote->input.phys = remote->phys; | ||||
| 	remote->input.id.bustype = BUS_USB; | ||||
| 	remote->input.id.vendor = le16_to_cpu(remote->udev->descriptor.idVendor); | ||||
| 	remote->input.id.product = le16_to_cpu(remote->udev->descriptor.idProduct); | ||||
| 	remote->input.id.version = le16_to_cpu(remote->udev->descriptor.bcdDevice); | ||||
| 
 | ||||
| 	if (!(buf = kmalloc(63, GFP_KERNEL))) { | ||||
| 		usb_buffer_free(remote->udev, RECV_SIZE, remote->in_buffer, remote->in_dma); | ||||
| 		kfree(remote); | ||||
| 		return -ENOMEM; | ||||
| 	} | ||||
| 
 | ||||
| 	if (remote->udev->descriptor.iManufacturer && | ||||
| 	    usb_string(remote->udev, remote->udev->descriptor.iManufacturer, buf, 63) > 0) | ||||
| 		strcat(remote->name, buf); | ||||
| 
 | ||||
| 	if (remote->udev->descriptor.iProduct && | ||||
| 	    usb_string(remote->udev, remote->udev->descriptor.iProduct, buf, 63) > 0) | ||||
| 		sprintf(remote->name, "%s %s", remote->name, buf); | ||||
| 
 | ||||
| 	if (!strlen(remote->name)) | ||||
| 		sprintf(remote->name, "USB Keyspan Remote %04x:%04x", | ||||
| 			remote->input.id.vendor, remote->input.id.product); | ||||
| 
 | ||||
| 	kfree(buf); | ||||
| 
 | ||||
| 	/*
 | ||||
| 	 * Initialize the URB to access the device. The urb gets sent to the device in keyspan_open() | ||||
| 	 */ | ||||
| 	usb_fill_int_urb(remote->irq_urb, | ||||
| 			 remote->udev, usb_rcvintpipe(remote->udev, remote->in_endpoint->bEndpointAddress), | ||||
| 			 remote->in_buffer, RECV_SIZE, keyspan_irq_recv, remote, | ||||
| 			 remote->in_endpoint->bInterval); | ||||
| 	remote->irq_urb->transfer_dma = remote->in_dma; | ||||
| 	remote->irq_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | ||||
| 
 | ||||
| 	/* we can register the device now, as it is ready */ | ||||
| 	input_register_device(&remote->input); | ||||
| 
 | ||||
| 	/* save our data pointer in this interface device */ | ||||
| 	usb_set_intfdata(interface, remote); | ||||
| 
 | ||||
| 	/* let the user know what node this device is now attached to */ | ||||
| 	info("connected: %s on %s", remote->name, path); | ||||
| 	return 0; | ||||
| 
 | ||||
| error: | ||||
| 	/*
 | ||||
| 	 * In case of error we need to clean up any allocated buffers | ||||
| 	 */ | ||||
| 	if (remote->irq_urb) | ||||
| 		usb_free_urb(remote->irq_urb); | ||||
| 
 | ||||
| 	if (remote->in_buffer) | ||||
| 		usb_buffer_free(remote->udev, RECV_SIZE, remote->in_buffer, remote->in_dma); | ||||
| 
 | ||||
| 	if (remote) | ||||
| 		kfree(remote); | ||||
| 
 | ||||
| 	return retval; | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Routine called when a device is disconnected from the USB. | ||||
|  */ | ||||
| static void keyspan_disconnect(struct usb_interface *interface) | ||||
| { | ||||
| 	struct usb_keyspan *remote; | ||||
| 
 | ||||
| 	/* prevent keyspan_open() from racing keyspan_disconnect() */ | ||||
| 	lock_kernel(); | ||||
| 
 | ||||
| 	remote = usb_get_intfdata(interface); | ||||
| 	usb_set_intfdata(interface, NULL); | ||||
| 
 | ||||
| 	if (remote) {	/* We have a valid driver structure so clean up everything we allocated. */ | ||||
| 		input_unregister_device(&remote->input); | ||||
| 		usb_kill_urb(remote->irq_urb); | ||||
| 		usb_free_urb(remote->irq_urb); | ||||
| 		usb_buffer_free(interface_to_usbdev(interface), RECV_SIZE, remote->in_buffer, remote->in_dma); | ||||
| 		kfree(remote); | ||||
| 	} | ||||
| 
 | ||||
| 	unlock_kernel(); | ||||
| 
 | ||||
| 	info("USB Keyspan now disconnected"); | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * Standard driver set up sections | ||||
|  */ | ||||
| static struct usb_driver keyspan_driver = | ||||
| { | ||||
| 	.owner =	THIS_MODULE, | ||||
| 	.name =		"keyspan_remote", | ||||
| 	.probe =	keyspan_probe, | ||||
| 	.disconnect =	keyspan_disconnect, | ||||
| 	.id_table =	keyspan_table | ||||
| }; | ||||
| 
 | ||||
| static int __init usb_keyspan_init(void) | ||||
| { | ||||
| 	int result; | ||||
| 
 | ||||
| 	/* register this driver with the USB subsystem */ | ||||
| 	result = usb_register(&keyspan_driver); | ||||
| 	if (result) | ||||
| 		err("usb_register failed. Error number %d\n", result); | ||||
| 
 | ||||
| 	return result; | ||||
| } | ||||
| 
 | ||||
| static void __exit usb_keyspan_exit(void) | ||||
| { | ||||
| 	/* deregister this driver with the USB subsystem */ | ||||
| 	usb_deregister(&keyspan_driver); | ||||
| } | ||||
| 
 | ||||
| module_init(usb_keyspan_init); | ||||
| module_exit(usb_keyspan_exit); | ||||
| 
 | ||||
| MODULE_DEVICE_TABLE(usb, keyspan_table); | ||||
| MODULE_AUTHOR(DRIVER_AUTHOR); | ||||
| MODULE_DESCRIPTION(DRIVER_DESC); | ||||
| MODULE_LICENSE(DRIVER_LICENSE); | ||||
		Loading…
	
		Reference in New Issue
	
	Block a user