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

// SPDX-License-Identifier: GPL-2.0-only
/*
 * 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@posteo.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 ret;

	mutex_lock(&fc_usb->data_mutex);
	if (!read)
		memcpy(fc_usb->data, val, sizeof(*val));

	ret = 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,
			fc_usb->data,
			sizeof(u32),
			B2C2_WAIT_FOR_OPERATION_RDW * HZ);

	if (ret != sizeof(u32)) {
		err("error while %s dword from %d (%d).", read ? "reading" :
				"writing", wAddress, wRegOffsPCI);
		if (ret >= 0)
			ret = -EIO;
	}

	if (read && ret >= 0)
		memcpy(val, fc_usb->data, sizeof(*val));
	mutex_unlock(&fc_usb->data_mutex);

	return ret;
}
/*
 * 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, ret;
	wIndex = page << 8;

	if (buflen > sizeof(fc_usb->data)) {
		err("Buffer size bigger than max URB control message\n");
		return -EIO;
	}

	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);

	mutex_lock(&fc_usb->data_mutex);

	if ((request_type & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT)
		memcpy(fc_usb->data, pbBuffer, buflen);

	ret = usb_control_msg(fc_usb->udev, pipe,
			req,
			request_type,
			wAddress,
			wIndex,
			fc_usb->data,
			buflen,
			nWaitTime * HZ);
	if (ret != buflen)
		ret = -EIO;

	if (ret >= 0) {
		ret = 0;
		if ((request_type & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN)
			memcpy(pbBuffer, fc_usb->data, buflen);
	}

	mutex_unlock(&fc_usb->data_mutex);

	debug_dump(pbBuffer, ret, deb_v8);
	return ret;
}

#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);
}

/* 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, ret;
	u8 request_type = USB_TYPE_VENDOR;

	if (buflen > sizeof(fc_usb->data)) {
		err("Buffer size bigger than max URB control message\n");
		return -EIO;
	}

	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);

	mutex_lock(&fc_usb->data_mutex);

	if ((request_type & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT)
		memcpy(fc_usb->data, buf, buflen);

	ret = usb_control_msg(fc_usb->udev, pipe,
			req,
			request_type,
			wValue,
			wIndex,
			fc_usb->data,
			buflen,
			nWaitTime * HZ);

	if (ret != buflen)
		ret = -EIO;

	if (ret >= 0) {
		ret = 0;
		if ((request_type & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN)
			memcpy(buf, fc_usb->data, buflen);
	}

	mutex_unlock(&fc_usb->data_mutex);

	return ret;
}

/* 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)
		usb_free_coherent(fc_usb->udev,
			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 = usb_alloc_coherent(fc_usb->udev,
			bufsize, GFP_KERNEL, &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 */
	int ret = usb_set_interface(fc_usb->udev, 0, 1);

	if (ret) {
		err("set interface failed.");
		return ret;
	}

	if (fc_usb->uintf->cur_altsetting->desc.bNumEndpoints < 1)
		return -ENODEV;

	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;
	mutex_init(&fc_usb->data_mutex);

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