[deliverable/linux.git] / drivers / usb / misc / appledisplay.c

/*
 * Apple Cinema Display driver
 *
 * Copyright (C) 2006  Michael Hanselmann (linux-kernel@hansmi.ch)
 *
 * Thanks to Caskey L. Dickson for his work with acdctl.
 *
 * 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 program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
 */

#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/usb.h>
#include <linux/backlight.h>
#include <linux/timer.h>
#include <linux/workqueue.h>
#include <linux/atomic.h>

#define APPLE_VENDOR_ID		0x05AC

#define USB_REQ_GET_REPORT	0x01
#define USB_REQ_SET_REPORT	0x09

#define ACD_USB_TIMEOUT		250

#define ACD_USB_EDID		0x0302
#define ACD_USB_BRIGHTNESS	0x0310

#define ACD_BTN_NONE		0
#define ACD_BTN_BRIGHT_UP	3
#define ACD_BTN_BRIGHT_DOWN	4

#define ACD_URB_BUFFER_LEN	2
#define ACD_MSG_BUFFER_LEN	2

#define APPLEDISPLAY_DEVICE(prod)				\
	.match_flags = USB_DEVICE_ID_MATCH_DEVICE |		\
		       USB_DEVICE_ID_MATCH_INT_CLASS |		\
		       USB_DEVICE_ID_MATCH_INT_PROTOCOL,	\
	.idVendor = APPLE_VENDOR_ID,				\
	.idProduct = (prod),					\
	.bInterfaceClass = USB_CLASS_HID,			\
	.bInterfaceProtocol = 0x00

/* table of devices that work with this driver */
static const struct usb_device_id appledisplay_table[] = {
	{ APPLEDISPLAY_DEVICE(0x9218) },
	{ APPLEDISPLAY_DEVICE(0x9219) },
	{ APPLEDISPLAY_DEVICE(0x921c) },
	{ APPLEDISPLAY_DEVICE(0x921d) },
	{ APPLEDISPLAY_DEVICE(0x9236) },

	/* Terminating entry */
	{ }
};
MODULE_DEVICE_TABLE(usb, appledisplay_table);

/* Structure to hold all of our device specific stuff */
struct appledisplay {
	struct usb_device *udev;	/* usb device */
	struct urb *urb;		/* usb request block */
	struct backlight_device *bd;	/* backlight device */
	u8 *urbdata;			/* interrupt URB data buffer */
	u8 *msgdata;			/* control message data buffer */

	struct delayed_work work;
	int button_pressed;
	spinlock_t lock;
	struct mutex sysfslock;		/* concurrent read and write */
};

static atomic_t count_displays = ATOMIC_INIT(0);
static struct workqueue_struct *wq;

static void appledisplay_complete(struct urb *urb)
{
	struct appledisplay *pdata = urb->context;
	struct device *dev = &pdata->udev->dev;
	unsigned long flags;
	int status = urb->status;
	int retval;

	switch (status) {
	case 0:
		/* success */
		break;
	case -EOVERFLOW:
		dev_err(dev,
			"OVERFLOW with data length %d, actual length is %d\n",
			ACD_URB_BUFFER_LEN, pdata->urb->actual_length);
	case -ECONNRESET:
	case -ENOENT:
	case -ESHUTDOWN:
		/* This urb is terminated, clean up */
		dev_dbg(dev, "%s - urb shuttingdown with status: %d\n",
			__func__, status);
		return;
	default:
		dev_dbg(dev, "%s - nonzero urb status received: %d\n",
			__func__, status);
		goto exit;
	}

	spin_lock_irqsave(&pdata->lock, flags);

	switch(pdata->urbdata[1]) {
	case ACD_BTN_BRIGHT_UP:
	case ACD_BTN_BRIGHT_DOWN:
		pdata->button_pressed = 1;
		queue_delayed_work(wq, &pdata->work, 0);
		break;
	case ACD_BTN_NONE:
	default:
		pdata->button_pressed = 0;
		break;
	}

	spin_unlock_irqrestore(&pdata->lock, flags);

exit:
	retval = usb_submit_urb(pdata->urb, GFP_ATOMIC);
	if (retval) {
		dev_err(dev, "%s - usb_submit_urb failed with result %d\n",
			__func__, retval);
	}
}

