CTC++ Coverage Report - Execution Profile    #757/1532

Files Summary | Functions Summary | Execution Profile | Index | No Index
First | Previous | Next | Last

File: drivers/usb/serial/empeg.c
Instrumentation mode: function-decision-multicondition
TER: 0 % ( 0/259)

Start/	End/
True	False	-	Line	Source
			1	/*
			2	* USB Empeg empeg-car player driver
			3	*
			4	*   Copyright (C) 2000, 2001
			5	*       Gary Brubaker (xavyer@ix.netcom.com)
			6	*
			7	*   Copyright (C) 1999 - 2001
			8	*       Greg Kroah-Hartman (greg@kroah.com)
			9	*
			10	*   This program is free software; you can redistribute it and/or modify
			11	*   it under the terms of the GNU General Public License, as published by
			12	*   the Free Software Foundation, version 2.
			13	*
			14	* See Documentation/usb/usb-serial.txt for more information on using this driver
			15	*
			16	* (07/16/2001) gb
			17	*   remove unused code in empeg_close() (thanks to Oliver Neukum for pointing this
			18	*   out) and rewrote empeg_set_termios().
			19	*
			20	* (05/30/2001) gkh
			21	*   switched from using spinlock to a semaphore, which fixes lots of problems.
			22	*
			23	* (04/08/2001) gb
			24	*      Identify version on module load.
			25	*
			26	* (01/22/2001) gb
			27	*   Added write_room() and chars_in_buffer() support.
			28	*
			29	* (12/21/2000) gb
			30	*   Moved termio stuff inside the port->active check.
			31	*   Moved MOD_DEC_USE_COUNT to end of empeg_close().
			32	*
			33	* (12/03/2000) gb
			34	*   Added port->tty->ldisc.set_termios(port->tty, NULL) to empeg_open()
			35	*   This notifies the tty driver that the termios have changed.
			36	*
			37	* (11/13/2000) gb
			38	*   Moved tty->low_latency = 1 from empeg_read_bulk_callback() to empeg_open()
			39	*   (It only needs to be set once - Doh!)
			40	*
			41	* (11/11/2000) gb
			42	*   Updated to work with id_table structure.
			43	*
			44	* (11/04/2000) gb
			45	*   Forked this from visor.c, and hacked it up to work with an
			46	*   Empeg ltd. empeg-car player.  Constructive criticism welcomed.
			47	*   I would like to say, 'Thank You' to Greg Kroah-Hartman for the
			48	*   use of his code, and for his guidance, advice and patience. :)
			49	*   A 'Thank You' is in order for John Ripley of Empeg ltd for his
			50	*   advice, and patience too.
			51	*
			52	*/
			53
			54	#include <linux/config.h>
			55	#include <linux/kernel.h>
			56	#include <linux/errno.h>
			57	#include <linux/init.h>
			58	#include <linux/slab.h>
			59	#include <linux/tty.h>
			60	#include <linux/tty_driver.h>
			61	#include <linux/tty_flip.h>
			62	#include <linux/module.h>
			63	#include <linux/spinlock.h>
			64	#include <asm/uaccess.h>
			65	#include <linux/usb.h>
			66	#include "usb-serial.h"
			67
			68	static int debug;
			69
			70	/*
			71	* Version Information
			72	*/
			73	#define DRIVER_VERSION "v1.2"
			74	#define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Gary Brubaker <xavyer@ix.netcom.com>"
			75	#define DRIVER_DESC "USB Empeg Mark I/II Driver"
			76
			77	#define EMPEG_VENDOR_ID         0x084f
			78	#define EMPEG_PRODUCT_ID      0x0001
			79
			80	/* function prototypes for an empeg-car player */
			81	static int  empeg_open         (struct usb_serial_port *port, struct file *filp);
			82	static void empeg_close         (struct usb_serial_port *port, struct file *filp);
			83	static int  empeg_write         (struct usb_serial_port *port,
			84	const unsigned char *buf,
			85	int count);
			86	static int  empeg_write_room      (struct usb_serial_port *port);
			87	static int  empeg_chars_in_buffer   (struct usb_serial_port *port);
			88	static void empeg_throttle      (struct usb_serial_port *port);
			89	static void empeg_unthrottle      (struct usb_serial_port *port);
			90	static int  empeg_startup      (struct usb_serial *serial);
			91	static void empeg_shutdown      (struct usb_serial *serial);
			92	static int  empeg_ioctl         (struct usb_serial_port *port,
			93	struct file * file,
			94	unsigned int cmd,
			95	unsigned long arg);
			96	static void empeg_set_termios      (struct usb_serial_port *port, struct termios *old_termios);
			97	static void empeg_write_bulk_callback   (struct urb *urb, struct pt_regs *regs);
			98	static void empeg_read_bulk_callback   (struct urb *urb, struct pt_regs *regs);
			99
			100	static struct usb_device_id id_table [] = {
			101	{ USB_DEVICE(EMPEG_VENDOR_ID, EMPEG_PRODUCT_ID) },
			102	{ }               /* Terminating entry */
			103	};
			104
			105	MODULE_DEVICE_TABLE (usb, id_table);
			106
			107	static struct usb_driver empeg_driver = {
			108	.name =      "empeg",
			109	.probe =   usb_serial_probe,
			110	.disconnect =   usb_serial_disconnect,
			111	.id_table =   id_table,
			112	.no_dynamic_id =    1,
			113	};
			114
			115	static struct usb_serial_driver empeg_device = {
			116	.driver = {
			117	.owner =   THIS_MODULE,
			118	.name =      "empeg",
			119	},
			120	.id_table =      id_table,
			121	.num_interrupt_in =   0,
			122	.num_bulk_in =      1,
			123	.num_bulk_out =      1,
			124	.num_ports =      1,
			125	.open =         empeg_open,
			126	.close =      empeg_close,
			127	.throttle =      empeg_throttle,
			128	.unthrottle =      empeg_unthrottle,
			129	.attach =      empeg_startup,
			130	.shutdown =      empeg_shutdown,
			131	.ioctl =      empeg_ioctl,
			132	.set_termios =      empeg_set_termios,
			133	.write =      empeg_write,
			134	.write_room =      empeg_write_room,
			135	.chars_in_buffer =   empeg_chars_in_buffer,
			136	.write_bulk_callback =   empeg_write_bulk_callback,
			137	.read_bulk_callback =   empeg_read_bulk_callback,
			138	};
			139
			140	#define NUM_URBS         16
			141	#define URB_TRANSFER_BUFFER_SIZE   4096
			142
			143	static struct urb   *write_urb_pool[NUM_URBS];
			144	static spinlock_t   write_urb_pool_lock;
			145	static int      bytes_in;
			146	static int      bytes_out;
			147
			148	/******************************************************************************
			149	* Empeg specific driver functions
			150	******************************************************************************/
