[net-next-2.6.git] / drivers / usb / misc / phidgetmotorcontrol.c

/*
 * USB Phidget MotorControl driver
 *
 * Copyright (C) 2006  Sean Young <sean@mess.org>
 *
 * 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.
 */

#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/usb.h>

#include "phidget.h"

#define DRIVER_AUTHOR "Sean Young <sean@mess.org>"
#define DRIVER_DESC "USB PhidgetMotorControl Driver"

#define USB_VENDOR_ID_GLAB		0x06c2
#define USB_DEVICE_ID_MOTORCONTROL	0x0058

#define URB_INT_SIZE			8

static unsigned long device_no;

struct motorcontrol {
	struct usb_device *udev;
	struct usb_interface *intf;
	struct device *dev;
	int dev_no;
	u8 inputs[4];
	s8 desired_speed[2];
	s8 speed[2];
	s16 _current[2];
	s8 acceleration[2];
	struct urb *irq;
	unsigned char *data;
	dma_addr_t data_dma;

	struct delayed_work do_notify;
	unsigned long input_events;
	unsigned long speed_events;
	unsigned long exceed_events;
};

static struct usb_device_id id_table[] = {
	{ USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_MOTORCONTROL) },
	{}
};
MODULE_DEVICE_TABLE(usb, id_table);

static int set_motor(struct motorcontrol *mc, int motor)
{
	u8 *buffer;
	int speed, speed2, acceleration;
	int retval;

	buffer = kzalloc(8, GFP_KERNEL);
	if (!buffer) {
		dev_err(&mc->intf->dev, "%s - out of memory\n", __FUNCTION__);
		return -ENOMEM;
	}

	acceleration = mc->acceleration[motor] * 10;
	/* -127 <= speed <= 127 */
	speed = (mc->desired_speed[motor] * 127) / 100;
	/* -0x7300 <= speed2 <= 0x7300 */
	speed2 = (mc->desired_speed[motor] * 230 * 128) / 100;

	buffer[0] = motor;
	buffer[1] = speed;
	buffer[2] = acceleration >> 8;
	buffer[3] = acceleration;
	buffer[4] = speed2 >> 8;
	buffer[5] = speed2;

	retval = usb_control_msg(mc->udev,
			 usb_sndctrlpipe(mc->udev, 0),
			 0x09, 0x21, 0x0200, 0x0000, buffer, 8, 2000);

	if (retval != 8)
		dev_err(&mc->intf->dev, "usb_control_msg returned %d\n",
				retval);
	kfree(buffer);

	return retval < 0 ? retval : 0;
}

static void motorcontrol_irq(struct urb *urb)
{
	struct motorcontrol *mc = urb->context;
	unsigned char *buffer = mc->data;
	int i, level;
	int status;

	switch (urb->status) {
	case 0:			/* success */
		break;
	case -ECONNRESET:	/* unlink */
	case -ENOENT:
	case -ESHUTDOWN:
		return;
	/* -EPIPE:  should clear the halt */
	default:		/* error */
		goto resubmit;
	}

	/* digital inputs */
	for (i=0; i<4; i++) {
		level = (buffer[0] >> i) & 1;
		if (mc->inputs[i] != level) {
			mc->inputs[i] = level;
			set_bit(i, &mc->input_events);
		}
	}

	/* motor speed */
	if (buffer[2] == 0) {
		for (i=0; i<2; i++) {
		level = ((s8)buffer[4+i]) * 100 / 127;
			if (mc->speed[i] != level) {
				mc->speed[i] = level;
				set_bit(i, &mc->speed_events);
			}
		}
	} else {
		int index = buffer[3] & 1;

		level = ((s8)buffer[4] << 8) | buffer[5];
		level = level * 100 / 29440;
		if (mc->speed[index] != level) {
			mc->speed[index] = level;
			set_bit(index, &mc->speed_events);
		}

		level = ((s8)buffer[6] << 8) | buffer[7];
		mc->_current[index] = level * 100 / 1572;
	}

	if (buffer[1] & 1)
		set_bit(0, &mc->exceed_events);

	if (buffer[1] & 2)
		set_bit(1, &mc->exceed_events);

	if (mc->input_events || mc->exceed_events || mc->speed_events)
		schedule_delayed_work(&mc->do_notify, 0);

resubmit:
	status = usb_submit_urb(urb, GFP_ATOMIC);
	if (status)
		dev_err(&mc->intf->dev,
			"can't resubmit intr, %s-%s/motorcontrol0, status %d",
			mc->udev->bus->bus_name,
			mc->udev->devpath, status);
}