static int appledisplay_bl_update_status(struct backlight_device *bd)
{
	struct appledisplay *pdata = bl_get_data(bd);
	int retval;

	mutex_lock(&pdata->sysfslock);
	pdata->msgdata[0] = 0x10;
	pdata->msgdata[1] = bd->props.brightness;

	retval = usb_control_msg(
		pdata->udev,
		usb_sndctrlpipe(pdata->udev, 0),
		USB_REQ_SET_REPORT,
		USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
		ACD_USB_BRIGHTNESS,
		0,
		pdata->msgdata, 2,
		ACD_USB_TIMEOUT);
	mutex_unlock(&pdata->sysfslock);
	
	return retval;
}

static int appledisplay_bl_get_brightness(struct backlight_device *bd)
{
	struct appledisplay *pdata = bl_get_data(bd);
	int retval, brightness;

	mutex_lock(&pdata->sysfslock);
	retval = usb_control_msg(
		pdata->udev,
		usb_rcvctrlpipe(pdata->udev, 0),
		USB_REQ_GET_REPORT,
		USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
		ACD_USB_BRIGHTNESS,
		0,
		pdata->msgdata, 2,
		ACD_USB_TIMEOUT);
	brightness = pdata->msgdata[1];
	mutex_unlock(&pdata->sysfslock);

	if (retval < 0)
		return retval;
	else
		return brightness;
}

static const struct backlight_ops appledisplay_bl_data = {
	.get_brightness	= appledisplay_bl_get_brightness,
	.update_status	= appledisplay_bl_update_status,
};

static void appledisplay_work(struct work_struct *work)
{
	struct appledisplay *pdata =
		container_of(work, struct appledisplay, work.work);
	int retval;

	retval = appledisplay_bl_get_brightness(pdata->bd);
	if (retval >= 0)
		pdata->bd->props.brightness = retval;

	/* Poll again in about 125ms if there's still a button pressed */
	if (pdata->button_pressed)
		schedule_delayed_work(&pdata->work, HZ / 8);
}

static int appledisplay_probe(struct usb_interface *iface,
	const struct usb_device_id *id)
{
	struct backlight_properties props;
	struct appledisplay *pdata;
	struct usb_device *udev = interface_to_usbdev(iface);
	struct usb_host_interface *iface_desc;
	struct usb_endpoint_descriptor *endpoint;
	int int_in_endpointAddr = 0;
	int i, retval = -ENOMEM, brightness;
	char bl_name[20];

	/* set up the endpoint information */
	/* use only the first interrupt-in endpoint */
	iface_desc = iface->cur_altsetting;
	for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) {
		endpoint = &iface_desc->endpoint[i].desc;
		if (!int_in_endpointAddr && usb_endpoint_is_int_in(endpoint)) {
			/* we found an interrupt in endpoint */
			int_in_endpointAddr = endpoint->bEndpointAddress;
			break;
		}
	}
	if (!int_in_endpointAddr) {
		dev_err(&iface->dev, "Could not find int-in endpoint\n");
		return -EIO;
	}

	/* allocate memory for our device state and initialize it */
	pdata = kzalloc(sizeof(struct appledisplay), GFP_KERNEL);
	if (!pdata) {
		retval = -ENOMEM;
		dev_err(&iface->dev, "Out of memory\n");
		goto error;
	}

	pdata->udev = udev;

	spin_lock_init(&pdata->lock);
	INIT_DELAYED_WORK(&pdata->work, appledisplay_work);
	mutex_init(&pdata->sysfslock);

	/* Allocate buffer for control messages */
	pdata->msgdata = kmalloc(ACD_MSG_BUFFER_LEN, GFP_KERNEL);
	if (!pdata->msgdata) {
		retval = -ENOMEM;
		dev_err(&iface->dev,
			"Allocating buffer for control messages failed\n");
		goto error;
	}

	/* Allocate interrupt URB */
	pdata->urb = usb_alloc_urb(0, GFP_KERNEL);
	if (!pdata->urb) {
		retval = -ENOMEM;
		dev_err(&iface->dev, "Allocating URB failed\n");
		goto error;
	}

	/* Allocate buffer for interrupt data */
	pdata->urbdata = usb_alloc_coherent(pdata->udev, ACD_URB_BUFFER_LEN,
		GFP_KERNEL, &pdata->urb->transfer_dma);
	if (!pdata->urbdata) {
		retval = -ENOMEM;
		dev_err(&iface->dev, "Allocating URB buffer failed\n");
		goto error;
	}

	/* Configure interrupt URB */
	usb_fill_int_urb(pdata->urb, udev,
		usb_rcvintpipe(udev, int_in_endpointAddr),
		pdata->urbdata, ACD_URB_BUFFER_LEN, appledisplay_complete,
		pdata, 1);
	if (usb_submit_urb(pdata->urb, GFP_KERNEL)) {
		retval = -EIO;
		dev_err(&iface->dev, "Submitting URB failed\n");
		goto error;
	}

	/* Register backlight device */
	snprintf(bl_name, sizeof(bl_name), "appledisplay%d",
		atomic_inc_return(&count_displays) - 1);
	memset(&props, 0, sizeof(struct backlight_properties));
	props.type = BACKLIGHT_RAW;
	props.max_brightness = 0xff;
	pdata->bd = backlight_device_register(bl_name, NULL, pdata,
					      &appledisplay_bl_data, &props);
	if (IS_ERR(pdata->bd)) {
		dev_err(&iface->dev, "Backlight registration failed\n");
		retval = PTR_ERR(pdata->bd);
		goto error;
	}

	/* Try to get brightness */
	brightness = appledisplay_bl_get_brightness(pdata->bd);

	if (brightness < 0) {
		retval = brightness;
		dev_err(&iface->dev,
			"Error while getting initial brightness: %d\n", retval);
		goto error;
	}

	/* Set brightness in backlight device */
	pdata->bd->props.brightness = brightness;

	/* save our data pointer in the interface device */
	usb_set_intfdata(iface, pdata);

	printk(KERN_INFO "appledisplay: Apple Cinema Display connected\n");

	return 0;