0	0	-	151	static int empeg_open (struct usb_serial_port *port, struct file *filp)
			152	{
			153	struct usb_serial *serial = port->serial;
			154	int result = 0;
			155
			156	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	156	if (debug)
0	0	-	156	do-while (0)
			157
			158	/* Force default termio settings */
			159	empeg_set_termios (port, NULL) ;
			160
			161	bytes_in = 0;
			162	bytes_out = 0;
			163
			164	/* Start reading from the device */
			165	usb_fill_bulk_urb(
			166	port->read_urb,
			167	serial->dev,
			168	usb_rcvbulkpipe(serial->dev,
			169	port->bulk_in_endpointAddress),
			170	port->read_urb->transfer_buffer,
			171	port->read_urb->transfer_buffer_length,
			172	empeg_read_bulk_callback,
			173	port);
			174
			175	result = usb_submit_urb(port->read_urb, GFP_KERNEL);
			176
0	0	-	177	if (result)
			178	dev_err(&port->dev, "%s - failed submitting read urb, error %d\n", __FUNCTION__, result);
0	0	-	178	ternary-?: ( & port -> dev ) -> driver
			179
0		-	180	return result;
			181	}
			182
			183
0	0	-	184	static void empeg_close (struct usb_serial_port *port, struct file * filp)
			185	{
			186	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	186	if (debug)
0	0	-	186	do-while (0)
			187
			188	/* shutdown our bulk read */
			189	usb_kill_urb(port->read_urb);
			190	/* Uncomment the following line if you want to see some statistics in your syslog */
			191	/* dev_info (&port->dev, "Bytes In = %d  Bytes Out = %d\n", bytes_in, bytes_out); */
			192	}
			193
			194
