/* * USB PhidgetInterfaceKit driver 1.0 * * Copyright (C) 2004 Sean Young <sean@mess.org> * Copyright (C) 2004 Greg Kroah-Hartman <greg@kroah.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; either version 2 of the License, or * (at your option) any later version. * * This is a driver for the USB PhidgetInterfaceKit. */ #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/usb.h> #define DRIVER_AUTHOR "Sean Young <sean@mess.org>"#define DRIVER_DESC "USB PhidgetInterfaceKit Driver" #define USB_VENDOR_ID_GLAB		0x06c2#define USB_DEVICE_ID_INTERFACEKIT004	0x0040#define USB_DEVICE_ID_INTERFACEKIT888	0x0045#define USB_DEVICE_ID_INTERFACEKIT047	0x0051#define USB_DEVICE_ID_INTERFACEKIT088	0x0053 #define USB_VENDOR_ID_WISEGROUP		0x0925#define USB_DEVICE_ID_INTERFACEKIT884	0x8201 #define MAX_INTERFACES			8 struct driver_interfacekit {	int sensors;	int inputs;	int outputs;	int has_lcd;};#define ifkit(_sensors, _inputs, _outputs, _lcd)			\static struct driver_interfacekit ph_##_sensors##_inputs##_outputs = {	\	.sensors	= _sensors,					\	.inputs		= _inputs,					\	.outputs	= _outputs,					\	.has_lcd	= _lcd,						\};ifkit(0, 0, 4, 0);ifkit(8, 8, 8, 0);ifkit(0, 4, 7, 1);ifkit(8, 8, 4, 0);ifkit(0, 8, 8, 1); struct phidget_interfacekit {	struct usb_device *udev;	struct usb_interface *intf;	struct driver_interfacekit *ifkit;	int outputs[MAX_INTERFACES];	int inputs[MAX_INTERFACES];	int sensors[MAX_INTERFACES];	u8 lcd_files_on; 	struct urb *irq;	unsigned char *data;	dma_addr_t data_dma;}; static struct usb_device_id id_table[] = {	{USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT004),		.driver_info = (kernel_ulong_t)&ph_004},	{USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT888),		.driver_info = (kernel_ulong_t)&ph_888},	{USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT047),		.driver_info = (kernel_ulong_t)&ph_047},	{USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_INTERFACEKIT088),		.driver_info = (kernel_ulong_t)&ph_088},	{USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_INTERFACEKIT884),		.driver_info = (kernel_ulong_t)&ph_884},	{}};MODULE_DEVICE_TABLE(usb, id_table); static int change_outputs(struct phidget_interfacekit *kit, int output_num, int enable){	unsigned char *buffer;	int retval;	int n; 	buffer = kmalloc(4, GFP_KERNEL);	if (!buffer) {		dev_err(&kit->udev->dev, "%s - out of memory\n",			__FUNCTION__);		return -ENOMEM;	} 	kit->outputs[output_num] = enable;	memset(buffer, 0, 4);	for (n=0; n<8; n++) {		if (kit->outputs[n]) {			buffer[0] |= 1 << n;		}	} 	dev_dbg(&kit->udev->dev, "sending data: %02x\n", buffer[0]); 	retval = usb_control_msg(kit->udev,			 usb_sndctrlpipe(kit->udev, 0),			 0x09, 0x21, 0x0200, 0x0000, buffer, 4, 2000); 	if (retval != 4)		dev_err(&kit->udev->dev, "usb_control_msg returned %d\n", 				retval);	kfree(buffer); 	return retval < 0 ? retval : 0;} static int change_string(struct phidget_interfacekit *kit, const char *display, unsigned char row){	unsigned char *buffer;        unsigned char *form_buffer;	int retval = -ENOMEM;	int i,j, len, buf_ptr;		buffer = kmalloc(8, GFP_KERNEL);	form_buffer = kmalloc(30, GFP_KERNEL);	if ((!buffer) || (!form_buffer)) {		dev_err(&kit->udev->dev, "%s - out of memory\n", __FUNCTION__);		goto exit;	} 	len = strlen(display);	if (len > 20)		len = 20; 	dev_dbg(&kit->udev->dev, "Setting LCD line %d to %s\n", row, display); 	form_buffer[0] = row * 0x40 + 0x80;	form_buffer[1] = 0x02;	buf_ptr = 2;	for (i = 0; i<len; i++)		form_buffer[buf_ptr++] = display[i]; 	for (i = 0; i < (20 - len); i++)		form_buffer[buf_ptr++] = 0x20;	form_buffer[buf_ptr++] = 0x01;	form_buffer[buf_ptr++] = row * 0x40 + 0x80 + strlen(display); 	for (i = 0; i < buf_ptr; i += 7) {		if ((buf_ptr - i) > 7)			len = 7;		else			len = (buf_ptr - i);		for (j = 0; j < len; j++)			buffer[j] = form_buffer[i + j];		buffer[7] = len; 		retval = usb_control_msg(kit->udev,				 usb_sndctrlpipe(kit->udev, 0),				 0x09, 0x21, 0x0200, 0x0000, buffer, 8, 2000);		if (retval < 0)			goto exit;	} 	retval = 0;exit:	kfree(buffer);	kfree(form_buffer); 	return retval;} #define set_lcd_line(number)	\static ssize_t lcd_line_##number(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)	\{											\	struct usb_interface *intf = to_usb_interface(dev);				\	struct phidget_interfacekit *kit = usb_get_intfdata(intf);			\	change_string(kit, buf, number - 1);						\	return count;									\}											\static DEVICE_ATTR(lcd_line_##number, S_IWUGO, NULL, lcd_line_##number);set_lcd_line(1);set_lcd_line(2); static ssize_t set_backlight(struct device *dev, struct device_attribute *attr, const char *buf, size_t count){	struct usb_interface *intf = to_usb_interface(dev);	struct phidget_interfacekit *kit = usb_get_intfdata(intf);	int enabled;	unsigned char *buffer;	int retval = -ENOMEM;		buffer = kmalloc(8, GFP_KERNEL);	if (!buffer) {		dev_err(&kit->udev->dev, "%s - out of memory\n", __FUNCTION__);		goto exit;	} 	if (sscanf(buf, "%d", &enabled) < 1) {		retval = -EINVAL;		goto exit;	}	memset(buffer, 0x00, 8);	if (enabled)		buffer[0] = 0x01;	buffer[7] = 0x11; 	dev_dbg(&kit->udev->dev, "Setting backlight to %s\n", enabled ? "on" : "off");		retval = usb_control_msg(kit->udev,			 usb_sndctrlpipe(kit->udev, 0),			 0x09, 0x21, 0x0200, 0x0000, buffer, 8, 2000);	if (retval < 0)		goto exit; 	retval = count;exit:	kfree(buffer);	return retval;}static DEVICE_ATTR(backlight, S_IWUGO, NULL, set_backlight); static void remove_lcd_files(struct phidget_interfacekit *kit){	if (kit->lcd_files_on) {		dev_dbg(&kit->udev->dev, "Removing lcd files\n");		device_remove_file(&kit->intf->dev, &dev_attr_lcd_line_1);		device_remove_file(&kit->intf->dev, &dev_attr_lcd_line_2);		device_remove_file(&kit->intf->dev, &dev_attr_backlight);	}} static ssize_t enable_lcd_files(struct device *dev, struct device_attribute *attr, const char *buf, size_t count){	struct usb_interface *intf = to_usb_interface(dev);	struct phidget_interfacekit *kit = usb_get_intfdata(intf);	int enable;		if (kit->ifkit->has_lcd == 0)		return -ENODEV; 	if (sscanf(buf, "%d", &enable) < 1)		return -EINVAL; 	if (enable) {		if (!kit->lcd_files_on) {			dev_dbg(&kit->udev->dev, "Adding lcd files\n");			device_create_file(&kit->intf->dev, &dev_attr_lcd_line_1);			device_create_file(&kit->intf->dev, &dev_attr_lcd_line_2);			device_create_file(&kit->intf->dev, &dev_attr_backlight);			kit->lcd_files_on = 1;		}	} else {		if (kit->lcd_files_on) {			remove_lcd_files(kit);			kit->lcd_files_on = 0;		}	}		return count;}static DEVICE_ATTR(lcd, S_IWUGO, NULL, enable_lcd_files); static void interfacekit_irq(struct urb *urb, struct pt_regs *regs){	struct phidget_interfacekit *kit = urb->context;	unsigned char *buffer = kit->data;	int status;	int n; 	switch (urb->status) {	case 0:			/* success */		break;	case -ECONNRESET:	/* unlink */	case -ENOENT:	case -ESHUTDOWN:		return;	/* -EPIPE:  should clear the halt */	default:		/* error */		goto resubmit;	} 	for (n=0; n<8; n++) {		kit->inputs[n] = buffer[1] & (1 << n) ? 1 : 0;	} 	if (buffer[0] & 1) {		kit->sensors[4] = buffer[2] + (buffer[3] & 0x0f) * 256;		kit->sensors[5] = buffer[4] + (buffer[3] & 0xf0) * 16;		kit->sensors[6] = buffer[5] + (buffer[6] & 0x0f) * 256;		kit->sensors[7] = buffer[7] + (buffer[6] & 0xf0) * 16;	} else {		kit->sensors[0] = buffer[2] + (buffer[3] & 0x0f) * 256;		kit->sensors[1] = buffer[4] + (buffer[3] & 0xf0) * 16;		kit->sensors[2] = buffer[5] + (buffer[6] & 0x0f) * 256;		kit->sensors[3] = buffer[7] + (buffer[6] & 0xf0) * 16;	} resubmit:	status = usb_submit_urb(urb, SLAB_ATOMIC);	if (status)		err("can't resubmit intr, %s-%s/interfacekit0, status %d",			kit->udev->bus->bus_name,			kit->udev->devpath, status);} #define show_set_output(value)		\static ssize_t set_output##value(struct device *dev, struct device_attribute *attr, const char *buf, 	\							size_t count)	\{									\	struct usb_interface *intf = to_usb_interface(dev);		\	struct phidget_interfacekit *kit = usb_get_intfdata(intf);	\	int enabled;							\	int retval;							\									\	if (sscanf(buf, "%d", &enabled) < 1) {				\		return -EINVAL;						\	}								\									\	retval = change_outputs(kit, value - 1, enabled ? 1 : 0);	\									\	return retval ? retval : count;					\}									\									\static ssize_t show_output##value(struct device *dev, struct device_attribute *attr, char *buf)	\{									\	struct usb_interface *intf = to_usb_interface(dev);		\	struct phidget_interfacekit *kit = usb_get_intfdata(intf);	\									\	return sprintf(buf, "%d\n", kit->outputs[value - 1]);		\}									\static DEVICE_ATTR(output##value, S_IWUGO | S_IRUGO,			\		show_output##value, set_output##value);show_set_output(1);show_set_output(2);show_set_output(3);show_set_output(4);show_set_output(5);show_set_output(6);show_set_output(7);show_set_output(8);	/* should be MAX_INTERFACES - 1 */ #define show_input(value)	\static ssize_t show_input##value(struct device *dev, struct device_attribute *attr, char *buf)	\{									\	struct usb_interface *intf = to_usb_interface(dev);		\	struct phidget_interfacekit *kit = usb_get_intfdata(intf);	\									\	return sprintf(buf, "%d\n", kit->inputs[value - 1]);		\}									\static DEVICE_ATTR(input##value, S_IRUGO, show_input##value, NULL); show_input(1);show_input(2);show_input(3);show_input(4);show_input(5);show_input(6);show_input(7);show_input(8);		/* should be MAX_INTERFACES - 1 */ #define show_sensor(value)	\static ssize_t show_sensor##value(struct device *dev, struct device_attribute *attr, char *buf)	\{									\	struct usb_interface *intf = to_usb_interface(dev);		\	struct phidget_interfacekit *kit = usb_get_intfdata(intf);	\									\	return sprintf(buf, "%d\n", kit->sensors[value - 1]);		\}									\static DEVICE_ATTR(sensor##value, S_IRUGO, show_sensor##value, NULL); show_sensor(1);show_sensor(2);show_sensor(3);show_sensor(4);show_sensor(5);show_sensor(6);show_sensor(7);show_sensor(8);		/* should be MAX_INTERFACES - 1 */ static int interfacekit_probe(struct usb_interface *intf, const struct usb_device_id *id){	struct usb_device *dev = interface_to_usbdev(intf);	struct usb_host_interface *interface;	struct usb_endpoint_descriptor *endpoint;	struct phidget_interfacekit *kit;	struct driver_interfacekit *ifkit;	int pipe, maxp; 	ifkit = (struct driver_interfacekit *)id->driver_info;	if (!ifkit)		return -ENODEV; 	interface = intf->cur_altsetting;	if (interface->desc.bNumEndpoints != 1)		return -ENODEV; 	endpoint = &interface->endpoint[0].desc;	if (!(endpoint->bEndpointAddress & 0x80)) 		return -ENODEV;	/*	 * bmAttributes	 */	pipe = usb_rcvintpipe(dev, endpoint->bEndpointAddress);	maxp = usb_maxpacket(dev, pipe, usb_pipeout(pipe));		kit = kmalloc(sizeof(*kit), GFP_KERNEL);	if (kit  == NULL) {		dev_err(&intf->dev, "%s - out of memory\n", __FUNCTION__);		return -ENOMEM;	}	memset(kit, 0, sizeof(*kit));	kit->ifkit = ifkit; 	kit->data = usb_buffer_alloc(dev, 8, SLAB_ATOMIC, &kit->data_dma);	if (!kit->data) {		kfree(kit);		return -ENOMEM;	} 	kit->irq = usb_alloc_urb(0, GFP_KERNEL);	if (!kit->irq) {		usb_buffer_free(dev, 8, kit->data, kit->data_dma);		kfree(kit);		return -ENOMEM;	} 	kit->udev = usb_get_dev(dev);	kit->intf = intf;	usb_fill_int_urb(kit->irq, kit->udev, pipe, kit->data,			(maxp > 8 ? 8 : maxp),			interfacekit_irq, kit, endpoint->bInterval);	kit->irq->transfer_dma = kit->data_dma;	kit->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 	usb_set_intfdata(intf, kit); 	if (usb_submit_urb(kit->irq, GFP_KERNEL)) {		return -EIO;	} 	if (ifkit->outputs >= 4) {		device_create_file(&intf->dev, &dev_attr_output1);		device_create_file(&intf->dev, &dev_attr_output2);		device_create_file(&intf->dev, &dev_attr_output3);		device_create_file(&intf->dev, &dev_attr_output4);	}	if (ifkit->outputs == 8) {		device_create_file(&intf->dev, &dev_attr_output5);		device_create_file(&intf->dev, &dev_attr_output6);		device_create_file(&intf->dev, &dev_attr_output7);		device_create_file(&intf->dev, &dev_attr_output8);	}  	if (ifkit->inputs >= 4) {		device_create_file(&intf->dev, &dev_attr_input1);		device_create_file(&intf->dev, &dev_attr_input2);		device_create_file(&intf->dev, &dev_attr_input3);		device_create_file(&intf->dev, &dev_attr_input4);	}	if (ifkit->inputs == 8) {		device_create_file(&intf->dev, &dev_attr_input5);		device_create_file(&intf->dev, &dev_attr_input6);		device_create_file(&intf->dev, &dev_attr_input7);		device_create_file(&intf->dev, &dev_attr_input8);	} 	if (ifkit->sensors >= 4) {		device_create_file(&intf->dev, &dev_attr_sensor1);		device_create_file(&intf->dev, &dev_attr_sensor2);		device_create_file(&intf->dev, &dev_attr_sensor3);		device_create_file(&intf->dev, &dev_attr_sensor4);	}	if (ifkit->sensors >= 7) {		device_create_file(&intf->dev, &dev_attr_sensor5);		device_create_file(&intf->dev, &dev_attr_sensor6);		device_create_file(&intf->dev, &dev_attr_sensor7);	}	if (ifkit->sensors == 8) {		device_create_file(&intf->dev, &dev_attr_sensor8);	} 	if (ifkit->has_lcd)		device_create_file(&intf->dev, &dev_attr_lcd); 	dev_info(&intf->dev, "USB PhidgetInterfaceKit %d/%d/%d attached\n",			ifkit->sensors, ifkit->inputs, ifkit->outputs); 	return 0;} static void interfacekit_disconnect(struct usb_interface *interface){	struct phidget_interfacekit *kit; 	kit = usb_get_intfdata(interface);	usb_set_intfdata(interface, NULL);	if (!kit)

Lines 1–500 of 586. Load more