[linux-2.6-block.git] / drivers / media / usb / b2c2 / flexcop-usb.c

/*
 * Linux driver for digital TV devices equipped with B2C2 FlexcopII(b)/III
 * flexcop-usb.c - covers the USB part
 * see flexcop.c for copyright information
 */
#define FC_LOG_PREFIX "flexcop_usb"
#include "flexcop-usb.h"
#include "flexcop-common.h"

/* Version information */
#define DRIVER_VERSION "0.1"
#define DRIVER_NAME "Technisat/B2C2 FlexCop II/IIb/III Digital TV USB Driver"
#define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@desy.de>"

/* debug */
#ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG
#define dprintk(level,args...) \
	do { if ((debug & level)) printk(args); } while (0)

#define debug_dump(b, l, method) do {\
	int i; \
	for (i = 0; i < l; i++) \
		method("%02x ", b[i]); \
	method("\n"); \
} while (0)

#define DEBSTATUS ""
#else
#define dprintk(level, args...)
#define debug_dump(b, l, method)
#define DEBSTATUS " (debugging is not enabled)"
#endif

static int debug;
module_param(debug, int, 0644);
MODULE_PARM_DESC(debug, "set debugging level (1=info,ts=2,"
		"ctrl=4,i2c=8,v8mem=16 (or-able))." DEBSTATUS);
#undef DEBSTATUS

#define deb_info(args...) dprintk(0x01, args)
#define deb_ts(args...) dprintk(0x02, args)
#define deb_ctrl(args...) dprintk(0x04, args)
#define deb_i2c(args...) dprintk(0x08, args)
#define deb_v8(args...) dprintk(0x10, args)

/* JLP 111700: we will include the 1 bit gap between the upper and lower 3 bits
 * in the IBI address, to make the V8 code simpler.
 * PCI ADDRESS FORMAT: 0x71C -> 0000 0111 0001 1100 (the six bits used)
 *                  in general: 0000 0HHH 000L LL00
 * IBI ADDRESS FORMAT:                    RHHH BLLL
 *
 * where R is the read(1)/write(0) bit, B is the busy bit
 * and HHH and LLL are the two sets of three bits from the PCI address.
 */
#define B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(usPCI) (u8) \
	(((usPCI >> 2) & 0x07) + ((usPCI >> 4) & 0x70))
#define B2C2_FLEX_INTERNALADDR_TO_PCIOFFSET(ucAddr) (u16) \
	(((ucAddr & 0x07) << 2) + ((ucAddr & 0x70) << 4))

/*
 * DKT 020228
 * - forget about this VENDOR_BUFFER_SIZE, read and write register
 *   deal with DWORD or 4 bytes, that should be should from now on
 * - from now on, we don't support anything older than firm 1.00
 *   I eliminated the write register as a 2 trip of writing hi word and lo word
 *   and force this to write only 4 bytes at a time.
 *   NOTE: this should work with all the firmware from 1.00 and newer
 */
static int flexcop_usb_readwrite_dw(struct flexcop_device *fc, u16 wRegOffsPCI, u32 *val, u8 read)
{
	struct flexcop_usb *fc_usb = fc->bus_specific;
	u8 request = read ? B2C2_USB_READ_REG : B2C2_USB_WRITE_REG;
	u8 request_type = (read ? USB_DIR_IN : USB_DIR_OUT) | USB_TYPE_VENDOR;
	u8 wAddress = B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(wRegOffsPCI) |
		(read ? 0x80 : 0);

	int len = usb_control_msg(fc_usb->udev,
			read ? B2C2_USB_CTRL_PIPE_IN : B2C2_USB_CTRL_PIPE_OUT,
			request,
			request_type, /* 0xc0 read or 0x40 write */
			wAddress,
			0,
			val,
			sizeof(u32),
			B2C2_WAIT_FOR_OPERATION_RDW * HZ);

	if (len != sizeof(u32)) {
		err("error while %s dword from %d (%d).", read ? "reading" :
				"writing", wAddress, wRegOffsPCI);
		return -EIO;
	}
	return 0;
}
/*
 * DKT 010817 - add support for V8 memory read/write and flash update
 */
static int flexcop_usb_v8_memory_req(struct flexcop_usb *fc_usb,
		flexcop_usb_request_t req, u8 page, u16 wAddress,
		u8 *pbBuffer, u32 buflen)
{
	u8 request_type = USB_TYPE_VENDOR;
	u16 wIndex;
	int nWaitTime, pipe, len;
	wIndex = page << 8;

	switch (req) {
	case B2C2_USB_READ_V8_MEM:
		nWaitTime = B2C2_WAIT_FOR_OPERATION_V8READ;
		request_type |= USB_DIR_IN;
		pipe = B2C2_USB_CTRL_PIPE_IN;
		break;
	case B2C2_USB_WRITE_V8_MEM:
		wIndex |= pbBuffer[0];
		request_type |= USB_DIR_OUT;
		nWaitTime = B2C2_WAIT_FOR_OPERATION_V8WRITE;
		pipe = B2C2_USB_CTRL_PIPE_OUT;
		break;
	case B2C2_USB_FLASH_BLOCK:
		request_type |= USB_DIR_OUT;
		nWaitTime = B2C2_WAIT_FOR_OPERATION_V8FLASH;
		pipe = B2C2_USB_CTRL_PIPE_OUT;
		break;
	default:
		deb_info("unsupported request for v8_mem_req %x.\n", req);
		return -EINVAL;
	}
	deb_v8("v8mem: %02x %02x %04x %04x, len: %d\n", request_type, req,
			wAddress, wIndex, buflen);

	len = usb_control_msg(fc_usb->udev, pipe,
			req,
			request_type,
			wAddress,
			wIndex,
			pbBuffer,
			buflen,
			nWaitTime * HZ);

	debug_dump(pbBuffer, len, deb_v8);
	return len == buflen ? 0 : -EIO;
}

#define bytes_left_to_read_on_page(paddr,buflen) \
	((V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)) > buflen \
	 ? buflen : (V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)))