error:
	if (pdata) {
		if (pdata->urb) {
			usb_kill_urb(pdata->urb);
			if (pdata->urbdata)
				usb_free_coherent(pdata->udev, ACD_URB_BUFFER_LEN,
					pdata->urbdata, pdata->urb->transfer_dma);
			usb_free_urb(pdata->urb);
		}
		if (!IS_ERR(pdata->bd))
			backlight_device_unregister(pdata->bd);
		kfree(pdata->msgdata);
	}
	usb_set_intfdata(iface, NULL);
	kfree(pdata);
	return retval;
}

static void appledisplay_disconnect(struct usb_interface *iface)
{
	struct appledisplay *pdata = usb_get_intfdata(iface);

	if (pdata) {
		usb_kill_urb(pdata->urb);
		cancel_delayed_work(&pdata->work);
		backlight_device_unregister(pdata->bd);
		usb_free_coherent(pdata->udev, ACD_URB_BUFFER_LEN,
			pdata->urbdata, pdata->urb->transfer_dma);
		usb_free_urb(pdata->urb);
		kfree(pdata->msgdata);
		kfree(pdata);
	}

	printk(KERN_INFO "appledisplay: Apple Cinema Display disconnected\n");
}

static struct usb_driver appledisplay_driver = {
	.name		= "appledisplay",
	.probe		= appledisplay_probe,
	.disconnect	= appledisplay_disconnect,
	.id_table	= appledisplay_table,
};

static int __init appledisplay_init(void)
{
	wq = create_singlethread_workqueue("appledisplay");
	if (!wq) {
		printk(KERN_ERR "appledisplay: Could not create work queue\n");
		return -ENOMEM;
	}

	return usb_register(&appledisplay_driver);
}

static void __exit appledisplay_exit(void)
{
	flush_workqueue(wq);
	destroy_workqueue(wq);
	usb_deregister(&appledisplay_driver);
}

MODULE_AUTHOR("Michael Hanselmann");
MODULE_DESCRIPTION("Apple Cinema Display driver");
MODULE_LICENSE("GPL");

