empeg.c 14.1 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 * USB Empeg empeg-car player driver
 *
 *	Copyright (C) 2000, 2001
 *	    Gary Brubaker (xavyer@ix.netcom.com)
 *
 *	Copyright (C) 1999 - 2001
 *	    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, version 2.
 *
Alan Cox's avatar
Alan Cox committed
14 15 16
 * See Documentation/usb/usb-serial.txt for more information on using this
 * driver
 *
Linus Torvalds's avatar
Linus Torvalds committed
17
 * (07/16/2001) gb
Alan Cox's avatar
Alan Cox committed
18 19 20
 *	remove unused code in empeg_close() (thanks to Oliver Neukum for
 *	pointing this out) and rewrote empeg_set_termios().
 *
Linus Torvalds's avatar
Linus Torvalds committed
21
 * (05/30/2001) gkh
Alan Cox's avatar
Alan Cox committed
22 23
 *	switched from using spinlock to a semaphore, which fixes lots of
 * problems.
Linus Torvalds's avatar
Linus Torvalds committed
24 25 26
 *
 * (04/08/2001) gb
 *      Identify version on module load.
Alan Cox's avatar
Alan Cox committed
27
 *
Linus Torvalds's avatar
Linus Torvalds committed
28
 * (01/22/2001) gb
Alan Cox's avatar
Alan Cox committed
29 30
 *	Added write_room() and chars_in_buffer() support.
 *
Linus Torvalds's avatar
Linus Torvalds committed
31 32 33
 * (12/21/2000) gb
 *	Moved termio stuff inside the port->active check.
 *	Moved MOD_DEC_USE_COUNT to end of empeg_close().
Alan Cox's avatar
Alan Cox committed
34
 *
Linus Torvalds's avatar
Linus Torvalds committed
35
 * (12/03/2000) gb
Alan Cox's avatar
Alan Cox committed
36 37
 *	Added tty->ldisc.set_termios(port, tty, NULL) to empeg_open().
 *	This notifies the tty driver that the termios have changed.
Alan Cox's avatar
Alan Cox committed
38
 *
Linus Torvalds's avatar
Linus Torvalds committed
39
 * (11/13/2000) gb
Alan Cox's avatar
Alan Cox committed
40 41 42
 *	Moved tty->low_latency = 1 from empeg_read_bulk_callback() to
 *	empeg_open() (It only needs to be set once - Doh!)
 *
Linus Torvalds's avatar
Linus Torvalds committed
43 44
 * (11/11/2000) gb
 *	Updated to work with id_table structure.
Alan Cox's avatar
Alan Cox committed
45
 *
Linus Torvalds's avatar
Linus Torvalds committed
46 47 48 49 50 51 52
 * (11/04/2000) gb
 *	Forked this from visor.c, and hacked it up to work with an
 *	Empeg ltd. empeg-car player.  Constructive criticism welcomed.
 *	I would like to say, 'Thank You' to Greg Kroah-Hartman for the
 *	use of his code, and for his guidance, advice and patience. :)
 *	A 'Thank You' is in order for John Ripley of Empeg ltd for his
 *	advice, and patience too.
Alan Cox's avatar
Alan Cox committed
53
 *
Linus Torvalds's avatar
Linus Torvalds committed
54 55 56 57 58 59 60 61 62 63 64
 */

#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/tty_driver.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
#include <linux/spinlock.h>
Alan Cox's avatar
Alan Cox committed
65
#include <linux/uaccess.h>
Linus Torvalds's avatar
Linus Torvalds committed
66
#include <linux/usb.h>
67
#include <linux/usb/serial.h>
Linus Torvalds's avatar
Linus Torvalds committed
68 69 70 71 72 73 74 75 76 77 78 79 80 81

static int debug;

/*
 * Version Information
 */
#define DRIVER_VERSION "v1.2"
#define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Gary Brubaker <xavyer@ix.netcom.com>"
#define DRIVER_DESC "USB Empeg Mark I/II Driver"

#define EMPEG_VENDOR_ID			0x084f
#define EMPEG_PRODUCT_ID		0x0001

/* function prototypes for an empeg-car player */
82
static int  empeg_open(struct tty_struct *tty, struct usb_serial_port *port);
83
static void empeg_close(struct usb_serial_port *port);
Alan Cox's avatar
Alan Cox committed
84 85 86 87 88 89 90 91 92 93 94 95
static int  empeg_write(struct tty_struct *tty, struct usb_serial_port *port,
						const unsigned char *buf,
						int count);