static int flexcop_usb_memory_req(struct flexcop_usb *fc_usb,
		flexcop_usb_request_t req, flexcop_usb_mem_page_t page_start,
		u32 addr, int extended, u8 *buf, u32 len)
{
	int i,ret = 0;
	u16 wMax;
	u32 pagechunk = 0;

	switch(req) {
	case B2C2_USB_READ_V8_MEM:
		wMax = USB_MEM_READ_MAX;
		break;
	case B2C2_USB_WRITE_V8_MEM:
		wMax = USB_MEM_WRITE_MAX;
		break;
	case B2C2_USB_FLASH_BLOCK:
		wMax = USB_FLASH_MAX;
		break;
	default:
		return -EINVAL;
		break;
	}
	for (i = 0; i < len;) {
		pagechunk =
			wMax < bytes_left_to_read_on_page(addr, len) ?
				wMax :
				bytes_left_to_read_on_page(addr, len);
		deb_info("%x\n",
			(addr & V8_MEMORY_PAGE_MASK) |
				(V8_MEMORY_EXTENDED*extended));

		ret = flexcop_usb_v8_memory_req(fc_usb, req,
			page_start + (addr / V8_MEMORY_PAGE_SIZE),
			(addr & V8_MEMORY_PAGE_MASK) |
				(V8_MEMORY_EXTENDED*extended),
			&buf[i], pagechunk);

		if (ret < 0)
			return ret;
		addr += pagechunk;
		len -= pagechunk;
	}
	return 0;
}

static int flexcop_usb_get_mac_addr(struct flexcop_device *fc, int extended)
{
	return flexcop_usb_memory_req(fc->bus_specific, B2C2_USB_READ_V8_MEM,
		V8_MEMORY_PAGE_FLASH, 0x1f010, 1,
		fc->dvb_adapter.proposed_mac, 6);
}

#if 0
static int flexcop_usb_utility_req(struct flexcop_usb *fc_usb, int set,
		flexcop_usb_utility_function_t func, u8 extra, u16 wIndex,
		u16 buflen, u8 *pvBuffer)
{
	u16 wValue;
	u8 request_type = (set ? USB_DIR_OUT : USB_DIR_IN) | USB_TYPE_VENDOR;
	int nWaitTime = 2,
	    pipe = set ? B2C2_USB_CTRL_PIPE_OUT : B2C2_USB_CTRL_PIPE_IN, len;
	wValue = (func << 8) | extra;

	len = usb_control_msg(fc_usb->udev,pipe,
			B2C2_USB_UTILITY,
			request_type,
			wValue,
			wIndex,
			pvBuffer,
			buflen,
			nWaitTime * HZ);
	return len == buflen ? 0 : -EIO;
}
#endif

/* usb i2c stuff */
static int flexcop_usb_i2c_req(struct flexcop_i2c_adapter *i2c,
		flexcop_usb_request_t req, flexcop_usb_i2c_function_t func,
		u8 chipaddr, u8 addr, u8 *buf, u8 buflen)
{
	struct flexcop_usb *fc_usb = i2c->fc->bus_specific;
	u16 wValue, wIndex;
	int nWaitTime,pipe,len;
	u8 request_type = USB_TYPE_VENDOR;

	switch (func) {
	case USB_FUNC_I2C_WRITE:
	case USB_FUNC_I2C_MULTIWRITE:
	case USB_FUNC_I2C_REPEATWRITE:
		/* DKT 020208 - add this to support special case of DiSEqC */
	case USB_FUNC_I2C_CHECKWRITE:
		pipe = B2C2_USB_CTRL_PIPE_OUT;
		nWaitTime = 2;
		request_type |= USB_DIR_OUT;
		break;
	case USB_FUNC_I2C_READ:
	case USB_FUNC_I2C_REPEATREAD:
		pipe = B2C2_USB_CTRL_PIPE_IN;
		nWaitTime = 2;
		request_type |= USB_DIR_IN;
		break;
	default:
		deb_info("unsupported function for i2c_req %x\n", func);
		return -EINVAL;
	}
	wValue = (func << 8) | (i2c->port << 4);
	wIndex = (chipaddr << 8 ) | addr;

	deb_i2c("i2c %2d: %02x %02x %02x %02x %02x %02x\n",
			func, request_type, req,
			wValue & 0xff, wValue >> 8,
			wIndex & 0xff, wIndex >> 8);

	len = usb_control_msg(fc_usb->udev,pipe,
			req,
			request_type,
			wValue,
			wIndex,
			buf,
			buflen,
			nWaitTime * HZ);
	return len == buflen ? 0 : -EREMOTEIO;
}

/* actual bus specific access functions,
   make sure prototype are/will be equal to pci */
static flexcop_ibi_value flexcop_usb_read_ibi_reg(struct flexcop_device *fc,
	flexcop_ibi_register reg)
{
	flexcop_ibi_value val;
	val.raw = 0;
	flexcop_usb_readwrite_dw(fc, reg, &val.raw, 1);
	return val;
}

static int flexcop_usb_write_ibi_reg(struct flexcop_device *fc,
		flexcop_ibi_register reg, flexcop_ibi_value val)
{
	return flexcop_usb_readwrite_dw(fc, reg, &val.raw, 0);
}

static int flexcop_usb_i2c_request(struct flexcop_i2c_adapter *i2c,
		flexcop_access_op_t op, u8 chipaddr, u8 addr, u8 *buf, u16 len)
{
	if (op == FC_READ)
		return flexcop_usb_i2c_req(i2c, B2C2_USB_I2C_REQUEST,
				USB_FUNC_I2C_READ, chipaddr, addr, buf, len);
	else
		return flexcop_usb_i2c_req(i2c, B2C2_USB_I2C_REQUEST,
				USB_FUNC_I2C_WRITE, chipaddr, addr, buf, len);
}

static void flexcop_usb_process_frame(struct flexcop_usb *fc_usb,
	u8 *buffer, int buffer_length)
{
	u8 *b;
	int l;

	deb_ts("tmp_buffer_length=%d, buffer_length=%d\n",
		fc_usb->tmp_buffer_length, buffer_length);

	if (fc_usb->tmp_buffer_length > 0) {
		memcpy(fc_usb->tmp_buffer+fc_usb->tmp_buffer_length, buffer,
				buffer_length);
		fc_usb->tmp_buffer_length += buffer_length;
		b = fc_usb->tmp_buffer;
		l = fc_usb->tmp_buffer_length;
	} else {
		b=buffer;
		l=buffer_length;
	}

	while (l >= 190) {
		if (*b == 0xff) {
			switch (*(b+1) & 0x03) {
			case 0x01: /* media packet */
				if (*(b+2) == 0x47)
					flexcop_pass_dmx_packets(
							fc_usb->fc_dev, b+2, 1);
				else
					deb_ts("not ts packet %*ph\n", 4, b+2);
				b += 190;
				l -= 190;
				break;
			default:
				deb_ts("wrong packet type\n");
				l = 0;
				break;
			}
		} else {
			deb_ts("wrong header\n");
			l = 0;
		}
	}

	if (l>0)
		memcpy(fc_usb->tmp_buffer, b, l);
	fc_usb->tmp_buffer_length = l;
}