static void do_notify(struct work_struct *work)
{
	struct motorcontrol *mc =
		container_of(work, struct motorcontrol, do_notify.work);
	int i;
	char sysfs_file[8];

	for (i=0; i<4; i++) {
		if (test_and_clear_bit(i, &mc->input_events)) {
			sprintf(sysfs_file, "input%d", i);
			sysfs_notify(&mc->dev->kobj, NULL, sysfs_file);
		}
	}

	for (i=0; i<2; i++) {
		if (test_and_clear_bit(i, &mc->speed_events)) {
			sprintf(sysfs_file, "speed%d", i);
			sysfs_notify(&mc->dev->kobj, NULL, sysfs_file);
		}
	}

	for (i=0; i<2; i++) {
		if (test_and_clear_bit(i, &mc->exceed_events))
			dev_warn(&mc->intf->dev,
				"motor #%d exceeds 1.5 Amp current limit\n", i);
	}
}

#define show_set_speed(value)		\
static ssize_t set_speed##value(struct device *dev,			\
					struct device_attribute *attr,	\
					const char *buf, size_t count)	\
{									\
	struct motorcontrol *mc = dev_get_drvdata(dev);			\
	int speed;							\
	int retval;							\
									\
	if (sscanf(buf, "%d", &speed) < 1)				\
		return -EINVAL;						\
									\
	if (speed < -100 || speed > 100)				\
		return -EINVAL;						\
									\
	mc->desired_speed[value] = speed;				\
									\
	retval = set_motor(mc, value);					\
									\
	return retval ? retval : count;					\
}									\
									\
static ssize_t show_speed##value(struct device *dev,			\
					struct device_attribute *attr,	\
					char *buf)			\
{									\
	struct motorcontrol *mc = dev_get_drvdata(dev);			\
									\
	return sprintf(buf, "%d\n", mc->speed[value]);			\
}

#define speed_attr(value) 						\
	__ATTR(speed##value, S_IWUGO | S_IRUGO, 			\
		show_speed##value, set_speed##value)

show_set_speed(0);
show_set_speed(1);

#define show_set_acceleration(value)		\
static ssize_t set_acceleration##value(struct device *dev, 		\
					struct device_attribute *attr,	\
					const char *buf, size_t count)	\
{									\
	struct motorcontrol *mc = dev_get_drvdata(dev);			\
	int acceleration;						\
	int retval;							\
									\
	if (sscanf(buf, "%d", &acceleration) < 1)			\
		return -EINVAL;						\
									\
	if (acceleration < 0 || acceleration > 100)			\
		return -EINVAL;						\
									\
	mc->acceleration[value] = acceleration;				\
									\
	retval = set_motor(mc, value);					\
									\
	return retval ? retval : count;					\
}									\
									\
static ssize_t show_acceleration##value(struct device *dev,	 	\
					struct device_attribute *attr,	\
							char *buf)	\
{									\
	struct motorcontrol *mc = dev_get_drvdata(dev);			\
									\
	return sprintf(buf, "%d\n", mc->acceleration[value]);		\
}

#define acceleration_attr(value)	\
	__ATTR(acceleration##value, S_IWUGO | S_IRUGO,			\
		show_acceleration##value, set_acceleration##value)

show_set_acceleration(0);
show_set_acceleration(1);

#define show_current(value)	\
static ssize_t show_current##value(struct device *dev,			\
					struct device_attribute *attr,	\
					char *buf)			\
{									\
	struct motorcontrol *mc = dev_get_drvdata(dev);			\
									\
	return sprintf(buf, "%dmA\n", (int)mc->_current[value]);	\
}