0	0	-	195	static int empeg_write (struct usb_serial_port *port, const unsigned char *buf, int count)
			196	{
			197	struct usb_serial *serial = port->serial;
			198	struct urb *urb;
			199	const unsigned char *current_position = buf;
			200	unsigned long flags;
			201	int status;
			202	int i;
			203	int bytes_sent = 0;
			204	int transfer_size;
			205
			206	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	206	if (debug)
0	0	-	206	do-while (0)
			207
0	0	-	208	while (count > 0) {
			209
			210	/* try to find a free urb in our list of them */
			211	urb = NULL;
			212
			213	spin_lock_irqsave (&write_urb_pool_lock, flags);
			213	do
			213	do
0	0	-	213	do-while (0)
0	0	-	213	do-while (0)
			213	do
			213	do
0	0	-	213	do-while (0)
0	0	-	213	do-while (0)
0	0	-	213	do-while (0)
			214
0	0	-	215	for (i = 0; i < NUM_URBS; ++i) {
0	0	-	216	if (write_urb_pool[i]->status != -EINPROGRESS) {
			217	urb = write_urb_pool[i];
0		-	218	break;
			219	}
			220	}
			221
			222	spin_unlock_irqrestore (&write_urb_pool_lock, flags);
			222	do
			222	do
0	0	-	222	do-while (0)
0	0	-	222	do-while (0)
0	0	-	222	do-while (0)
			223
0	0	-	224	if (urb == NULL) {
			225	dbg("%s - no more free urbs", __FUNCTION__);
0	0	-	225	if (debug)
0	0	-	225	do-while (0)
0		-	226	goto exit;
			227	}
			228
0	0	-	229	if (urb->transfer_buffer == NULL) {
			230	urb->transfer_buffer = kmalloc (URB_TRANSFER_BUFFER_SIZE, GFP_ATOMIC);
0	0	-	231	if (urb->transfer_buffer == NULL) {
			232	dev_err(&port->dev, "%s no more kernel memory...\n", __FUNCTION__);
0	0	-	232	ternary-?: ( & port -> dev ) -> driver
0		-	233	goto exit;
			234	}
			235	}
			236
			237	transfer_size = min (count, URB_TRANSFER_BUFFER_SIZE);
			238
			239	memcpy (urb->transfer_buffer, current_position, transfer_size);
			240
			241	usb_serial_debug_data(debug, &port->dev, __FUNCTION__, transfer_size, urb->transfer_buffer);
			242
			243	/* build up our urb */
			244	usb_fill_bulk_urb (
			245	urb,
			246	serial->dev,
			247	usb_sndbulkpipe(serial->dev,
			248	port->bulk_out_endpointAddress),
			249	urb->transfer_buffer,
			250	transfer_size,
			251	empeg_write_bulk_callback,
			252	port);
			253
			254	/* send it down the pipe */
			255	status = usb_submit_urb(urb, GFP_ATOMIC);
0	0	-	256	if (status) {
			257	dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed with status = %d\n", __FUNCTION__, status);
0	0	-	257	ternary-?: ( & port -> dev ) -> driver
			258	bytes_sent = status;
0		-	259	break;
			260	}
			261
			262	current_position += transfer_size;
			263	bytes_sent += transfer_size;
			264	count -= transfer_size;
			265	bytes_out += transfer_size;
			266
			267	}
			268
			269	exit:
0		-	270	return bytes_sent;
			271
			272	}
			273
			274