static void flexcop_usb_urb_complete(struct urb *urb)
{
	struct flexcop_usb *fc_usb = urb->context;
	int i;

	if (urb->actual_length > 0)
		deb_ts("urb completed, bufsize: %d actlen; %d\n",
			urb->transfer_buffer_length, urb->actual_length);

	for (i = 0; i < urb->number_of_packets; i++) {
		if (urb->iso_frame_desc[i].status < 0) {
			err("iso frame descriptor %d has an error: %d\n", i,
				urb->iso_frame_desc[i].status);
		} else
			if (urb->iso_frame_desc[i].actual_length > 0) {
				deb_ts("passed %d bytes to the demux\n",
					urb->iso_frame_desc[i].actual_length);

				flexcop_usb_process_frame(fc_usb,
					urb->transfer_buffer +
						urb->iso_frame_desc[i].offset,
					urb->iso_frame_desc[i].actual_length);
			}
		urb->iso_frame_desc[i].status = 0;
		urb->iso_frame_desc[i].actual_length = 0;
	}
	usb_submit_urb(urb,GFP_ATOMIC);
}

static int flexcop_usb_stream_control(struct flexcop_device *fc, int onoff)
{
	/* submit/kill iso packets */
	return 0;
}

static void flexcop_usb_transfer_exit(struct flexcop_usb *fc_usb)
{
	int i;
	for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++)
		if (fc_usb->iso_urb[i] != NULL) {
			deb_ts("unlinking/killing urb no. %d\n",i);
			usb_kill_urb(fc_usb->iso_urb[i]);
			usb_free_urb(fc_usb->iso_urb[i]);
		}

	if (fc_usb->iso_buffer != NULL)
		pci_free_consistent(NULL,
			fc_usb->buffer_size, fc_usb->iso_buffer,
			fc_usb->dma_addr);
}

static int flexcop_usb_transfer_init(struct flexcop_usb *fc_usb)
{
	u16 frame_size = le16_to_cpu(
		fc_usb->uintf->cur_altsetting->endpoint[0].desc.wMaxPacketSize);
	int bufsize = B2C2_USB_NUM_ISO_URB * B2C2_USB_FRAMES_PER_ISO *
		frame_size, i, j, ret;
	int buffer_offset = 0;

	deb_ts("creating %d iso-urbs with %d frames "
			"each of %d bytes size = %d.\n", B2C2_USB_NUM_ISO_URB,
			B2C2_USB_FRAMES_PER_ISO, frame_size, bufsize);

	fc_usb->iso_buffer = pci_alloc_consistent(NULL,
			bufsize, &fc_usb->dma_addr);
	if (fc_usb->iso_buffer == NULL)
		return -ENOMEM;

	memset(fc_usb->iso_buffer, 0, bufsize);
	fc_usb->buffer_size = bufsize;

	/* creating iso urbs */
	for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) {
		fc_usb->iso_urb[i] = usb_alloc_urb(B2C2_USB_FRAMES_PER_ISO,
			GFP_ATOMIC);
		if (fc_usb->iso_urb[i] == NULL) {
			ret = -ENOMEM;
			goto urb_error;
		}
	}

	/* initialising and submitting iso urbs */
	for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) {
		int frame_offset = 0;
		struct urb *urb = fc_usb->iso_urb[i];
		deb_ts("initializing and submitting urb no. %d "
			"(buf_offset: %d).\n", i, buffer_offset);

		urb->dev = fc_usb->udev;
		urb->context = fc_usb;
		urb->complete = flexcop_usb_urb_complete;
		urb->pipe = B2C2_USB_DATA_PIPE;
		urb->transfer_flags = URB_ISO_ASAP;
		urb->interval = 1;
		urb->number_of_packets = B2C2_USB_FRAMES_PER_ISO;
		urb->transfer_buffer_length = frame_size * B2C2_USB_FRAMES_PER_ISO;
		urb->transfer_buffer = fc_usb->iso_buffer + buffer_offset;

		buffer_offset += frame_size * B2C2_USB_FRAMES_PER_ISO;
		for (j = 0; j < B2C2_USB_FRAMES_PER_ISO; j++) {
			deb_ts("urb no: %d, frame: %d, frame_offset: %d\n",
					i, j, frame_offset);
			urb->iso_frame_desc[j].offset = frame_offset;
			urb->iso_frame_desc[j].length = frame_size;
			frame_offset += frame_size;
		}

		if ((ret = usb_submit_urb(fc_usb->iso_urb[i],GFP_ATOMIC))) {
			err("submitting urb %d failed with %d.", i, ret);
			goto urb_error;
		}
		deb_ts("submitted urb no. %d.\n",i);
	}

	/* SRAM */
	flexcop_sram_set_dest(fc_usb->fc_dev, FC_SRAM_DEST_MEDIA |
			FC_SRAM_DEST_NET | FC_SRAM_DEST_CAO | FC_SRAM_DEST_CAI,
			FC_SRAM_DEST_TARGET_WAN_USB);
	flexcop_wan_set_speed(fc_usb->fc_dev, FC_WAN_SPEED_8MBITS);
	flexcop_sram_ctrl(fc_usb->fc_dev, 1, 1, 1);
	return 0;

urb_error:
	flexcop_usb_transfer_exit(fc_usb);
	return ret;
}

static int flexcop_usb_init(struct flexcop_usb *fc_usb)
{
	/* use the alternate setting with the larges buffer */
	usb_set_interface(fc_usb->udev,0,1);
	switch (fc_usb->udev->speed) {
	case USB_SPEED_LOW:
		err("cannot handle USB speed because it is too slow.");
		return -ENODEV;
		break;
	case USB_SPEED_FULL:
		info("running at FULL speed.");
		break;
	case USB_SPEED_HIGH:
		info("running at HIGH speed.");
		break;
	case USB_SPEED_UNKNOWN: /* fall through */
	default:
		err("cannot handle USB speed because it is unknown.");
		return -ENODEV;
	}
	usb_set_intfdata(fc_usb->uintf, fc_usb);
	return 0;
}

static void flexcop_usb_exit(struct flexcop_usb *fc_usb)
{
	usb_set_intfdata(fc_usb->uintf, NULL);
}