#define current_attr(value)	\
	__ATTR(current##value, S_IRUGO, show_current##value, NULL)

show_current(0);
show_current(1);

#define show_input(value)	\
static ssize_t show_input##value(struct device *dev,			\
					struct device_attribute *attr,	\
					char *buf)			\
{									\
	struct motorcontrol *mc = dev_get_drvdata(dev);			\
									\
	return sprintf(buf, "%d\n", (int)mc->inputs[value]);		\
}

#define input_attr(value)	\
	__ATTR(input##value, S_IRUGO, show_input##value, NULL)

show_input(0);
show_input(1);
show_input(2);
show_input(3);

static struct device_attribute dev_attrs[] = {
	input_attr(0),
	input_attr(1),
	input_attr(2),
	input_attr(3),
	speed_attr(0),
	speed_attr(1),
	acceleration_attr(0),
	acceleration_attr(1),
	current_attr(0),
	current_attr(1)
};

static int motorcontrol_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 motorcontrol *mc;
	int pipe, maxp, rc = -ENOMEM;
	int bit, value, i;

	interface = intf->cur_altsetting;
	if (interface->desc.bNumEndpoints != 1)
		return -ENODEV;

	endpoint = &interface->endpoint[0].desc;
	if (!usb_endpoint_dir_in(endpoint))
		return -ENODEV;

	/*
	 * bmAttributes
	 */
	pipe = usb_rcvintpipe(dev, endpoint->bEndpointAddress);
	maxp = usb_maxpacket(dev, pipe, usb_pipeout(pipe));

	mc = kzalloc(sizeof(*mc), GFP_KERNEL);
	if (!mc)
		goto out;

	mc->dev_no = -1;
	mc->data = usb_buffer_alloc(dev, URB_INT_SIZE, GFP_ATOMIC, &mc->data_dma);
	if (!mc->data)
		goto out;

	mc->irq = usb_alloc_urb(0, GFP_KERNEL);
	if (!mc->irq)
		goto out;

	mc->udev = usb_get_dev(dev);
	mc->intf = intf;
	mc->acceleration[0] = mc->acceleration[1] = 10;
	INIT_DELAYED_WORK(&mc->do_notify, do_notify);
	usb_fill_int_urb(mc->irq, mc->udev, pipe, mc->data,
			maxp > URB_INT_SIZE ? URB_INT_SIZE : maxp,
			motorcontrol_irq, mc, endpoint->bInterval);
	mc->irq->transfer_dma = mc->data_dma;
	mc->irq->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;

	usb_set_intfdata(intf, mc);

	do {
		bit = find_first_zero_bit(&device_no, sizeof(device_no));
		value = test_and_set_bit(bit, &device_no);
	} while(value);
	mc->dev_no = bit;

	mc->dev = device_create(phidget_class, &mc->udev->dev, 0,
				"motorcontrol%d", mc->dev_no);
	if (IS_ERR(mc->dev)) {
		rc = PTR_ERR(mc->dev);
		mc->dev = NULL;
		goto out;
	}

	dev_set_drvdata(mc->dev, mc);

	if (usb_submit_urb(mc->irq, GFP_KERNEL)) {
		rc = -EIO;
		goto out;
	}

	for (i=0; i<ARRAY_SIZE(dev_attrs); i++) {
		rc = device_create_file(mc->dev, &dev_attrs[i]);
		if (rc)
			goto out2;
	}

	dev_info(&intf->dev, "USB PhidgetMotorControl attached\n");

	return 0;
out2:
	while (i-- > 0)
		device_remove_file(mc->dev, &dev_attrs[i]);
out:
	if (mc) {
		usb_free_urb(mc->irq);
		if (mc->data)
			usb_buffer_free(dev, URB_INT_SIZE, mc->data, mc->data_dma);
		if (mc->dev)
			device_unregister(mc->dev);
		if (mc->dev_no >= 0)
			clear_bit(mc->dev_no, &device_no);

		kfree(mc);
	}

	return rc;
}