0	0	-	275	static int empeg_write_room (struct usb_serial_port *port)
			276	{
			277	unsigned long flags;
			278	int i;
			279	int room = 0;
			280
			281	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	281	if (debug)
0	0	-	281	do-while (0)
			282
			283	spin_lock_irqsave (&write_urb_pool_lock, flags);
			283	do
			283	do
0	0	-	283	do-while (0)
0	0	-	283	do-while (0)
			283	do
			283	do
0	0	-	283	do-while (0)
0	0	-	283	do-while (0)
0	0	-	283	do-while (0)
			284
			285	/* tally up the number of bytes available */
0	0	-	286	for (i = 0; i < NUM_URBS; ++i) {
0	0	-	287	if (write_urb_pool[i]->status != -EINPROGRESS) {
			288	room += URB_TRANSFER_BUFFER_SIZE;
			289	}
			290	}
			291
			292	spin_unlock_irqrestore (&write_urb_pool_lock, flags);
			292	do
			292	do
0	0	-	292	do-while (0)
0	0	-	292	do-while (0)
0	0	-	292	do-while (0)
			293
			294	dbg("%s - returns %d", __FUNCTION__, room);
0	0	-	294	if (debug)
0	0	-	294	do-while (0)
			295
0		-	296	return (room);
			297
			298	}
			299
			300
0	0	-	301	static int empeg_chars_in_buffer (struct usb_serial_port *port)
			302	{
			303	unsigned long flags;
			304	int i;
			305	int chars = 0;
			306
			307	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	307	if (debug)
0	0	-	307	do-while (0)
			308
			309	spin_lock_irqsave (&write_urb_pool_lock, flags);
			309	do
			309	do
0	0	-	309	do-while (0)
0	0	-	309	do-while (0)
			309	do
			309	do
0	0	-	309	do-while (0)
0	0	-	309	do-while (0)
0	0	-	309	do-while (0)
			310
			311	/* tally up the number of bytes waiting */
0	0	-	312	for (i = 0; i < NUM_URBS; ++i) {
0	0	-	313	if (write_urb_pool[i]->status == -EINPROGRESS) {
			314	chars += URB_TRANSFER_BUFFER_SIZE;
			315	}
			316	}
			317
			318	spin_unlock_irqrestore (&write_urb_pool_lock, flags);
			318	do
			318	do
0	0	-	318	do-while (0)
0	0	-	318	do-while (0)
0	0	-	318	do-while (0)
			319
			320	dbg("%s - returns %d", __FUNCTION__, chars);
0	0	-	320	if (debug)
0	0	-	320	do-while (0)
			321
0		-	322	return (chars);
			323
			324	}
			325
			326
0	0	-	327	static void empeg_write_bulk_callback (struct urb *urb, struct pt_regs *regs)
			328	{
			329	struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
			330
			331	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	331	if (debug)
0	0	-	331	do-while (0)
			332
0	0	-	333	if (urb->status) {
			334	dbg("%s - nonzero write bulk status received: %d", __FUNCTION__, urb->status);
0	0	-	334	if (debug)
0	0	-	334	do-while (0)
0		-	335	return;
			336	}
			337
			338	schedule_work(&port->work);
			339	}
			340
			341