static int flexcop_usb_probe(struct usb_interface *intf,
		const struct usb_device_id *id)
{
	struct usb_device *udev = interface_to_usbdev(intf);
	struct flexcop_usb *fc_usb = NULL;
	struct flexcop_device *fc = NULL;
	int ret;

	if ((fc = flexcop_device_kmalloc(sizeof(struct flexcop_usb))) == NULL) {
		err("out of memory\n");
		return -ENOMEM;
	}

	/* general flexcop init */
	fc_usb = fc->bus_specific;
	fc_usb->fc_dev = fc;

	fc->read_ibi_reg  = flexcop_usb_read_ibi_reg;
	fc->write_ibi_reg = flexcop_usb_write_ibi_reg;
	fc->i2c_request = flexcop_usb_i2c_request;
	fc->get_mac_addr = flexcop_usb_get_mac_addr;

	fc->stream_control = flexcop_usb_stream_control;

	fc->pid_filtering = 1;
	fc->bus_type = FC_USB;

	fc->dev = &udev->dev;
	fc->owner = THIS_MODULE;

	/* bus specific part */
	fc_usb->udev = udev;
	fc_usb->uintf = intf;
	if ((ret = flexcop_usb_init(fc_usb)) != 0)
		goto err_kfree;

	/* init flexcop */
	if ((ret = flexcop_device_initialize(fc)) != 0)
		goto err_usb_exit;

	/* xfer init */
	if ((ret = flexcop_usb_transfer_init(fc_usb)) != 0)
		goto err_fc_exit;

	info("%s successfully initialized and connected.", DRIVER_NAME);
	return 0;

err_fc_exit:
	flexcop_device_exit(fc);
err_usb_exit:
	flexcop_usb_exit(fc_usb);
err_kfree:
	flexcop_device_kfree(fc);
	return ret;
}

static void flexcop_usb_disconnect(struct usb_interface *intf)
{
	struct flexcop_usb *fc_usb = usb_get_intfdata(intf);
	flexcop_usb_transfer_exit(fc_usb);
	flexcop_device_exit(fc_usb->fc_dev);
	flexcop_usb_exit(fc_usb);
	flexcop_device_kfree(fc_usb->fc_dev);
	info("%s successfully deinitialized and disconnected.", DRIVER_NAME);
}

static struct usb_device_id flexcop_usb_table [] = {
	{ USB_DEVICE(0x0af7, 0x0101) },
	{ }
};
MODULE_DEVICE_TABLE (usb, flexcop_usb_table);

/* usb specific object needed to register this driver with the usb subsystem */
static struct usb_driver flexcop_usb_driver = {
	.name		= "b2c2_flexcop_usb",
	.probe		= flexcop_usb_probe,
	.disconnect = flexcop_usb_disconnect,
	.id_table	= flexcop_usb_table,
};

module_usb_driver(flexcop_usb_driver);

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_NAME);
MODULE_LICENSE("GPL");
Commit	Line	Data
2add87a9	1	/*
91b94366 UB	2	* Linux driver for digital TV devices equipped with B2C2 FlexcopII(b)/III
	3	* flexcop-usb.c - covers the USB part
	4	* see flexcop.c for copyright information
2add87a9	5	*/
2add87a9 JS	6	#define FC_LOG_PREFIX "flexcop_usb"
	7	#include "flexcop-usb.h"
	8	#include "flexcop-common.h"
	9
	10	/* Version information */
	11	#define DRIVER_VERSION "0.1"
	12	#define DRIVER_NAME "Technisat/B2C2 FlexCop II/IIb/III Digital TV USB Driver"
	13	#define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@desy.de>"
	14
	15	/* debug */
	16	#ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG
	17	#define dprintk(level,args...) \
91b94366 UB	18	do { if ((debug & level)) printk(args); } while (0)
	19
	20	#define debug_dump(b, l, method) do {\
2add87a9	21	int i; \
91b94366 UB	22	for (i = 0; i < l; i++) \
	23	method("%02x ", b[i]); \
	24	method("\n"); \
	25	} while (0)
2add87a9 JS	26
	27	#define DEBSTATUS ""
	28	#else
91b94366 UB	29	#define dprintk(level, args...)
91b94366 UB	30	#define debug_dump(b, l, method)
2add87a9 JS	31	#define DEBSTATUS " (debugging is not enabled)"
	32	#endif
	33
	34	static int debug;
	35	module_param(debug, int, 0644);
91b94366 UB	36	MODULE_PARM_DESC(debug, "set debugging level (1=info,ts=2,"
91b94366 UB	37	"ctrl=4,i2c=8,v8mem=16 (or-able))." DEBSTATUS);
2add87a9 JS	38	#undef DEBSTATUS
2add87a9 JS	39
91b94366 UB	40	#define deb_info(args...) dprintk(0x01, args)
	41	#define deb_ts(args...) dprintk(0x02, args)
	42	#define deb_ctrl(args...) dprintk(0x04, args)
	43	#define deb_i2c(args...) dprintk(0x08, args)
	44	#define deb_v8(args...) dprintk(0x10, args)
2add87a9 JS	45
	46	/* JLP 111700: we will include the 1 bit gap between the upper and lower 3 bits
	47	* in the IBI address, to make the V8 code simpler.
91b94366	48	* PCI ADDRESS FORMAT: 0x71C -> 0000 0111 0001 1100 (the six bits used)
2add87a9 JS	49	* in general: 0000 0HHH 000L LL00
	50	* IBI ADDRESS FORMAT: RHHH BLLL
	51	*
	52	* where R is the read(1)/write(0) bit, B is the busy bit
	53	* and HHH and LLL are the two sets of three bits from the PCI address.
	54	*/
91b94366 UB	55	#define B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(usPCI) (u8) \
	56	(((usPCI >> 2) & 0x07) + ((usPCI >> 4) & 0x70))
	57	#define B2C2_FLEX_INTERNALADDR_TO_PCIOFFSET(ucAddr) (u16) \
	58	(((ucAddr & 0x07) << 2) + ((ucAddr & 0x70) << 4))