static void motorcontrol_disconnect(struct usb_interface *interface)
{
	struct motorcontrol *mc;
	int i;

	mc = usb_get_intfdata(interface);
	usb_set_intfdata(interface, NULL);
	if (!mc)
		return;

	usb_kill_urb(mc->irq);
	usb_free_urb(mc->irq);
	usb_buffer_free(mc->udev, URB_INT_SIZE, mc->data, mc->data_dma);

	cancel_delayed_work(&mc->do_notify);

	for (i=0; i<ARRAY_SIZE(dev_attrs); i++)
		device_remove_file(mc->dev, &dev_attrs[i]);

	device_unregister(mc->dev);

	usb_put_dev(mc->udev);
	clear_bit(mc->dev_no, &device_no);
	kfree(mc);

	dev_info(&interface->dev, "USB PhidgetMotorControl detached\n");
}

static struct usb_driver motorcontrol_driver = {
	.name = "phidgetmotorcontrol",
	.probe = motorcontrol_probe,
	.disconnect = motorcontrol_disconnect,
	.id_table = id_table
};

static int __init motorcontrol_init(void)
{
	int retval = 0;

	retval = usb_register(&motorcontrol_driver);
	if (retval)
		err("usb_register failed. Error number %d", retval);

	return retval;
}

static void __exit motorcontrol_exit(void)
{
	usb_deregister(&motorcontrol_driver);
}

module_init(motorcontrol_init);
module_exit(motorcontrol_exit);

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");
Commit	Line	Data
d5176b41 SY	1	/*
	2	* USB Phidget MotorControl driver
	3	*
	4	* Copyright (C) 2006 Sean Young <sean@mess.org>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*/
	11
	12	#include <linux/kernel.h>
	13	#include <linux/errno.h>
	14	#include <linux/init.h>
	15	#include <linux/module.h>
	16	#include <linux/usb.h>
	17
912b24c3 SY	18	#include "phidget.h"
912b24c3 SY	19
d5176b41 SY	20	#define DRIVER_AUTHOR "Sean Young <sean@mess.org>"
	21	#define DRIVER_DESC "USB PhidgetMotorControl Driver"
	22
	23	#define USB_VENDOR_ID_GLAB 0x06c2
	24	#define USB_DEVICE_ID_MOTORCONTROL 0x0058
	25
	26	#define URB_INT_SIZE 8
	27
912b24c3 SY	28	static unsigned long device_no;
912b24c3 SY	29
d5176b41 SY	30	struct motorcontrol {
	31	struct usb_device *udev;
	32	struct usb_interface *intf;
912b24c3 SY	33	struct device *dev;
912b24c3 SY	34	int dev_no;
d5176b41 SY	35	u8 inputs[4];
	36	s8 desired_speed[2];
	37	s8 speed[2];
	38	s16 _current[2];
	39	s8 acceleration[2];
	40	struct urb *irq;
	41	unsigned char *data;
	42	dma_addr_t data_dma;
	43
c4028958	44	struct delayed_work do_notify;
d5176b41 SY	45	unsigned long input_events;
	46	unsigned long speed_events;
	47	unsigned long exceed_events;
	48	};
	49
	50	static struct usb_device_id id_table[] = {
	51	{ USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_MOTORCONTROL) },
	52	{}
	53	};
	54	MODULE_DEVICE_TABLE(usb, id_table);
	55
	56	static int set_motor(struct motorcontrol *mc, int motor)
	57	{
	58	u8 *buffer;
	59	int speed, speed2, acceleration;
	60	int retval;
	61
	62	buffer = kzalloc(8, GFP_KERNEL);
	63	if (!buffer) {
	64	dev_err(&mc->intf->dev, "%s - out of memory\n", __FUNCTION__);
	65	return -ENOMEM;
	66	}
	67
	68	acceleration = mc->acceleration[motor] * 10;
	69	/* -127 <= speed <= 127 */
	70	speed = (mc->desired_speed[motor] * 127) / 100;
	71	/* -0x7300 <= speed2 <= 0x7300 */
	72	speed2 = (mc->desired_speed[motor] * 230 * 128) / 100;
	73
	74	buffer[0] = motor;
	75	buffer[1] = speed;
	76	buffer[2] = acceleration >> 8;
	77	buffer[3] = acceleration;
	78	buffer[4] = speed2 >> 8;
	79	buffer[5] = speed2;
	80
	81	retval = usb_control_msg(mc->udev,
	82	usb_sndctrlpipe(mc->udev, 0),
	83	0x09, 0x21, 0x0200, 0x0000, buffer, 8, 2000);
	84
	85	if (retval != 8)
	86	dev_err(&mc->intf->dev, "usb_control_msg returned %d\n",
	87	retval);
	88	kfree(buffer);
	89
	90	return retval < 0 ? retval : 0;
	91	}
	92