module_init(appledisplay_init);
module_exit(appledisplay_exit);
Commit	Line	Data
069e8a65	1	/*
	2	* Apple Cinema Display driver
	3	*
	4	* Copyright (C) 2006 Michael Hanselmann (linux-kernel@hansmi.ch)
	5	*
	6	* Thanks to Caskey L. Dickson for his work with acdctl.
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
	21	*/
	22
069e8a65	23	#include <linux/kernel.h>
	24	#include <linux/errno.h>
	25	#include <linux/init.h>
	26	#include <linux/module.h>
5a0e3ad6	27	#include <linux/slab.h>
069e8a65	28	#include <linux/usb.h>
	29	#include <linux/backlight.h>
	30	#include <linux/timer.h>
	31	#include <linux/workqueue.h>
60063497	32	#include <linux/atomic.h>
069e8a65	33
	34	#define APPLE_VENDOR_ID 0x05AC
	35
	36	#define USB_REQ_GET_REPORT 0x01
	37	#define USB_REQ_SET_REPORT 0x09
	38
	39	#define ACD_USB_TIMEOUT 250
	40
	41	#define ACD_USB_EDID 0x0302
	42	#define ACD_USB_BRIGHTNESS 0x0310
	43
	44	#define ACD_BTN_NONE 0
	45	#define ACD_BTN_BRIGHT_UP 3
	46	#define ACD_BTN_BRIGHT_DOWN 4
	47
	48	#define ACD_URB_BUFFER_LEN 2
	49	#define ACD_MSG_BUFFER_LEN 2
	50
	51	#define APPLEDISPLAY_DEVICE(prod) \
	52	.match_flags = USB_DEVICE_ID_MATCH_DEVICE \| \
	53	USB_DEVICE_ID_MATCH_INT_CLASS \| \
	54	USB_DEVICE_ID_MATCH_INT_PROTOCOL, \
	55	.idVendor = APPLE_VENDOR_ID, \
	56	.idProduct = (prod), \
	57	.bInterfaceClass = USB_CLASS_HID, \
	58	.bInterfaceProtocol = 0x00
	59
	60	/* table of devices that work with this driver */
33b9e162	61	static const struct usb_device_id appledisplay_table[] = {
069e8a65	62	{ APPLEDISPLAY_DEVICE(0x9218) },
069e8a65	63	{ APPLEDISPLAY_DEVICE(0x9219) },
4b372072	64	{ APPLEDISPLAY_DEVICE(0x921c) },
069e8a65	65	{ APPLEDISPLAY_DEVICE(0x921d) },
e7d3b6e2	66	{ APPLEDISPLAY_DEVICE(0x9236) },
069e8a65	67
	68	/* Terminating entry */
	69	{ }
	70	};
	71	MODULE_DEVICE_TABLE(usb, appledisplay_table);
	72
	73	/* Structure to hold all of our device specific stuff */
	74	struct appledisplay {
	75	struct usb_device udev; / usb device */
	76	struct urb urb; / usb request block */
	77	struct backlight_device bd; / backlight device */
37e9066b	78	u8 urbdata; / interrupt URB data buffer */
37e9066b	79	u8 msgdata; / control message data buffer */
069e8a65	80
6d5aefb8	81	struct delayed_work work;
069e8a65	82	int button_pressed;
069e8a65	83	spinlock_t lock;
552e1f26	84	struct mutex sysfslock; /* concurrent read and write */
069e8a65	85	};
	86
	87	static atomic_t count_displays = ATOMIC_INIT(0);
	88	static struct workqueue_struct *wq;
	89