2add87a9 JS	59
	60	/*
	61	* DKT 020228
	62	* - forget about this VENDOR_BUFFER_SIZE, read and write register
	63	* deal with DWORD or 4 bytes, that should be should from now on
	64	* - from now on, we don't support anything older than firm 1.00
	65	* I eliminated the write register as a 2 trip of writing hi word and lo word
	66	* and force this to write only 4 bytes at a time.
	67	* NOTE: this should work with all the firmware from 1.00 and newer
	68	*/
	69	static int flexcop_usb_readwrite_dw(struct flexcop_device fc, u16 wRegOffsPCI, u32 val, u8 read)
	70	{
	71	struct flexcop_usb *fc_usb = fc->bus_specific;
	72	u8 request = read ? B2C2_USB_READ_REG : B2C2_USB_WRITE_REG;
	73	u8 request_type = (read ? USB_DIR_IN : USB_DIR_OUT) \| USB_TYPE_VENDOR;
91b94366 UB	74	u8 wAddress = B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(wRegOffsPCI) \|
91b94366 UB	75	(read ? 0x80 : 0);
2add87a9 JS	76
	77	int len = usb_control_msg(fc_usb->udev,
	78	read ? B2C2_USB_CTRL_PIPE_IN : B2C2_USB_CTRL_PIPE_OUT,
	79	request,
91b94366	80	request_type, /* 0xc0 read or 0x40 write */
2add87a9 JS	81	wAddress,
	82	0,
	83	val,
	84	sizeof(u32),
	85	B2C2_WAIT_FOR_OPERATION_RDW * HZ);
	86
	87	if (len != sizeof(u32)) {
91b94366 UB	88	err("error while %s dword from %d (%d).", read ? "reading" :
91b94366 UB	89	"writing", wAddress, wRegOffsPCI);
2add87a9 JS	90	return -EIO;
	91	}
	92	return 0;
	93	}
2add87a9 JS	94	/*
	95	* DKT 010817 - add support for V8 memory read/write and flash update
	96	*/
	97	static int flexcop_usb_v8_memory_req(struct flexcop_usb *fc_usb,
	98	flexcop_usb_request_t req, u8 page, u16 wAddress,
91b94366	99	u8 *pbBuffer, u32 buflen)
2add87a9	100	{
2add87a9 JS	101	u8 request_type = USB_TYPE_VENDOR;
2add87a9 JS	102	u16 wIndex;
91b94366	103	int nWaitTime, pipe, len;
2add87a9 JS	104	wIndex = page << 8;
	105
	106	switch (req) {
91b94366 UB	107	case B2C2_USB_READ_V8_MEM:
	108	nWaitTime = B2C2_WAIT_FOR_OPERATION_V8READ;
	109	request_type \|= USB_DIR_IN;
	110	pipe = B2C2_USB_CTRL_PIPE_IN;
2add87a9	111	break;
91b94366 UB	112	case B2C2_USB_WRITE_V8_MEM:
	113	wIndex \|= pbBuffer[0];
	114	request_type \|= USB_DIR_OUT;
	115	nWaitTime = B2C2_WAIT_FOR_OPERATION_V8WRITE;
	116	pipe = B2C2_USB_CTRL_PIPE_OUT;
2add87a9	117	break;
91b94366 UB	118	case B2C2_USB_FLASH_BLOCK:
	119	request_type \|= USB_DIR_OUT;
	120	nWaitTime = B2C2_WAIT_FOR_OPERATION_V8FLASH;
	121	pipe = B2C2_USB_CTRL_PIPE_OUT;
2add87a9	122	break;
91b94366 UB	123	default:
91b94366 UB	124	deb_info("unsupported request for v8_mem_req %x.\n", req);
2add87a9 JS	125	return -EINVAL;
2add87a9 JS	126	}
91b94366 UB	127	deb_v8("v8mem: %02x %02x %04x %04x, len: %d\n", request_type, req,
91b94366 UB	128	wAddress, wIndex, buflen);
2add87a9	129
91b94366	130	len = usb_control_msg(fc_usb->udev, pipe,
2add87a9 JS	131	req,
	132	request_type,
	133	wAddress,
	134	wIndex,
	135	pbBuffer,
	136	buflen,
	137	nWaitTime * HZ);
	138
91b94366	139	debug_dump(pbBuffer, len, deb_v8);
2add87a9 JS	140	return len == buflen ? 0 : -EIO;
	141	}
	142
	143	#define bytes_left_to_read_on_page(paddr,buflen) \
91b94366 UB	144	((V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)) > buflen \
91b94366 UB	145	? buflen : (V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)))
2add87a9	146
91b94366 UB	147	static int flexcop_usb_memory_req(struct flexcop_usb *fc_usb,
	148	flexcop_usb_request_t req, flexcop_usb_mem_page_t page_start,
	149	u32 addr, int extended, u8 *buf, u32 len)
2add87a9 JS	150	{
	151	int i,ret = 0;
	152	u16 wMax;
	153	u32 pagechunk = 0;
	154
	155	switch(req) {
91b94366 UB	156	case B2C2_USB_READ_V8_MEM:
	157	wMax = USB_MEM_READ_MAX;
	158	break;
	159	case B2C2_USB_WRITE_V8_MEM:
	160	wMax = USB_MEM_WRITE_MAX;
	161	break;
	162	case B2C2_USB_FLASH_BLOCK:
	163	wMax = USB_FLASH_MAX;
	164	break;
	165	default:
	166	return -EINVAL;
2add87a9 JS	167	break;
	168	}
	169	for (i = 0; i < len;) {
91b94366 UB	170	pagechunk =
	171	wMax < bytes_left_to_read_on_page(addr, len) ?
	172	wMax :
	173	bytes_left_to_read_on_page(addr, len);
	174	deb_info("%x\n",
	175	(addr & V8_MEMORY_PAGE_MASK) \|
	176	(V8_MEMORY_EXTENDED*extended));
	177
	178	ret = flexcop_usb_v8_memory_req(fc_usb, req,
	179	page_start + (addr / V8_MEMORY_PAGE_SIZE),
	180	(addr & V8_MEMORY_PAGE_MASK) \|
	181	(V8_MEMORY_EXTENDED*extended),
	182	&buf[i], pagechunk);
	183
	184	if (ret < 0)
2add87a9	185	return ret;
2add87a9 JS	186	addr += pagechunk;
	187	len -= pagechunk;
	188	}
	189	return 0;
	190	}
	191
	192	static int flexcop_usb_get_mac_addr(struct flexcop_device *fc, int extended)
	193	{
91b94366 UB	194	return flexcop_usb_memory_req(fc->bus_specific, B2C2_USB_READ_V8_MEM,
	195	V8_MEMORY_PAGE_FLASH, 0x1f010, 1,
	196	fc->dvb_adapter.proposed_mac, 6);
2add87a9 JS	197	}
	198
	199	#if 0
	200	static int flexcop_usb_utility_req(struct flexcop_usb *fc_usb, int set,
	201	flexcop_usb_utility_function_t func, u8 extra, u16 wIndex,
	202	u16 buflen, u8 *pvBuffer)
	203	{
	204	u16 wValue;
	205	u8 request_type = (set ? USB_DIR_OUT : USB_DIR_IN) \| USB_TYPE_VENDOR;
2add87a9	206	int nWaitTime = 2,
91b94366	207	pipe = set ? B2C2_USB_CTRL_PIPE_OUT : B2C2_USB_CTRL_PIPE_IN, len;
2add87a9 JS	208	wValue = (func << 8) \| extra;
	209
	210	len = usb_control_msg(fc_usb->udev,pipe,
	211	B2C2_USB_UTILITY,
	212	request_type,
	213	wValue,
	214	wIndex,
	215	pvBuffer,
	216	buflen,
	217	nWaitTime * HZ);
	218	return len == buflen ? 0 : -EIO;
	219	}
	220	#endif
	221
	222	/* usb i2c stuff */