7d12e780	93	static void motorcontrol_irq(struct urb *urb)
d5176b41 SY	94	{
	95	struct motorcontrol *mc = urb->context;
	96	unsigned char *buffer = mc->data;
	97	int i, level;
	98	int status;
	99
	100	switch (urb->status) {
	101	case 0: /* success */
	102	break;
	103	case -ECONNRESET: /* unlink */
	104	case -ENOENT:
	105	case -ESHUTDOWN:
	106	return;
	107	/* -EPIPE: should clear the halt */
	108	default: /* error */
	109	goto resubmit;
	110	}
	111
	112	/* digital inputs */
	113	for (i=0; i<4; i++) {
	114	level = (buffer[0] >> i) & 1;
	115	if (mc->inputs[i] != level) {
	116	mc->inputs[i] = level;
	117	set_bit(i, &mc->input_events);
	118	}
	119	}
	120
	121	/* motor speed */
	122	if (buffer[2] == 0) {
	123	for (i=0; i<2; i++) {
	124	level = ((s8)buffer[4+i]) * 100 / 127;
	125	if (mc->speed[i] != level) {
	126	mc->speed[i] = level;
	127	set_bit(i, &mc->speed_events);
	128	}
	129	}
	130	} else {
	131	int index = buffer[3] & 1;
	132
	133	level = ((s8)buffer[4] << 8) \| buffer[5];
	134	level = level * 100 / 29440;
	135	if (mc->speed[index] != level) {
	136	mc->speed[index] = level;
	137	set_bit(index, &mc->speed_events);
	138	}
	139
	140	level = ((s8)buffer[6] << 8) \| buffer[7];
	141	mc->_current[index] = level * 100 / 1572;
	142	}
	143
	144	if (buffer[1] & 1)
	145	set_bit(0, &mc->exceed_events);
	146
	147	if (buffer[1] & 2)
	148	set_bit(1, &mc->exceed_events);
	149
	150	if (mc->input_events \|\| mc->exceed_events \|\| mc->speed_events)
c4028958	151	schedule_delayed_work(&mc->do_notify, 0);
d5176b41 SY	152
d5176b41 SY	153	resubmit:
54e6ecb2	154	status = usb_submit_urb(urb, GFP_ATOMIC);
d5176b41 SY	155	if (status)
	156	dev_err(&mc->intf->dev,
	157	"can't resubmit intr, %s-%s/motorcontrol0, status %d",
	158	mc->udev->bus->bus_name,
	159	mc->udev->devpath, status);
	160	}
	161