7d12e780	90	static void appledisplay_complete(struct urb *urb)
069e8a65	91	{
069e8a65	92	struct appledisplay *pdata = urb->context;
0a3fd536	93	struct device *dev = &pdata->udev->dev;
069e8a65	94	unsigned long flags;
13f9782d	95	int status = urb->status;
069e8a65	96	int retval;
069e8a65	97
13f9782d	98	switch (status) {
069e8a65	99	case 0:
	100	/* success */
	101	break;
	102	case -EOVERFLOW:
0a3fd536 GKH	103	dev_err(dev,
0a3fd536 GKH	104	"OVERFLOW with data length %d, actual length is %d\n",
069e8a65	105	ACD_URB_BUFFER_LEN, pdata->urb->actual_length);
	106	case -ECONNRESET:
	107	case -ENOENT:
	108	case -ESHUTDOWN:
	109	/* This urb is terminated, clean up */
0a3fd536	110	dev_dbg(dev, "%s - urb shuttingdown with status: %d\n",
441b62c1	111	__func__, status);
069e8a65	112	return;
069e8a65	113	default:
e2b86c1d	114	dev_dbg(dev, "%s - nonzero urb status received: %d\n",
441b62c1	115	__func__, status);
069e8a65	116	goto exit;
	117	}
	118
	119	spin_lock_irqsave(&pdata->lock, flags);
	120
	121	switch(pdata->urbdata[1]) {
	122	case ACD_BTN_BRIGHT_UP:
	123	case ACD_BTN_BRIGHT_DOWN:
	124	pdata->button_pressed = 1;
6d5aefb8	125	queue_delayed_work(wq, &pdata->work, 0);
069e8a65	126	break;
	127	case ACD_BTN_NONE:
	128	default:
	129	pdata->button_pressed = 0;
	130	break;
	131	}
	132
	133	spin_unlock_irqrestore(&pdata->lock, flags);
	134
	135	exit:
	136	retval = usb_submit_urb(pdata->urb, GFP_ATOMIC);
	137	if (retval) {
0a3fd536	138	dev_err(dev, "%s - usb_submit_urb failed with result %d\n",
441b62c1	139	__func__, retval);
069e8a65	140	}
	141	}
	142
	143	static int appledisplay_bl_update_status(struct backlight_device *bd)
	144	{
655bfd7a	145	struct appledisplay *pdata = bl_get_data(bd);
069e8a65	146	int retval;
069e8a65	147
552e1f26	148	mutex_lock(&pdata->sysfslock);
069e8a65	149	pdata->msgdata[0] = 0x10;
599a52d1	150	pdata->msgdata[1] = bd->props.brightness;
069e8a65	151
	152	retval = usb_control_msg(
	153	pdata->udev,
	154	usb_sndctrlpipe(pdata->udev, 0),
	155	USB_REQ_SET_REPORT,
	156	USB_DIR_OUT \| USB_TYPE_CLASS \| USB_RECIP_INTERFACE,
	157	ACD_USB_BRIGHTNESS,
	158	0,
	159	pdata->msgdata, 2,
	160	ACD_USB_TIMEOUT);
552e1f26 ON	161	mutex_unlock(&pdata->sysfslock);
552e1f26 ON	162
069e8a65	163	return retval;
	164	}
	165
	166	static int appledisplay_bl_get_brightness(struct backlight_device *bd)
	167	{
655bfd7a	168	struct appledisplay *pdata = bl_get_data(bd);
552e1f26	169	int retval, brightness;
069e8a65	170
552e1f26	171	mutex_lock(&pdata->sysfslock);
069e8a65	172	retval = usb_control_msg(
	173	pdata->udev,
	174	usb_rcvctrlpipe(pdata->udev, 0),
	175	USB_REQ_GET_REPORT,
	176	USB_DIR_IN \| USB_TYPE_CLASS \| USB_RECIP_INTERFACE,
	177	ACD_USB_BRIGHTNESS,
	178	0,
	179	pdata->msgdata, 2,
	180	ACD_USB_TIMEOUT);
552e1f26 ON	181	brightness = pdata->msgdata[1];
552e1f26 ON	182	mutex_unlock(&pdata->sysfslock);
069e8a65	183
	184	if (retval < 0)
	185	return retval;
	186	else
552e1f26	187	return brightness;
069e8a65	188	}
069e8a65	189
cedf8a78	190	static const struct backlight_ops appledisplay_bl_data = {
069e8a65	191	.get_brightness = appledisplay_bl_get_brightness,
069e8a65	192	.update_status = appledisplay_bl_update_status,
069e8a65	193	};
069e8a65	194
6d5aefb8	195	static void appledisplay_work(struct work_struct *work)
069e8a65	196	{
6d5aefb8 DH	197	struct appledisplay *pdata =
6d5aefb8 DH	198	container_of(work, struct appledisplay, work.work);
069e8a65	199	int retval;
069e8a65	200
069e8a65	201	retval = appledisplay_bl_get_brightness(pdata->bd);
069e8a65	202	if (retval >= 0)
599a52d1	203	pdata->bd->props.brightness = retval;
069e8a65	204
	205	/* Poll again in about 125ms if there's still a button pressed */
	206	if (pdata->button_pressed)
	207	schedule_delayed_work(&pdata->work, HZ / 8);
	208	}
	209
	210	static int appledisplay_probe(struct usb_interface *iface,
	211	const struct usb_device_id *id)
	212	{
a19a6ee6	213	struct backlight_properties props;
069e8a65	214	struct appledisplay *pdata;
	215	struct usb_device *udev = interface_to_usbdev(iface);
	216	struct usb_host_interface *iface_desc;
	217	struct usb_endpoint_descriptor *endpoint;
	218	int int_in_endpointAddr = 0;
	219	int i, retval = -ENOMEM, brightness;
	220	char bl_name[20];
	221
	222	/* set up the endpoint information */
	223	/* use only the first interrupt-in endpoint */
	224	iface_desc = iface->cur_altsetting;
	225	for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) {
	226	endpoint = &iface_desc->endpoint[i].desc;
16f96376	227	if (!int_in_endpointAddr && usb_endpoint_is_int_in(endpoint)) {
069e8a65	228	/* we found an interrupt in endpoint */
	229	int_in_endpointAddr = endpoint->bEndpointAddress;
	230	break;
	231	}
	232	}
	233	if (!int_in_endpointAddr) {
fd3f1917	234	dev_err(&iface->dev, "Could not find int-in endpoint\n");
069e8a65	235	return -EIO;
	236	}
	237
	238	/* allocate memory for our device state and initialize it */
	239	pdata = kzalloc(sizeof(struct appledisplay), GFP_KERNEL);
	240	if (!pdata) {
	241	retval = -ENOMEM;
fd3f1917	242	dev_err(&iface->dev, "Out of memory\n");
069e8a65	243	goto error;
	244	}
	245
	246	pdata->udev = udev;
	247
	248	spin_lock_init(&pdata->lock);