6394cf53	223	static int flexcop_usb_i2c_req(struct flexcop_i2c_adapter *i2c,
2add87a9	224	flexcop_usb_request_t req, flexcop_usb_i2c_function_t func,
6394cf53	225	u8 chipaddr, u8 addr, u8 *buf, u8 buflen)
2add87a9	226	{
6394cf53	227	struct flexcop_usb *fc_usb = i2c->fc->bus_specific;
2add87a9 JS	228	u16 wValue, wIndex;
2add87a9 JS	229	int nWaitTime,pipe,len;
2add87a9 JS	230	u8 request_type = USB_TYPE_VENDOR;
	231
	232	switch (func) {
91b94366 UB	233	case USB_FUNC_I2C_WRITE:
	234	case USB_FUNC_I2C_MULTIWRITE:
	235	case USB_FUNC_I2C_REPEATWRITE:
2add87a9	236	/* DKT 020208 - add this to support special case of DiSEqC */
91b94366 UB	237	case USB_FUNC_I2C_CHECKWRITE:
	238	pipe = B2C2_USB_CTRL_PIPE_OUT;
	239	nWaitTime = 2;
	240	request_type \|= USB_DIR_OUT;
2add87a9	241	break;
91b94366 UB	242	case USB_FUNC_I2C_READ:
	243	case USB_FUNC_I2C_REPEATREAD:
	244	pipe = B2C2_USB_CTRL_PIPE_IN;
	245	nWaitTime = 2;
	246	request_type \|= USB_DIR_IN;
2add87a9	247	break;
91b94366 UB	248	default:
	249	deb_info("unsupported function for i2c_req %x\n", func);
	250	return -EINVAL;
2add87a9	251	}
6394cf53	252	wValue = (func << 8) \| (i2c->port << 4);
2add87a9 JS	253	wIndex = (chipaddr << 8 ) \| addr;
2add87a9 JS	254
91b94366 UB	255	deb_i2c("i2c %2d: %02x %02x %02x %02x %02x %02x\n",
	256	func, request_type, req,
	257	wValue & 0xff, wValue >> 8,
	258	wIndex & 0xff, wIndex >> 8);
2add87a9 JS	259
	260	len = usb_control_msg(fc_usb->udev,pipe,
	261	req,
	262	request_type,
	263	wValue,
	264	wIndex,
	265	buf,
	266	buflen,
	267	nWaitTime * HZ);
2add87a9 JS	268	return len == buflen ? 0 : -EREMOTEIO;
	269	}
	270
91b94366 UB	271	/* actual bus specific access functions,
	272	make sure prototype are/will be equal to pci */
	273	static flexcop_ibi_value flexcop_usb_read_ibi_reg(struct flexcop_device *fc,
	274	flexcop_ibi_register reg)
2add87a9 JS	275	{
	276	flexcop_ibi_value val;
	277	val.raw = 0;
91b94366	278	flexcop_usb_readwrite_dw(fc, reg, &val.raw, 1);
2add87a9 JS	279	return val;
	280	}
	281
91b94366 UB	282	static int flexcop_usb_write_ibi_reg(struct flexcop_device *fc,
91b94366 UB	283	flexcop_ibi_register reg, flexcop_ibi_value val)
2add87a9	284	{
91b94366	285	return flexcop_usb_readwrite_dw(fc, reg, &val.raw, 0);
2add87a9 JS	286	}
2add87a9 JS	287
6394cf53	288	static int flexcop_usb_i2c_request(struct flexcop_i2c_adapter *i2c,
91b94366	289	flexcop_access_op_t op, u8 chipaddr, u8 addr, u8 *buf, u16 len)
2add87a9 JS	290	{
2add87a9 JS	291	if (op == FC_READ)
6394cf53	292	return flexcop_usb_i2c_req(i2c, B2C2_USB_I2C_REQUEST,
91b94366	293	USB_FUNC_I2C_READ, chipaddr, addr, buf, len);
2add87a9	294	else
6394cf53	295	return flexcop_usb_i2c_req(i2c, B2C2_USB_I2C_REQUEST,
91b94366	296	USB_FUNC_I2C_WRITE, chipaddr, addr, buf, len);
2add87a9 JS	297	}
2add87a9 JS	298
91b94366 UB	299	static void flexcop_usb_process_frame(struct flexcop_usb *fc_usb,
91b94366 UB	300	u8 *buffer, int buffer_length)
7635acd2 JS	301	{
	302	u8 *b;
	303	int l;
	304
91b94366 UB	305	deb_ts("tmp_buffer_length=%d, buffer_length=%d\n",
91b94366 UB	306	fc_usb->tmp_buffer_length, buffer_length);
7635acd2 JS	307
7635acd2 JS	308	if (fc_usb->tmp_buffer_length > 0) {
91b94366 UB	309	memcpy(fc_usb->tmp_buffer+fc_usb->tmp_buffer_length, buffer,
91b94366 UB	310	buffer_length);
7635acd2 JS	311	fc_usb->tmp_buffer_length += buffer_length;
	312	b = fc_usb->tmp_buffer;
	313	l = fc_usb->tmp_buffer_length;
	314	} else {
	315	b=buffer;
	316	l=buffer_length;
	317	}
	318
	319	while (l >= 190) {
91b94366	320	if (*b == 0xff) {
7635acd2	321	switch (*(b+1) & 0x03) {
91b94366 UB	322	case 0x01: /* media packet */
	323	if (*(b+2) == 0x47)
	324	flexcop_pass_dmx_packets(
	325	fc_usb->fc_dev, b+2, 1);
	326	else
090fdc17	327	deb_ts("not ts packet %*ph\n", 4, b+2);
91b94366 UB	328	b += 190;
91b94366 UB	329	l -= 190;
7635acd2	330	break;
91b94366 UB	331	default:
	332	deb_ts("wrong packet type\n");
	333	l = 0;
7635acd2 JS	334	break;
7635acd2 JS	335	}
91b94366	336	} else {
7635acd2 JS	337	deb_ts("wrong header\n");
	338	l = 0;
	339	}
	340	}
	341
	342	if (l>0)
	343	memcpy(fc_usb->tmp_buffer, b, l);
	344	fc_usb->tmp_buffer_length = l;
	345	}
	346