c4028958	162	static void do_notify(struct work_struct *work)
d5176b41	163	{
c4028958 DH	164	struct motorcontrol *mc =
c4028958 DH	165	container_of(work, struct motorcontrol, do_notify.work);
d5176b41 SY	166	int i;
	167	char sysfs_file[8];
	168
	169	for (i=0; i<4; i++) {
	170	if (test_and_clear_bit(i, &mc->input_events)) {
	171	sprintf(sysfs_file, "input%d", i);
912b24c3	172	sysfs_notify(&mc->dev->kobj, NULL, sysfs_file);
d5176b41 SY	173	}
	174	}
	175
	176	for (i=0; i<2; i++) {
	177	if (test_and_clear_bit(i, &mc->speed_events)) {
	178	sprintf(sysfs_file, "speed%d", i);
912b24c3	179	sysfs_notify(&mc->dev->kobj, NULL, sysfs_file);
d5176b41 SY	180	}
	181	}
	182
	183	for (i=0; i<2; i++) {
	184	if (test_and_clear_bit(i, &mc->exceed_events))
	185	dev_warn(&mc->intf->dev,
	186	"motor #%d exceeds 1.5 Amp current limit\n", i);
	187	}
	188	}
	189
	190	#define show_set_speed(value) \
912b24c3 SY	191	static ssize_t set_speed##value(struct device *dev, \
	192	struct device_attribute *attr, \
	193	const char *buf, size_t count) \
d5176b41	194	{ \
912b24c3	195	struct motorcontrol *mc = dev_get_drvdata(dev); \
d5176b41 SY	196	int speed; \
	197	int retval; \
	198	\
	199	if (sscanf(buf, "%d", &speed) < 1) \
	200	return -EINVAL; \
	201	\
	202	if (speed < -100 \|\| speed > 100) \
	203	return -EINVAL; \
	204	\
	205	mc->desired_speed[value] = speed; \
	206	\
	207	retval = set_motor(mc, value); \
	208	\
	209	return retval ? retval : count; \
	210	} \
	211	\
912b24c3 SY	212	static ssize_t show_speed##value(struct device *dev, \
	213	struct device_attribute *attr, \
	214	char *buf) \
d5176b41	215	{ \
912b24c3	216	struct motorcontrol *mc = dev_get_drvdata(dev); \
d5176b41 SY	217	\
d5176b41 SY	218	return sprintf(buf, "%d\n", mc->speed[value]); \
da308e8d SY	219	}
	220
	221	#define speed_attr(value) \
	222	__ATTR(speed##value, S_IWUGO \| S_IRUGO, \
	223	show_speed##value, set_speed##value)
	224
d5176b41 SY	225	show_set_speed(0);
	226	show_set_speed(1);
	227
	228	#define show_set_acceleration(value) \
	229	static ssize_t set_acceleration##value(struct device *dev, \
912b24c3 SY	230	struct device_attribute *attr, \
912b24c3 SY	231	const char *buf, size_t count) \
d5176b41	232	{ \
912b24c3	233	struct motorcontrol *mc = dev_get_drvdata(dev); \
d5176b41 SY	234	int acceleration; \
	235	int retval; \
	236	\
	237	if (sscanf(buf, "%d", &acceleration) < 1) \
	238	return -EINVAL; \
	239	\
	240	if (acceleration < 0 \|\| acceleration > 100) \
	241	return -EINVAL; \
	242	\
	243	mc->acceleration[value] = acceleration; \
	244	\
	245	retval = set_motor(mc, value); \
	246	\
	247	return retval ? retval : count; \
	248	} \
	249	\
912b24c3 SY	250	static ssize_t show_acceleration##value(struct device *dev, \
	251	struct device_attribute *attr, \
	252	char *buf) \
d5176b41	253	{ \
912b24c3	254	struct motorcontrol *mc = dev_get_drvdata(dev); \
d5176b41 SY	255	\
d5176b41 SY	256	return sprintf(buf, "%d\n", mc->acceleration[value]); \
da308e8d SY	257	}
	258
	259	#define acceleration_attr(value) \
	260	__ATTR(acceleration##value, S_IWUGO \| S_IRUGO, \
	261	show_acceleration##value, set_acceleration##value)
	262
d5176b41 SY	263	show_set_acceleration(0);
	264	show_set_acceleration(1);
	265
	266	#define show_current(value) \
912b24c3 SY	267	static ssize_t show_current##value(struct device *dev, \
	268	struct device_attribute *attr, \
	269	char *buf) \