static int  empeg_write_room(struct tty_struct *tty);
static int  empeg_chars_in_buffer(struct tty_struct *tty);
static void empeg_throttle(struct tty_struct *tty);
static void empeg_unthrottle(struct tty_struct *tty);
static int  empeg_startup(struct usb_serial *serial);
static void empeg_set_termios(struct tty_struct *tty,
		struct usb_serial_port *port, struct ktermios *old_termios);
static void empeg_write_bulk_callback(struct urb *urb);
static void empeg_read_bulk_callback(struct urb *urb);
Linus Torvalds's avatar
Linus Torvalds committed
96 97 98 99 100 101

static struct usb_device_id id_table [] = {
	{ USB_DEVICE(EMPEG_VENDOR_ID, EMPEG_PRODUCT_ID) },
	{ }					/* Terminating entry */
};

Alan Cox's avatar
Alan Cox committed
102
MODULE_DEVICE_TABLE(usb, id_table);
Linus Torvalds's avatar
Linus Torvalds committed
103 104 105 106 107 108

static struct usb_driver empeg_driver = {
	.name =		"empeg",
	.probe =	usb_serial_probe,
	.disconnect =	usb_serial_disconnect,
	.id_table =	id_table,
109
	.no_dynamic_id = 	1,
Linus Torvalds's avatar
Linus Torvalds committed
110 111
};

112
static struct usb_serial_driver empeg_device = {
113 114
	.driver = {
		.owner =	THIS_MODULE,
115
		.name =		"empeg",
116
	},
Linus Torvalds's avatar
Linus Torvalds committed
117
	.id_table =		id_table,
118
	.usb_driver = 		&empeg_driver,
Linus Torvalds's avatar
Linus Torvalds committed
119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143
	.num_ports =		1,
	.open =			empeg_open,
	.close =		empeg_close,
	.throttle =		empeg_throttle,
	.unthrottle =		empeg_unthrottle,
	.attach =		empeg_startup,
	.set_termios =		empeg_set_termios,
	.write =		empeg_write,
	.write_room =		empeg_write_room,
	.chars_in_buffer =	empeg_chars_in_buffer,
	.write_bulk_callback =	empeg_write_bulk_callback,
	.read_bulk_callback =	empeg_read_bulk_callback,
};

#define NUM_URBS			16
#define URB_TRANSFER_BUFFER_SIZE	4096

static struct urb	*write_urb_pool[NUM_URBS];
static spinlock_t	write_urb_pool_lock;
static int		bytes_in;
static int		bytes_out;

/******************************************************************************
 * Empeg specific driver functions
 ******************************************************************************/
144
static int empeg_open(struct tty_struct *tty,struct usb_serial_port *port)
Linus Torvalds's avatar
Linus Torvalds committed
145 146 147 148
{
	struct usb_serial *serial = port->serial;
	int result = 0;

149
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
150 151

	/* Force default termio settings */
152
	empeg_set_termios(tty, port, NULL);
Linus Torvalds's avatar
Linus Torvalds committed
153 154 155 156 157 158 159

	bytes_in = 0;
	bytes_out = 0;

	/* Start reading from the device */
	usb_fill_bulk_urb(
		port->read_urb,
Alan Cox's avatar
Alan Cox committed
160
		serial->dev,
Linus Torvalds's avatar
Linus Torvalds committed
161 162 163 164 165 166 167 168 169 170
		usb_rcvbulkpipe(serial->dev,
			port->bulk_in_endpointAddress),
		port->read_urb->transfer_buffer,
		port->read_urb->transfer_buffer_length,
		empeg_read_bulk_callback,
		port);

	result = usb_submit_urb(port->read_urb, GFP_KERNEL);

	if (result)
Alan Cox's avatar
Alan Cox committed
171 172 173
		dev_err(&port->dev,
			"%s - failed submitting read urb, error %d\n",
							__func__, result);
Linus Torvalds's avatar
Linus Torvalds committed
174 175 176 177 178

	return result;
}


179
static void empeg_close(struct usb_serial_port *port)
Linus Torvalds's avatar
Linus Torvalds committed
180
{
181
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
182 183 184 185 186 187 188 189

	/* shutdown our bulk read */
	usb_kill_urb(port->read_urb);
	/* Uncomment the following line if you want to see some statistics in your syslog */
	/* dev_info (&port->dev, "Bytes In = %d  Bytes Out = %d\n", bytes_in, bytes_out); */
}