7d12e780	347	static void flexcop_usb_urb_complete(struct urb *urb)
2add87a9 JS	348	{
	349	struct flexcop_usb *fc_usb = urb->context;
	350	int i;
	351
	352	if (urb->actual_length > 0)
91b94366 UB	353	deb_ts("urb completed, bufsize: %d actlen; %d\n",
91b94366 UB	354	urb->transfer_buffer_length, urb->actual_length);
2add87a9 JS	355
	356	for (i = 0; i < urb->number_of_packets; i++) {
	357	if (urb->iso_frame_desc[i].status < 0) {
91b94366 UB	358	err("iso frame descriptor %d has an error: %d\n", i,
91b94366 UB	359	urb->iso_frame_desc[i].status);
2add87a9 JS	360	} else
2add87a9 JS	361	if (urb->iso_frame_desc[i].actual_length > 0) {
91b94366 UB	362	deb_ts("passed %d bytes to the demux\n",
91b94366 UB	363	urb->iso_frame_desc[i].actual_length);
2add87a9	364
7635acd2	365	flexcop_usb_process_frame(fc_usb,
91b94366 UB	366	urb->transfer_buffer +
91b94366 UB	367	urb->iso_frame_desc[i].offset,
2add87a9	368	urb->iso_frame_desc[i].actual_length);
91b94366	369	}
2add87a9 JS	370	urb->iso_frame_desc[i].status = 0;
	371	urb->iso_frame_desc[i].actual_length = 0;
	372	}
2add87a9 JS	373	usb_submit_urb(urb,GFP_ATOMIC);
	374	}
	375
	376	static int flexcop_usb_stream_control(struct flexcop_device *fc, int onoff)
	377	{
	378	/* submit/kill iso packets */
	379	return 0;
	380	}
	381
	382	static void flexcop_usb_transfer_exit(struct flexcop_usb *fc_usb)
	383	{
	384	int i;
	385	for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++)
	386	if (fc_usb->iso_urb[i] != NULL) {
	387	deb_ts("unlinking/killing urb no. %d\n",i);
	388	usb_kill_urb(fc_usb->iso_urb[i]);
	389	usb_free_urb(fc_usb->iso_urb[i]);
	390	}
	391
	392	if (fc_usb->iso_buffer != NULL)
91b94366 UB	393	pci_free_consistent(NULL,
	394	fc_usb->buffer_size, fc_usb->iso_buffer,
	395	fc_usb->dma_addr);
2add87a9 JS	396	}
	397
	398	static int flexcop_usb_transfer_init(struct flexcop_usb *fc_usb)
	399	{
91b94366 UB	400	u16 frame_size = le16_to_cpu(
	401	fc_usb->uintf->cur_altsetting->endpoint[0].desc.wMaxPacketSize);
	402	int bufsize = B2C2_USB_NUM_ISO_URB * B2C2_USB_FRAMES_PER_ISO *
	403	frame_size, i, j, ret;
2add87a9 JS	404	int buffer_offset = 0;
2add87a9 JS	405
91b94366 UB	406	deb_ts("creating %d iso-urbs with %d frames "
	407	"each of %d bytes size = %d.\n", B2C2_USB_NUM_ISO_URB,
	408	B2C2_USB_FRAMES_PER_ISO, frame_size, bufsize);
2add87a9	409
91b94366 UB	410	fc_usb->iso_buffer = pci_alloc_consistent(NULL,
91b94366 UB	411	bufsize, &fc_usb->dma_addr);
2add87a9 JS	412	if (fc_usb->iso_buffer == NULL)
2add87a9 JS	413	return -ENOMEM;
91b94366	414
2add87a9 JS	415	memset(fc_usb->iso_buffer, 0, bufsize);
	416	fc_usb->buffer_size = bufsize;
	417
	418	/* creating iso urbs */
91b94366 UB	419	for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) {
	420	fc_usb->iso_urb[i] = usb_alloc_urb(B2C2_USB_FRAMES_PER_ISO,
	421	GFP_ATOMIC);
	422	if (fc_usb->iso_urb[i] == NULL) {
2add87a9 JS	423	ret = -ENOMEM;
	424	goto urb_error;
	425	}
91b94366 UB	426	}
91b94366 UB	427
2add87a9 JS	428	/* initialising and submitting iso urbs */
	429	for (i = 0; i < B2C2_USB_NUM_ISO_URB; i++) {
	430	int frame_offset = 0;
	431	struct urb *urb = fc_usb->iso_urb[i];
91b94366 UB	432	deb_ts("initializing and submitting urb no. %d "
91b94366 UB	433	"(buf_offset: %d).\n", i, buffer_offset);
2add87a9 JS	434
	435	urb->dev = fc_usb->udev;
	436	urb->context = fc_usb;
	437	urb->complete = flexcop_usb_urb_complete;
	438	urb->pipe = B2C2_USB_DATA_PIPE;
	439	urb->transfer_flags = URB_ISO_ASAP;
	440	urb->interval = 1;
	441	urb->number_of_packets = B2C2_USB_FRAMES_PER_ISO;
	442	urb->transfer_buffer_length = frame_size * B2C2_USB_FRAMES_PER_ISO;
	443	urb->transfer_buffer = fc_usb->iso_buffer + buffer_offset;
	444
	445	buffer_offset += frame_size * B2C2_USB_FRAMES_PER_ISO;
	446	for (j = 0; j < B2C2_USB_FRAMES_PER_ISO; j++) {
91b94366 UB	447	deb_ts("urb no: %d, frame: %d, frame_offset: %d\n",
91b94366 UB	448	i, j, frame_offset);
2add87a9 JS	449	urb->iso_frame_desc[j].offset = frame_offset;
	450	urb->iso_frame_desc[j].length = frame_size;
	451	frame_offset += frame_size;
	452	}
	453
	454	if ((ret = usb_submit_urb(fc_usb->iso_urb[i],GFP_ATOMIC))) {
91b94366	455	err("submitting urb %d failed with %d.", i, ret);
2add87a9 JS	456	goto urb_error;
	457	}
	458	deb_ts("submitted urb no. %d.\n",i);
	459	}
	460