0	0	-	342	static void empeg_read_bulk_callback (struct urb *urb, struct pt_regs *regs)
			343	{
			344	struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
			345	struct tty_struct *tty;
			346	unsigned char *data = urb->transfer_buffer;
			347	int result;
			348
			349	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	349	if (debug)
0	0	-	349	do-while (0)
			350
0	0	-	351	if (urb->status) {
			352	dbg("%s - nonzero read bulk status received: %d", __FUNCTION__, urb->status);
0	0	-	352	if (debug)
0	0	-	352	do-while (0)
0		-	353	return;
			354	}
			355
			356	usb_serial_debug_data(debug, &port->dev, __FUNCTION__, urb->actual_length, data);
			357
			358	tty = port->tty;
			359
0	0	-	360	if (urb->actual_length) {
			361	tty_buffer_request_room(tty, urb->actual_length);
			362	tty_insert_flip_string(tty, data, urb->actual_length);
			363	tty_flip_buffer_push(tty);
			364	bytes_in += urb->actual_length;
			365	}
			366
			367	/* Continue trying to always read  */
			368	usb_fill_bulk_urb(
			369	port->read_urb,
			370	port->serial->dev,
			371	usb_rcvbulkpipe(port->serial->dev,
			372	port->bulk_in_endpointAddress),
			373	port->read_urb->transfer_buffer,
			374	port->read_urb->transfer_buffer_length,
			375	empeg_read_bulk_callback,
			376	port);
			377
			378	result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
			379
0	0	-	380	if (result)
			381	dev_err(&urb->dev->dev, "%s - failed resubmitting read urb, error %d\n", __FUNCTION__, result);
0	0	-	381	ternary-?: ( & urb -> dev -> dev ) -> driver
			382
0		-	383	return;
			384
			385	}
			386
			387
0	0	-	388	static void empeg_throttle (struct usb_serial_port *port)
			389	{
			390	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	390	if (debug)
0	0	-	390	do-while (0)
			391	usb_kill_urb(port->read_urb);
			392	}
			393
			394
0	0	-	395	static void empeg_unthrottle (struct usb_serial_port *port)
			396	{
			397	int result;
			398
			399	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	399	if (debug)
0	0	-	399	do-while (0)
			400
			401	port->read_urb->dev = port->serial->dev;
			402
			403	result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
			404
0	0	-	405	if (result)
			406	dev_err(&port->dev, "%s - failed submitting read urb, error %d\n", __FUNCTION__, result);
0	0	-	406	ternary-?: ( & port -> dev ) -> driver
			407
0		-	408	return;
			409	}
			410
			411
0	0	-	412	static int  empeg_startup (struct usb_serial *serial)
			413	{
			414	int r;
			415
			416	dbg("%s", __FUNCTION__);
0	0	-	416	if (debug)
0	0	-	416	do-while (0)
			417
0	0	-	418	if (serial->dev->actconfig->desc.bConfigurationValue != 1) {
			419	err("active config #%d != 1 ??",
			420	serial->dev->actconfig->desc.bConfigurationValue);
0		-	421	return -ENODEV;
			422	}
			423	dbg("%s - reset config", __FUNCTION__);
0	0	-	423	if (debug)
0	0	-	423	do-while (0)
			424	r = usb_reset_configuration (serial->dev);
			425
			426	/* continue on with initialization */
0		-	427	return r;
			428
			429	}
			430
			431
0	0	-	432	static void empeg_shutdown (struct usb_serial *serial)
			433	{
			434	dbg ("%s", __FUNCTION__);
0	0	-	434	if (debug)
0	0	-	434	do-while (0)
			435	}
			436
			437
0	0	-	438	static int empeg_ioctl (struct usb_serial_port *port, struct file * file, unsigned int cmd, unsigned long arg)
			439	{
			440	dbg("%s - port %d, cmd 0x%.4x", __FUNCTION__, port->number, cmd);
0	0	-	440	if (debug)
0	0	-	440	do-while (0)
			441
0		-	442	return -ENOIOCTLCMD;
			443	}
			444
			445
0	0	-	446	static void empeg_set_termios (struct usb_serial_port *port, struct termios *old_termios)
			447	{
			448
			449	dbg("%s - port %d", __FUNCTION__, port->number);
0	0	-	449	if (debug)
0	0	-	449	do-while (0)
			450
0	0	-	451	if ((!port->tty) || (!port->tty->termios)) {
0