Alan Cox's avatar
Alan Cox committed
190 191
static int empeg_write(struct tty_struct *tty, struct usb_serial_port *port,
					const unsigned char *buf, int count)
Linus Torvalds's avatar
Linus Torvalds committed
192 193 194 195 196 197 198 199 200 201
{
	struct usb_serial *serial = port->serial;
	struct urb *urb;
	const unsigned char *current_position = buf;
	unsigned long flags;
	int status;
	int i;
	int bytes_sent = 0;
	int transfer_size;

202
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
203 204 205 206 207

	while (count > 0) {
		/* try to find a free urb in our list of them */
		urb = NULL;

Alan Cox's avatar
Alan Cox committed
208
		spin_lock_irqsave(&write_urb_pool_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
209 210 211 212 213 214 215 216

		for (i = 0; i < NUM_URBS; ++i) {
			if (write_urb_pool[i]->status != -EINPROGRESS) {
				urb = write_urb_pool[i];
				break;
			}
		}

Alan Cox's avatar
Alan Cox committed
217
		spin_unlock_irqrestore(&write_urb_pool_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
218 219

		if (urb == NULL) {
220
			dbg("%s - no more free urbs", __func__);
Linus Torvalds's avatar
Linus Torvalds committed
221 222 223 224
			goto exit;
		}

		if (urb->transfer_buffer == NULL) {
Alan Cox's avatar
Alan Cox committed
225
			urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_ATOMIC);
Linus Torvalds's avatar
Linus Torvalds committed
226
			if (urb->transfer_buffer == NULL) {
Alan Cox's avatar
Alan Cox committed
227 228 229
				dev_err(&port->dev,
					"%s no more kernel memory...\n",
								__func__);
Linus Torvalds's avatar
Linus Torvalds committed
230 231 232 233
				goto exit;
			}
		}

Alan Cox's avatar
Alan Cox committed
234
		transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE);
Linus Torvalds's avatar
Linus Torvalds committed
235

Alan Cox's avatar
Alan Cox committed
236
		memcpy(urb->transfer_buffer, current_position, transfer_size);
Linus Torvalds's avatar
Linus Torvalds committed
237

238
		usb_serial_debug_data(debug, &port->dev, __func__, transfer_size, urb->transfer_buffer);
Linus Torvalds's avatar
Linus Torvalds committed
239 240

		/* build up our urb */
Alan Cox's avatar
Alan Cox committed
241
		usb_fill_bulk_urb(
Linus Torvalds's avatar
Linus Torvalds committed
242 243 244
			urb,
			serial->dev,
			usb_sndbulkpipe(serial->dev,
Alan Cox's avatar
Alan Cox committed
245
					port->bulk_out_endpointAddress),
Linus Torvalds's avatar
Linus Torvalds committed
246 247 248 249 250 251 252 253
			urb->transfer_buffer,
			transfer_size,
			empeg_write_bulk_callback,
			port);

		/* send it down the pipe */
		status = usb_submit_urb(urb, GFP_ATOMIC);
		if (status) {
254
			dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed with status = %d\n", __func__, status);
Linus Torvalds's avatar
Linus Torvalds committed
255 256 257 258 259 260 261 262 263 264 265 266
			bytes_sent = status;
			break;
		}

		current_position += transfer_size;
		bytes_sent += transfer_size;
		count -= transfer_size;
		bytes_out += transfer_size;

	}
exit:
	return bytes_sent;
Alan Cox's avatar
Alan Cox committed
267
}
Linus Torvalds's avatar
Linus Torvalds committed
268 269