91b94366 UB	461	/* SRAM */
	462	flexcop_sram_set_dest(fc_usb->fc_dev, FC_SRAM_DEST_MEDIA \|
	463	FC_SRAM_DEST_NET \| FC_SRAM_DEST_CAO \| FC_SRAM_DEST_CAI,
	464	FC_SRAM_DEST_TARGET_WAN_USB);
	465	flexcop_wan_set_speed(fc_usb->fc_dev, FC_WAN_SPEED_8MBITS);
	466	flexcop_sram_ctrl(fc_usb->fc_dev, 1, 1, 1);
8397703e TP	467	return 0;
8397703e TP	468
2add87a9 JS	469	urb_error:
2add87a9 JS	470	flexcop_usb_transfer_exit(fc_usb);
2add87a9 JS	471	return ret;
	472	}
	473
	474	static int flexcop_usb_init(struct flexcop_usb *fc_usb)
	475	{
	476	/* use the alternate setting with the larges buffer */
	477	usb_set_interface(fc_usb->udev,0,1);
	478	switch (fc_usb->udev->speed) {
91b94366 UB	479	case USB_SPEED_LOW:
	480	err("cannot handle USB speed because it is too slow.");
	481	return -ENODEV;
	482	break;
	483	case USB_SPEED_FULL:
	484	info("running at FULL speed.");
	485	break;
	486	case USB_SPEED_HIGH:
	487	info("running at HIGH speed.");
	488	break;
	489	case USB_SPEED_UNKNOWN: /* fall through */
	490	default:
	491	err("cannot handle USB speed because it is unknown.");
	492	return -ENODEV;
2add87a9 JS	493	}
	494	usb_set_intfdata(fc_usb->uintf, fc_usb);
	495	return 0;
	496	}
	497
	498	static void flexcop_usb_exit(struct flexcop_usb *fc_usb)
	499	{
	500	usb_set_intfdata(fc_usb->uintf, NULL);
	501	}
	502
	503	static int flexcop_usb_probe(struct usb_interface *intf,
	504	const struct usb_device_id *id)
	505	{
	506	struct usb_device *udev = interface_to_usbdev(intf);
	507	struct flexcop_usb *fc_usb = NULL;
	508	struct flexcop_device *fc = NULL;
	509	int ret;
	510
	511	if ((fc = flexcop_device_kmalloc(sizeof(struct flexcop_usb))) == NULL) {
	512	err("out of memory\n");
	513	return -ENOMEM;
	514	}
	515
91b94366	516	/* general flexcop init */
2add87a9 JS	517	fc_usb = fc->bus_specific;
	518	fc_usb->fc_dev = fc;
	519
	520	fc->read_ibi_reg = flexcop_usb_read_ibi_reg;
	521	fc->write_ibi_reg = flexcop_usb_write_ibi_reg;
	522	fc->i2c_request = flexcop_usb_i2c_request;
	523	fc->get_mac_addr = flexcop_usb_get_mac_addr;
	524
	525	fc->stream_control = flexcop_usb_stream_control;
	526
	527	fc->pid_filtering = 1;
	528	fc->bus_type = FC_USB;
	529
	530	fc->dev = &udev->dev;
59a7ad6c	531	fc->owner = THIS_MODULE;
2add87a9	532
91b94366	533	/* bus specific part */
2add87a9 JS	534	fc_usb->udev = udev;
	535	fc_usb->uintf = intf;
	536	if ((ret = flexcop_usb_init(fc_usb)) != 0)
	537	goto err_kfree;
	538
91b94366	539	/* init flexcop */
2add87a9 JS	540	if ((ret = flexcop_device_initialize(fc)) != 0)
	541	goto err_usb_exit;
	542
91b94366	543	/* xfer init */
2add87a9 JS	544	if ((ret = flexcop_usb_transfer_init(fc_usb)) != 0)
	545	goto err_fc_exit;
	546
91b94366	547	info("%s successfully initialized and connected.", DRIVER_NAME);
8397703e TP	548	return 0;
8397703e TP	549
2add87a9 JS	550	err_fc_exit:
	551	flexcop_device_exit(fc);
	552	err_usb_exit:
	553	flexcop_usb_exit(fc_usb);
	554	err_kfree:
	555	flexcop_device_kfree(fc);
2add87a9 JS	556	return ret;
	557	}
	558
	559	static void flexcop_usb_disconnect(struct usb_interface *intf)
	560	{
	561	struct flexcop_usb *fc_usb = usb_get_intfdata(intf);
	562	flexcop_usb_transfer_exit(fc_usb);
	563	flexcop_device_exit(fc_usb->fc_dev);
	564	flexcop_usb_exit(fc_usb);
	565	flexcop_device_kfree(fc_usb->fc_dev);
91b94366	566	info("%s successfully deinitialized and disconnected.", DRIVER_NAME);
2add87a9 JS	567	}
	568
	569	static struct usb_device_id flexcop_usb_table [] = {
91b94366 UB	570	{ USB_DEVICE(0x0af7, 0x0101) },
91b94366 UB	571	{ }
2add87a9	572	};
6637e6fd	573	MODULE_DEVICE_TABLE (usb, flexcop_usb_table);
2add87a9 JS	574
	575	/* usb specific object needed to register this driver with the usb subsystem */
	576	static struct usb_driver flexcop_usb_driver = {
63b5c1c4	577	.name = "b2c2_flexcop_usb",
2add87a9 JS	578	.probe = flexcop_usb_probe,
	579	.disconnect = flexcop_usb_disconnect,
	580	.id_table = flexcop_usb_table,
	581	};
	582
ecb3b2b3	583	module_usb_driver(flexcop_usb_driver);
2add87a9 JS	584
	585	MODULE_AUTHOR(DRIVER_AUTHOR);
	586	MODULE_DESCRIPTION(DRIVER_NAME);
	587	MODULE_LICENSE("GPL");