6d5aefb8	249	INIT_DELAYED_WORK(&pdata->work, appledisplay_work);
552e1f26	250	mutex_init(&pdata->sysfslock);
069e8a65	251
	252	/* Allocate buffer for control messages */
	253	pdata->msgdata = kmalloc(ACD_MSG_BUFFER_LEN, GFP_KERNEL);
	254	if (!pdata->msgdata) {
	255	retval = -ENOMEM;
fd3f1917 GKH	256	dev_err(&iface->dev,
fd3f1917 GKH	257	"Allocating buffer for control messages failed\n");
069e8a65	258	goto error;
	259	}
	260
	261	/* Allocate interrupt URB */
	262	pdata->urb = usb_alloc_urb(0, GFP_KERNEL);
	263	if (!pdata->urb) {
	264	retval = -ENOMEM;
fd3f1917	265	dev_err(&iface->dev, "Allocating URB failed\n");
069e8a65	266	goto error;
	267	}
	268
	269	/* Allocate buffer for interrupt data */
997ea58e	270	pdata->urbdata = usb_alloc_coherent(pdata->udev, ACD_URB_BUFFER_LEN,
069e8a65	271	GFP_KERNEL, &pdata->urb->transfer_dma);
	272	if (!pdata->urbdata) {
	273	retval = -ENOMEM;
fd3f1917	274	dev_err(&iface->dev, "Allocating URB buffer failed\n");
069e8a65	275	goto error;
	276	}
	277
	278	/* Configure interrupt URB */
	279	usb_fill_int_urb(pdata->urb, udev,
	280	usb_rcvintpipe(udev, int_in_endpointAddr),
	281	pdata->urbdata, ACD_URB_BUFFER_LEN, appledisplay_complete,
	282	pdata, 1);
	283	if (usb_submit_urb(pdata->urb, GFP_KERNEL)) {
	284	retval = -EIO;
fd3f1917	285	dev_err(&iface->dev, "Submitting URB failed\n");
069e8a65	286	goto error;
	287	}
	288
	289	/* Register backlight device */
	290	snprintf(bl_name, sizeof(bl_name), "appledisplay%d",
	291	atomic_inc_return(&count_displays) - 1);