Alan Cox's avatar
Alan Cox committed
270
static int empeg_write_room(struct tty_struct *tty)
Linus Torvalds's avatar
Linus Torvalds committed
271
{
Alan Cox's avatar
Alan Cox committed
272
	struct usb_serial_port *port = tty->driver_data;
Linus Torvalds's avatar
Linus Torvalds committed
273 274 275 276
	unsigned long flags;
	int i;
	int room = 0;

277
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
278

Alan Cox's avatar
Alan Cox committed
279
	spin_lock_irqsave(&write_urb_pool_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
280 281
	/* tally up the number of bytes available */
	for (i = 0; i < NUM_URBS; ++i) {
Alan Cox's avatar
Alan Cox committed
282
		if (write_urb_pool[i]->status != -EINPROGRESS)
Linus Torvalds's avatar
Linus Torvalds committed
283
			room += URB_TRANSFER_BUFFER_SIZE;
Alan Cox's avatar
Alan Cox committed
284 285
	}
	spin_unlock_irqrestore(&write_urb_pool_lock, flags);
286
	dbg("%s - returns %d", __func__, room);
Alan Cox's avatar
Alan Cox committed
287
	return room;
Linus Torvalds's avatar
Linus Torvalds committed
288 289 290 291

}


Alan Cox's avatar
Alan Cox committed
292
static int empeg_chars_in_buffer(struct tty_struct *tty)
Linus Torvalds's avatar
Linus Torvalds committed
293
{
Alan Cox's avatar
Alan Cox committed
294
	struct usb_serial_port *port = tty->driver_data;
Linus Torvalds's avatar
Linus Torvalds committed
295 296 297 298
	unsigned long flags;
	int i;
	int chars = 0;

299
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
300

Alan Cox's avatar
Alan Cox committed
301
	spin_lock_irqsave(&write_urb_pool_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
302 303 304

	/* tally up the number of bytes waiting */
	for (i = 0; i < NUM_URBS; ++i) {
Alan Cox's avatar
Alan Cox committed
305
		if (write_urb_pool[i]->status == -EINPROGRESS)
Linus Torvalds's avatar
Linus Torvalds committed
306 307 308
			chars += URB_TRANSFER_BUFFER_SIZE;
	}

Alan Cox's avatar
Alan Cox committed
309
	spin_unlock_irqrestore(&write_urb_pool_lock, flags);
310
	dbg("%s - returns %d", __func__, chars);
Alan Cox's avatar
Alan Cox committed
311
	return chars;
Linus Torvalds's avatar
Linus Torvalds committed
312 313 314
}


Alan Cox's avatar
Alan Cox committed
315
static void empeg_write_bulk_callback(struct urb *urb)
Linus Torvalds's avatar
Linus Torvalds committed
316
{
317 318
	struct usb_serial_port *port = urb->context;
	int status = urb->status;
Linus Torvalds's avatar
Linus Torvalds committed
319

320
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
321

322 323
	if (status) {
		dbg("%s - nonzero write bulk status received: %d",
324
		    __func__, status);
Linus Torvalds's avatar
Linus Torvalds committed
325 326 327
		return;
	}

328
	usb_serial_port_softint(port);
Linus Torvalds's avatar
Linus Torvalds committed
329 330 331
}


Alan Cox's avatar
Alan Cox committed
332
static void empeg_read_bulk_callback(struct urb *urb)
Linus Torvalds's avatar
Linus Torvalds committed
333
{
334
	struct usb_serial_port *port = urb->context;
Linus Torvalds's avatar
Linus Torvalds committed
335 336 337
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
	int result;
338
	int status = urb->status;
Linus Torvalds's avatar
Linus Torvalds committed
339

340
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
341

342 343
	if (status) {
		dbg("%s - nonzero read bulk status received: %d",
344
		    __func__, status);
Linus Torvalds's avatar
Linus Torvalds committed
345 346 347
		return;
	}

Alan Cox's avatar
Alan Cox committed
348 349
	usb_serial_debug_data(debug, &port->dev, __func__,
						urb->actual_length, data);
Alan Cox's avatar
Alan Cox committed
350
	tty = tty_port_tty_get(&port->port);
Linus Torvalds's avatar
Linus Torvalds committed
351 352

	if (urb->actual_length) {
Alan Cox's avatar
Alan Cox committed
353 354
		tty_buffer_request_room(tty, urb->actual_length);
		tty_insert_flip_string(tty, data, urb->actual_length);
Linus Torvalds's avatar
Linus Torvalds committed
355 356 357
		tty_flip_buffer_push(tty);
		bytes_in += urb->actual_length;
	}
Alan Cox's avatar
Alan Cox committed
358
	tty_kref_put(tty);
Linus Torvalds's avatar
Linus Torvalds committed
359 360 361 362

	/* Continue trying to always read  */
	usb_fill_bulk_urb(
		port->read_urb,
Alan Cox's avatar
Alan Cox committed
363
		port->serial->dev,
Linus Torvalds's avatar
Linus Torvalds committed
364 365 366 367 368 369 370 371 372 373
		usb_rcvbulkpipe(port->serial->dev,
			port->bulk_in_endpointAddress),
		port->read_urb->transfer_buffer,
		port->read_urb->transfer_buffer_length,
		empeg_read_bulk_callback,
		port);

	result = usb_submit_urb(port->read_urb, GFP_ATOMIC);

	if (result)
Alan Cox's avatar
Alan Cox committed
374 375 376
		dev_err(&urb->dev->dev,
			"%s - failed resubmitting read urb, error %d\n",
							__func__, result);
Linus Torvalds's avatar
Linus Torvalds committed
377 378 379 380 381 382

	return;

}


Alan Cox's avatar
Alan Cox committed
383
static void empeg_throttle(struct tty_struct *tty)
Linus Torvalds's avatar
Linus Torvalds committed
384
{
Alan Cox's avatar
Alan Cox committed
385
	struct usb_serial_port *port = tty->driver_data;
386
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
387 388 389 390
	usb_kill_urb(port->read_urb);
}


Alan Cox's avatar
Alan Cox committed
391
static void empeg_unthrottle(struct tty_struct *tty)
Linus Torvalds's avatar
Linus Torvalds committed
392
{
Alan Cox's avatar
Alan Cox committed
393
	struct usb_serial_port *port = tty->driver_data;
Linus Torvalds's avatar
Linus Torvalds committed
394
	int result;
395
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
396 397 398 399

	port->read_urb->dev = port->serial->dev;
	result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
	if (result)
Alan Cox's avatar
Alan Cox committed
400 401 402
		dev_err(&port->dev,
			"%s - failed submitting read urb, error %d\n",
							__func__, result);
Linus Torvalds's avatar
Linus Torvalds committed
403 404 405
}


Alan Cox's avatar
Alan Cox committed
406
static int  empeg_startup(struct usb_serial *serial)
Linus Torvalds's avatar
Linus Torvalds committed
407 408 409
{
	int r;

410
	dbg("%s", __func__);
Linus Torvalds's avatar
Linus Torvalds committed
411 412

	if (serial->dev->actconfig->desc.bConfigurationValue != 1) {
413
		dev_err(&serial->dev->dev, "active config #%d != 1 ??\n",
Linus Torvalds's avatar
Linus Torvalds committed
414 415 416
			serial->dev->actconfig->desc.bConfigurationValue);
		return -ENODEV;
	}
417
	dbg("%s - reset config", __func__);
Alan Cox's avatar
Alan Cox committed
418
	r = usb_reset_configuration(serial->dev);
Linus Torvalds's avatar
Linus Torvalds committed
419 420 421 422 423 424 425

	/* continue on with initialization */
	return r;

}


Alan Cox's avatar
Alan Cox committed
426 427
static void empeg_set_termios(struct tty_struct *tty,
		struct usb_serial_port *port, struct ktermios *old_termios)
Linus Torvalds's avatar
Linus Torvalds committed
428
{
Alan Cox's avatar
Alan Cox committed
429
	struct ktermios *termios = tty->termios;
430
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
431 432

	/*
Alan Cox's avatar
Alan Cox committed
433 434 435 436 437 438 439 440
	 * The empeg-car player wants these particular tty settings.
	 * You could, for example, change the baud rate, however the
	 * player only supports 115200 (currently), so there is really
	 * no point in support for changes to the tty settings.
	 * (at least for now)
	 *
	 * The default requirements for this device are:
	 */
441
	termios->c_iflag
Linus Torvalds's avatar
Linus Torvalds committed
442 443 444 445 446 447 448 449 450
		&= ~(IGNBRK	/* disable ignore break */
		| BRKINT	/* disable break causes interrupt */
		| PARMRK	/* disable mark parity errors */
		| ISTRIP	/* disable clear high bit of input characters */
		| INLCR		/* disable translate NL to CR */
		| IGNCR		/* disable ignore CR */
		| ICRNL		/* disable translate CR to NL */
		| IXON);	/* disable enable XON/XOFF flow control */

451
	termios->c_oflag
Linus Torvalds's avatar
Linus Torvalds committed
452 453
		&= ~OPOST;	/* disable postprocess output characters */

454
	termios->c_lflag
Linus Torvalds's avatar
Linus Torvalds committed
455 456 457 458 459 460
		&= ~(ECHO	/* disable echo input characters */
		| ECHONL	/* disable echo new line */
		| ICANON	/* disable erase, kill, werase, and rprnt special characters */
		| ISIG		/* disable interrupt, quit, and suspend special characters */
		| IEXTEN);	/* disable non-POSIX special characters */

461
	termios->c_cflag
Linus Torvalds's avatar
Linus Torvalds committed
462 463 464 465
		&= ~(CSIZE	/* no size */
		| PARENB	/* disable parity bit */
		| CBAUD);	/* clear current baud rate */

466 467
	termios->c_cflag
		|= CS8;		/* character size 8 bits */
Linus Torvalds's avatar
Linus Torvalds committed
468

Alan Cox's avatar
Alan Cox committed
469
	tty_encode_baud_rate(tty, 115200, 115200);
Linus Torvalds's avatar
Linus Torvalds committed
470 471 472
}


Alan Cox's avatar
Alan Cox committed
473
static int __init empeg_init(void)
Linus Torvalds's avatar
Linus Torvalds committed
474 475 476 477
{
	struct urb *urb;
	int i, retval;

Alan Cox's avatar
Alan Cox committed
478 479
	/* create our write urb pool and transfer buffers */
	spin_lock_init(&write_urb_pool_lock);
Linus Torvalds's avatar
Linus Torvalds committed
480 481 482 483
	for (i = 0; i < NUM_URBS; ++i) {
		urb = usb_alloc_urb(0, GFP_KERNEL);
		write_urb_pool[i] = urb;
		if (urb == NULL) {
484
			printk(KERN_ERR "empeg: No more urbs???\n");
Linus Torvalds's avatar
Linus Torvalds committed
485 486 487
			continue;
		}

Alan Cox's avatar
Alan Cox committed
488 489
		urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE,
								GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
490
		if (!urb->transfer_buffer) {
491 492
			printk(KERN_ERR "empeg: %s - out of memory for urb "
			       "buffers.", __func__);
Linus Torvalds's avatar
Linus Torvalds committed
493 494 495 496 497 498 499 500 501 502 503
			continue;
		}
	}

	retval = usb_serial_register(&empeg_device);
	if (retval)
		goto failed_usb_serial_register;
	retval = usb_register(&empeg_driver);
	if (retval)
		goto failed_usb_register;

504 505
	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
	       DRIVER_DESC "\n");
Linus Torvalds's avatar
Linus Torvalds committed
506 507 508 509 510 511 512

	return 0;
failed_usb_register:
	usb_serial_deregister(&empeg_device);
failed_usb_serial_register:
	for (i = 0; i < NUM_URBS; ++i) {
		if (write_urb_pool[i]) {
513
			kfree(write_urb_pool[i]->transfer_buffer);
Linus Torvalds's avatar
Linus Torvalds committed
514 515 516 517 518 519 520
			usb_free_urb(write_urb_pool[i]);
		}
	}
	return retval;
}


Alan Cox's avatar
Alan Cox committed
521
static void __exit empeg_exit(void)
Linus Torvalds's avatar
Linus Torvalds committed
522 523 524 525 526
{
	int i;
	unsigned long flags;

	usb_deregister(&empeg_driver);
Alan Cox's avatar
Alan Cox committed
527
	usb_serial_deregister(&empeg_device);
Linus Torvalds's avatar
Linus Torvalds committed
528

Alan Cox's avatar
Alan Cox committed
529
	spin_lock_irqsave(&write_urb_pool_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
530 531 532

	for (i = 0; i < NUM_URBS; ++i) {
		if (write_urb_pool[i]) {
Alan Cox's avatar
Alan Cox committed
533 534 535 536
			/* FIXME - uncomment the following usb_kill_urb call
			 * when the host controllers get fixed to set urb->dev
			 * = NULL after the urb is finished.  Otherwise this
			 * call oopses. */
Linus Torvalds's avatar
Linus Torvalds committed
537
			/* usb_kill_urb(write_urb_pool[i]); */
538
			kfree(write_urb_pool[i]->transfer_buffer);
Alan Cox's avatar
Alan Cox committed
539
			usb_free_urb(write_urb_pool[i]);
Linus Torvalds's avatar
Linus Torvalds committed
540 541
		}
	}
Alan Cox's avatar
Alan Cox committed
542
	spin_unlock_irqrestore(&write_urb_pool_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
543 544 545 546 547 548
}


module_init(empeg_init);
module_exit(empeg_exit);

Alan Cox's avatar
Alan Cox committed
549 550
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
Linus Torvalds's avatar
Linus Torvalds committed
551 552 553 554
MODULE_LICENSE("GPL");

module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug enabled or not");