d5176b41	270	{ \
912b24c3	271	struct motorcontrol *mc = dev_get_drvdata(dev); \
d5176b41 SY	272	\
d5176b41 SY	273	return sprintf(buf, "%dmA\n", (int)mc->_current[value]); \
da308e8d SY	274	}
	275
	276	#define current_attr(value) \
	277	__ATTR(current##value, S_IRUGO, show_current##value, NULL)
d5176b41 SY	278
	279	show_current(0);
	280	show_current(1);
	281
	282	#define show_input(value) \
912b24c3 SY	283	static ssize_t show_input##value(struct device *dev, \
	284	struct device_attribute *attr, \
	285	char *buf) \
d5176b41	286	{ \
912b24c3	287	struct motorcontrol *mc = dev_get_drvdata(dev); \
d5176b41 SY	288	\
d5176b41 SY	289	return sprintf(buf, "%d\n", (int)mc->inputs[value]); \
da308e8d SY	290	}
	291
	292	#define input_attr(value) \
	293	__ATTR(input##value, S_IRUGO, show_input##value, NULL)
d5176b41 SY	294
	295	show_input(0);
	296	show_input(1);
	297	show_input(2);
	298	show_input(3);
	299
da308e8d SY	300	static struct device_attribute dev_attrs[] = {
	301	input_attr(0),
	302	input_attr(1),
	303	input_attr(2),
	304	input_attr(3),
	305	speed_attr(0),
	306	speed_attr(1),
	307	acceleration_attr(0),
	308	acceleration_attr(1),
	309	current_attr(0),
	310	current_attr(1)
	311	};
	312
d5176b41 SY	313	static int motorcontrol_probe(struct usb_interface intf, const struct usb_device_id id)
	314	{
	315	struct usb_device *dev = interface_to_usbdev(intf);
	316	struct usb_host_interface *interface;
	317	struct usb_endpoint_descriptor *endpoint;
	318	struct motorcontrol *mc;
	319	int pipe, maxp, rc = -ENOMEM;
da308e8d	320	int bit, value, i;
d5176b41 SY	321
	322	interface = intf->cur_altsetting;
	323	if (interface->desc.bNumEndpoints != 1)
	324	return -ENODEV;
	325
	326	endpoint = &interface->endpoint[0].desc;
a742e5a7	327	if (!usb_endpoint_dir_in(endpoint))
d5176b41 SY	328	return -ENODEV;
	329
	330	/*
	331	* bmAttributes
	332	*/
	333	pipe = usb_rcvintpipe(dev, endpoint->bEndpointAddress);
	334	maxp = usb_maxpacket(dev, pipe, usb_pipeout(pipe));
	335
	336	mc = kzalloc(sizeof(*mc), GFP_KERNEL);
	337	if (!mc)
	338	goto out;
	339
912b24c3	340	mc->dev_no = -1;
54e6ecb2	341	mc->data = usb_buffer_alloc(dev, URB_INT_SIZE, GFP_ATOMIC, &mc->data_dma);
d5176b41 SY	342	if (!mc->data)
	343	goto out;
	344
	345	mc->irq = usb_alloc_urb(0, GFP_KERNEL);
	346	if (!mc->irq)
	347	goto out;
	348
	349	mc->udev = usb_get_dev(dev);
	350	mc->intf = intf;
	351	mc->acceleration[0] = mc->acceleration[1] = 10;
c4028958	352	INIT_DELAYED_WORK(&mc->do_notify, do_notify);
d5176b41 SY	353	usb_fill_int_urb(mc->irq, mc->udev, pipe, mc->data,
	354	maxp > URB_INT_SIZE ? URB_INT_SIZE : maxp,
	355	motorcontrol_irq, mc, endpoint->bInterval);
	356	mc->irq->transfer_dma = mc->data_dma;
	357	mc->irq->transfer_flags \|= URB_NO_TRANSFER_DMA_MAP;
	358
	359	usb_set_intfdata(intf, mc);
	360
912b24c3 SY	361	do {
	362	bit = find_first_zero_bit(&device_no, sizeof(device_no));
	363	value = test_and_set_bit(bit, &device_no);
	364	} while(value);
	365	mc->dev_no = bit;
	366
	367	mc->dev = device_create(phidget_class, &mc->udev->dev, 0,
	368	"motorcontrol%d", mc->dev_no);
	369	if (IS_ERR(mc->dev)) {
	370	rc = PTR_ERR(mc->dev);
	371	mc->dev = NULL;
	372	goto out;
	373	}
	374
	375	dev_set_drvdata(mc->dev, mc);
	376
d5176b41 SY	377	if (usb_submit_urb(mc->irq, GFP_KERNEL)) {
	378	rc = -EIO;
	379	goto out;
	380	}
	381
da308e8d SY	382	for (i=0; i<ARRAY_SIZE(dev_attrs); i++) {
	383	rc = device_create_file(mc->dev, &dev_attrs[i]);
	384	if (rc)
	385	goto out2;
	386	}
d5176b41	387
912b24c3	388	dev_info(&intf->dev, "USB PhidgetMotorControl attached\n");
d5176b41 SY	389
d5176b41 SY	390	return 0;
da308e8d SY	391	out2:
	392	while (i-- > 0)
	393	device_remove_file(mc->dev, &dev_attrs[i]);
d5176b41 SY	394	out:
d5176b41 SY	395	if (mc) {
5483eb13	396	usb_free_urb(mc->irq);
d5176b41 SY	397	if (mc->data)
d5176b41 SY	398	usb_buffer_free(dev, URB_INT_SIZE, mc->data, mc->data_dma);
912b24c3 SY	399	if (mc->dev)
	400	device_unregister(mc->dev);
	401	if (mc->dev_no >= 0)
	402	clear_bit(mc->dev_no, &device_no);
	403
d5176b41 SY	404	kfree(mc);
	405	}
	406
	407	return rc;
	408	}
	409
	410	static void motorcontrol_disconnect(struct usb_interface *interface)
	411	{
	412	struct motorcontrol *mc;
da308e8d	413	int i;
d5176b41 SY	414
	415	mc = usb_get_intfdata(interface);
	416	usb_set_intfdata(interface, NULL);
	417	if (!mc)
	418	return;
	419
	420	usb_kill_urb(mc->irq);
	421	usb_free_urb(mc->irq);
	422	usb_buffer_free(mc->udev, URB_INT_SIZE, mc->data, mc->data_dma);
	423
	424	cancel_delayed_work(&mc->do_notify);
	425
da308e8d SY	426	for (i=0; i<ARRAY_SIZE(dev_attrs); i++)
da308e8d SY	427	device_remove_file(mc->dev, &dev_attrs[i]);
d5176b41	428
912b24c3	429	device_unregister(mc->dev);
d5176b41 SY	430
d5176b41 SY	431	usb_put_dev(mc->udev);
912b24c3	432	clear_bit(mc->dev_no, &device_no);
d5176b41	433	kfree(mc);
912b24c3 SY	434
912b24c3 SY	435	dev_info(&interface->dev, "USB PhidgetMotorControl detached\n");
d5176b41 SY	436	}
	437
	438	static struct usb_driver motorcontrol_driver = {
	439	.name = "phidgetmotorcontrol",
	440	.probe = motorcontrol_probe,
	441	.disconnect = motorcontrol_disconnect,
	442	.id_table = id_table
	443	};
	444
	445	static int __init motorcontrol_init(void)
	446	{
	447	int retval = 0;
	448
	449	retval = usb_register(&motorcontrol_driver);
	450	if (retval)
	451	err("usb_register failed. Error number %d", retval);
	452
	453	return retval;
	454	}
	455
	456	static void __exit motorcontrol_exit(void)
	457	{
	458	usb_deregister(&motorcontrol_driver);
	459	}
	460
	461	module_init(motorcontrol_init);
	462	module_exit(motorcontrol_exit);
	463
	464	MODULE_AUTHOR(DRIVER_AUTHOR);
	465	MODULE_DESCRIPTION(DRIVER_DESC);
	466	MODULE_LICENSE("GPL");