a19a6ee6	292	memset(&props, 0, sizeof(struct backlight_properties));
bb7ca747	293	props.type = BACKLIGHT_RAW;
a19a6ee6	294	props.max_brightness = 0xff;
81450b73	295	pdata->bd = backlight_device_register(bl_name, NULL, pdata,
a19a6ee6	296	&appledisplay_bl_data, &props);
069e8a65	297	if (IS_ERR(pdata->bd)) {
fd3f1917	298	dev_err(&iface->dev, "Backlight registration failed\n");
cedf8a78	299	retval = PTR_ERR(pdata->bd);
069e8a65	300	goto error;
	301	}
	302
	303	/* Try to get brightness */
069e8a65	304	brightness = appledisplay_bl_get_brightness(pdata->bd);
069e8a65	305
	306	if (brightness < 0) {
	307	retval = brightness;
fd3f1917 GKH	308	dev_err(&iface->dev,
fd3f1917 GKH	309	"Error while getting initial brightness: %d\n", retval);
069e8a65	310	goto error;
	311	}
	312
	313	/* Set brightness in backlight device */
599a52d1	314	pdata->bd->props.brightness = brightness;
069e8a65	315
	316	/* save our data pointer in the interface device */
	317	usb_set_intfdata(iface, pdata);
	318
	319	printk(KERN_INFO "appledisplay: Apple Cinema Display connected\n");
	320
	321	return 0;
	322
	323	error:
	324	if (pdata) {
	325	if (pdata->urb) {
	326	usb_kill_urb(pdata->urb);
	327	if (pdata->urbdata)
997ea58e	328	usb_free_coherent(pdata->udev, ACD_URB_BUFFER_LEN,
069e8a65	329	pdata->urbdata, pdata->urb->transfer_dma);
	330	usb_free_urb(pdata->urb);
	331	}
c60b89aa	332	if (!IS_ERR(pdata->bd))
069e8a65	333	backlight_device_unregister(pdata->bd);
	334	kfree(pdata->msgdata);
	335	}
	336	usb_set_intfdata(iface, NULL);
	337	kfree(pdata);
	338	return retval;
	339	}
	340
	341	static void appledisplay_disconnect(struct usb_interface *iface)
	342	{
	343	struct appledisplay *pdata = usb_get_intfdata(iface);
	344
	345	if (pdata) {
	346	usb_kill_urb(pdata->urb);
	347	cancel_delayed_work(&pdata->work);
	348	backlight_device_unregister(pdata->bd);
997ea58e	349	usb_free_coherent(pdata->udev, ACD_URB_BUFFER_LEN,
069e8a65	350	pdata->urbdata, pdata->urb->transfer_dma);
	351	usb_free_urb(pdata->urb);
	352	kfree(pdata->msgdata);
	353	kfree(pdata);
	354	}
	355
	356	printk(KERN_INFO "appledisplay: Apple Cinema Display disconnected\n");
	357	}
	358
	359	static struct usb_driver appledisplay_driver = {
	360	.name = "appledisplay",
	361	.probe = appledisplay_probe,
	362	.disconnect = appledisplay_disconnect,
	363	.id_table = appledisplay_table,
	364	};
	365
	366	static int __init appledisplay_init(void)
	367	{
	368	wq = create_singlethread_workqueue("appledisplay");
	369	if (!wq) {
fd3f1917	370	printk(KERN_ERR "appledisplay: Could not create work queue\n");
069e8a65	371	return -ENOMEM;
	372	}
	373
	374	return usb_register(&appledisplay_driver);
	375	}
	376
	377	static void __exit appledisplay_exit(void)
	378	{
	379	flush_workqueue(wq);
	380	destroy_workqueue(wq);
	381	usb_deregister(&appledisplay_driver);
	382	}
	383
	384	MODULE_AUTHOR("Michael Hanselmann");
	385	MODULE_DESCRIPTION("Apple Cinema Display driver");
	386	MODULE_LICENSE("GPL");
	387
	388	module_init(appledisplay_init);
	389	module_exit(appledisplay_exit);