added a driver for TerraTec's brand new Cinergy T² device

3 files changed, 907 insertions, 0 deletions

diff --git a/linux/drivers/media/dvb/cinergyT2/Kconfig b/linux/drivers/media/dvb/cinergyT2/Kconfig
new file mode 100644
index 000000000..cd5f3a16d
--- /dev/null
+++ b/linux/drivers/media/dvb/cinergyT2/Kconfig
@@ -0,0 +1,59 @@
+config DVB_CINERGYT2
+	tristate "Terratec CinergyT2/qanu USB2 DVB-T receiver"
+	depends on DVB_CORE && USB
+	help
+	  Support for "TerraTec CinergyT2" USB2.0 Highspeed DVB Receivers
+
+	  Say Y if you own such a device and want to use it.
+
+
+config DVB_CINERGYT2_TUNING
+	bool "sophisticated fine-tuning for CinergyT2 cards"
+	depends on DVB_CINERGYT2
+	help
+	  Here you can fine-tune some parameters of the CinergyT2 driver.
+
+	  Normally you don't need to touch this, but in exotic setups you
+	  may fine-tune your setup and adjust e.g. DMA buffer sizes for
+	  a particular application.
+
+
+config DVB_CINERGYT2_STREAM_URB_COUNT
+	int "Number of queued USB Request Blocks for Highspeed Stream Transfers"
+	depends on DVB_CINERGYT2_TUNING
+        default "16"
+	help
+	  USB Request Blocks for Highspeed Stream transfers are queued in a
+	  for the Host Controller. Usually the default value is a safe choice.
+
+	  You may increase this number if you are using this device in a 
+	  Server Environment with many high-traffic USB Highspeed devices 
+	  sharing the same USB bus.
+
+
+config DVB_CINERGYT2_STREAM_BUF_SIZE
+	int "Size of URB Stream Buffers for Highspeed Transfers"
+	depends on DVB_CINERGYT2_TUNING
+        default "512"
+	help
+	  Should be a multiple of native buffer size of 512 bytes.
+	  Default value is a safe choice.
+
+	  You may increase this number if you are using this device in a 
+	  Server Environment with many high-traffic USB Highspeed devices 
+	  sharing the same USB bus.
+
+
+config DVB_CINERGYT2_ENABLE_RC_INPUT_DEVICE
+	bool "Register the onboard IR Remote Control Receiver as Input Device"
+	depends on DVB_CINERGYT2_TUNING
+        default "yes"
+	help
+	  Enable this option if you want to use the onboard Infrared Remote 
+	  Control Receiver as Linux-Input device.
+
+	  Right now only the keycode table for the default Remote Control
+	  delivered with the device is supported, please see the driver
+	  source code to find out how to add support for other controls.
+
+
diff --git a/linux/drivers/media/dvb/cinergyT2/Makefile b/linux/drivers/media/dvb/cinergyT2/Makefile
new file mode 100644
index 000000000..c51aece20
--- /dev/null
+++ b/linux/drivers/media/dvb/cinergyT2/Makefile
@@ -0,0 +1,3 @@
+obj-$(CONFIG_DVB_CINERGYT2) += cinergyT2.o
+
+EXTRA_CFLAGS = -Idrivers/media/dvb/dvb-core/
diff --git a/linux/drivers/media/dvb/cinergyT2/cinergyT2.c b/linux/drivers/media/dvb/cinergyT2/cinergyT2.c
new file mode 100644
index 000000000..f4cb859c4
--- /dev/null
+++ b/linux/drivers/media/dvb/cinergyT2/cinergyT2.c
@@ -0,0 +1,845 @@
+/*
+ * TerraTec Cinergy T²/qanu USB2 DVB-T adapter.
+ *
+ * Copyright (C) 2004 Daniel Mack <daniel@qanu.de> and
+ *		    Holger Waechtler <holger@qanu.de>
+ *
+ *  Protocol Spec published on http://qanu.de/specs/terratec_cinergyT2.pdf
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ */
+
+#include <linux/config.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/usb.h>
+#include <linux/pci.h>
+#include <linux/input.h>
+
+#include "dmxdev.h"
+#include "dvb_demux.h"
+#include "dvb_net.h"
+#include "dvb_frontend.h"
+
+
+#ifdef CONFIG_DVB_CINERGYT2_TUNING
+	#define STREAM_URB_COUNT (CONFIG_DVB_CINERGYT2_STREAM_URB_COUNT)
+	#define STREAM_BUF_SIZE (CONFIG_DVB_CINERGYT2_STREAM_BUF_SIZE)
+	#ifdef CONFIG_DVB_CINERGYT2_ENABLE_RC_INPUT_DEVICE
+		#define ENABLE_RC (1)
+	#endif
+#else
+	#define STREAM_URB_COUNT (8)
+	#define STREAM_BUF_SIZE (512)
+	#define ENABLE_RC (1)
+#endif
+
+
+#define DRIVER_NAME "TerraTec/qanu USB2.0 Highspeed DVB-T Receiver"
+
+
+enum cinergyt2_ep1_cmd {
+	CINERGYT2_EP1_PID_TABLE_RESET		= 0x01,
+	CINERGYT2_EP1_PID_SETUP			= 0x02,
+	CINERGYT2_EP1_CONTROL_STREAM_TRANSFER 	= 0x03,
+	CINERGYT2_EP1_SET_TUNER_PARAMETERS 	= 0x04,
+	CINERGYT2_EP1_GET_TUNER_STATUS		= 0x05,
+	CINERGYT2_EP1_START_SCAN		= 0x06,
+	CINERGYT2_EP1_CONTINUE_SCAN		= 0x07,
+	CINERGYT2_EP1_GET_RC_EVENTS		= 0x08,
+	CINERGYT2_EP1_SLEEP_MODE		= 0x09
+};
+
+
+static
+struct dvb_frontend_info cinergyt2_fe_info = {
+	.name = DRIVER_NAME,
+	.type = FE_OFDM,
+	.frequency_min = 174000000,
+	.frequency_max = 862000000,
+	.frequency_stepsize = 166667,
+	.notifier_delay = 0,
+	.caps = FE_CAN_INVERSION_AUTO | FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 |
+		FE_CAN_FEC_3_4 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 |
+		FE_CAN_FEC_AUTO |
+		FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
+		FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_GUARD_INTERVAL_AUTO |
+		FE_CAN_HIERARCHY_AUTO | FE_CAN_RECOVER | FE_CAN_MUTE_TS
+};
+
+
+struct cinergyt2 {
+	struct dvb_demux demux;
+	struct usb_device *udev;
+	struct semaphore sem;
+	struct dvb_adapter *adapter;
+	struct dmxdev dmxdev;
+	struct dvb_net dvbnet;
+
+	int streaming;
+
+	void *streambuf;
+	dma_addr_t streambuf_dmahandle;
+	struct urb *stream_urb [STREAM_URB_COUNT];
+#ifdef ENABLE_RC
+	struct input_dev rc_input_dev;
+	struct work_struct rc_query_work;
+	int rc_input_event;
+#endif
+};
+
+
+enum {
+	CINERGYT2_RC_EVENT_TYPE_NONE = 0x00,
+	CINERGYT2_RC_EVENT_TYPE_NEC  = 0x01,
+	CINERGYT2_RC_EVENT_TYPE_RC5  = 0x02
+};
+
+
+struct cinergyt2_rc_event {
+	char type;
+	uint32_t value;
+} __attribute__((packed));
+
+
+static const
+uint32_t rc_keys [] = {
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xfe01eb04,	KEY_POWER,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xfd02eb04,	KEY_1,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xfc03eb04,	KEY_2,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xfb04eb04,	KEY_3,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xfa05eb04,	KEY_4,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf906eb04,	KEY_5,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf807eb04,	KEY_6,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf708eb04,	KEY_7,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf609eb04,	KEY_8,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf50aeb04,	KEY_9,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf30ceb04,	KEY_0,
+	CINERGYT2_RC_EVENT_TYPE_NEC,	0xf40beb04,	KEY_VIDEO,
+	CINERGYT2_RC_EVENT_TYPE_NEC,	0xf20deb04,	KEY_REFRESH,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf10eeb04,	KEY_SELECT,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xf00feb04,	KEY_EPG,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xef10eb04,	KEY_UP,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xeb14eb04,	KEY_DOWN,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xee11eb04,	KEY_LEFT,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xec13eb04,	KEY_RIGHT,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xed12eb04,	KEY_OK,	
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xea15eb04,	KEY_TEXT,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe916eb04,	KEY_INFO,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe817eb04,	KEY_RED,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe718eb04,	KEY_GREEN,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe619eb04,	KEY_YELLOW,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe51aeb04,	KEY_BLUE,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe31ceb04,	KEY_VOLUMEUP,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe11eeb04,	KEY_VOLUMEDOWN,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe21deb04,	KEY_MUTE,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe41beb04,	KEY_CHANNELUP,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xe01feb04,	KEY_CHANNELDOWN,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xbf40eb04,	KEY_PAUSE,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xb34ceb04,	KEY_PLAY,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xa758eb04,	KEY_RECORD,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xab54eb04,	KEY_PREVIOUS,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xb748eb04,	KEY_STOP,
+	CINERGYT2_RC_EVENT_TYPE_NEC, 	0xa35ceb04,	KEY_NEXT
+};
+
+
+static void cinergyt2_stream_irq (struct urb *urb, struct pt_regs *regs);
+
+
+static
+int cinergyt2_submit_stream_urb (struct cinergyt2 *cinergyt2, struct urb *urb)
+{
+	int err;
+
+	usb_fill_bulk_urb(urb,
+			  cinergyt2->udev,
+			  usb_rcvbulkpipe(cinergyt2->udev, 0x2),
+			  urb->transfer_buffer,
+			  STREAM_BUF_SIZE,
+			  cinergyt2_stream_irq,
+			  cinergyt2);
+
+	if ((err = usb_submit_urb(urb, GFP_ATOMIC)))
+		printk("%s: urb submission failed (err = %i)!\n",
+		       __FUNCTION__, err);
+
+	return err;
+}
+
+
+static
+void cinergyt2_stream_irq (struct urb *urb, struct pt_regs *regs)
+{
+	struct cinergyt2 *cinergyt2 = urb->context;
+
+	if (urb->actual_length > 0)
+		dvb_dmx_swfilter(&cinergyt2->demux,
+				 urb->transfer_buffer, urb->actual_length);
+
+	if (cinergyt2->streaming)
+		cinergyt2_submit_stream_urb(cinergyt2, urb);
+}
+
+
+static
+void cinergyt2_free_stream_urbs (struct cinergyt2 *cinergyt2)
+{
+	int i;
+
+	for (i=0; i<STREAM_URB_COUNT; i++)
+		if (cinergyt2->stream_urb[i])
+			usb_free_urb(cinergyt2->stream_urb[i]);
+
+	pci_free_consistent(NULL, STREAM_URB_COUNT*STREAM_BUF_SIZE,
+			    cinergyt2->streambuf, cinergyt2->streambuf_dmahandle);
+}
+
+
+static
+int cinergyt2_alloc_stream_urbs (struct cinergyt2 *cinergyt2)
+{
+	int i;
+
+	cinergyt2->streambuf = pci_alloc_consistent(NULL, 
+					      STREAM_URB_COUNT*STREAM_BUF_SIZE,
+					      &cinergyt2->streambuf_dmahandle);
+	if (!cinergyt2->streambuf) {
+		printk("%s: failed to alloc consistent stream memory area, "
+		       "bailing out!\n", __FUNCTION__);
+		return -ENOMEM;
+	}
+
+	memset(cinergyt2->streambuf, 0, STREAM_URB_COUNT*STREAM_BUF_SIZE);
+
+	for (i=0; i<STREAM_URB_COUNT; i++) {
+		struct urb *urb;	
+
+		if (!(urb = usb_alloc_urb(0, GFP_ATOMIC))) {
+			printk("%s: failed to alloc consistent stream urbs, "
+			       "bailing out!\n", __FUNCTION__);
+			cinergyt2_free_stream_urbs(cinergyt2);
+			return -ENOMEM;
+		}
+
+		urb->transfer_buffer = cinergyt2->streambuf + i * STREAM_BUF_SIZE;
+		urb->transfer_buffer_length = STREAM_BUF_SIZE;
+
+		cinergyt2->stream_urb[i] = urb;
+	}
+
+	return 0;
+}
+
+
+static
+void cinergyt2_stop_stream_xfer (struct cinergyt2 *cinergyt2)
+{
+	int i;
+
+	for (i=0; i<STREAM_URB_COUNT; i++)
+		if (cinergyt2->stream_urb[i])
+			usb_unlink_urb(cinergyt2->stream_urb[i]);
+}
+
+
+static
+int cinergyt2_start_stream_xfer (struct cinergyt2 *cinergyt2)
+{
+	int i, err;
+
+	for (i=0; i<STREAM_URB_COUNT; i++) {
+		if ((err = cinergyt2_submit_stream_urb(cinergyt2, cinergyt2->stream_urb[i]))) {
+			cinergyt2_stop_stream_xfer(cinergyt2);
+			printk("%s: failed urb submission (%i: err = %i)!\n",
+			       __FUNCTION__, i, err);
+			return err;
+		}
+	}
+
+	return 0;
+}
+
+
+static
+int cinergyt2_command (struct cinergyt2 *cinergyt2,
+		    char *send_buf, int send_buf_len,
+		    char *rec_buf, int rec_buf_len)
+{
+	int ret;
+	int actual_len;
+	char dummy;
+
+	if (down_interruptible(&cinergyt2->sem)) {
+		printk (KERN_WARNING "============> EBUSY!\n");
+		return -EBUSY;}
+
+	ret = usb_bulk_msg(cinergyt2->udev, usb_sndbulkpipe(cinergyt2->udev, 1),
+			   send_buf, send_buf_len, &actual_len, HZ);
+
+	if (ret)
+		printk("%s: usb_bulk_msg (send) failed, err %i\n",
+				__FUNCTION__, ret);
+	
+	if (!rec_buf)
+		rec_buf = &dummy;
+	
+	ret = usb_bulk_msg(cinergyt2->udev, usb_rcvbulkpipe(cinergyt2->udev, 1),
+			   rec_buf, rec_buf_len, &actual_len, HZ);
+
+	if (ret)
+		printk("%s: usb_bulk_msg (read) failed, err %i\n",
+				__FUNCTION__, ret);
+
+	up(&cinergyt2->sem);
+
+	return ret ? ret : actual_len;
+}
+
+
+static
+void cinergyt2_control_stream_transfer (struct cinergyt2 *cinergyt2, int enable)
+{
+	char buf [] = { CINERGYT2_EP1_CONTROL_STREAM_TRANSFER, enable ? 1 : 0 };
+  	cinergyt2_command(cinergyt2, buf, sizeof(buf), NULL, 0);
+}
+
+
+static
+void cinergyt2_control_sleep_mode (struct cinergyt2 *cinergyt2, int sleep)
+{
+	char buf [] = { CINERGYT2_EP1_SLEEP_MODE, sleep ? 1 : 0 };
+  	cinergyt2_command(cinergyt2, buf, sizeof(buf), NULL, 0);
+}
+
+
+static
+int cinergyt2_start_feed(struct dvb_demux_feed *dvbdmxfeed)
+{
+	struct dvb_demux *demux = dvbdmxfeed->demux;
+	struct cinergyt2 *cinergyt2 = demux->priv;
+
+	
+	if (cinergyt2->streaming == 0) {
+		cinergyt2_control_sleep_mode(cinergyt2, 1);
+	       	if (cinergyt2_start_stream_xfer (cinergyt2) == 0)
+		       cinergyt2_control_stream_transfer (cinergyt2, 1);
+	}
+
+	cinergyt2->streaming++;
+
+	return 0;
+}
+
+
+static
+int cinergyt2_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
+{
+	struct dvb_demux *demux = dvbdmxfeed->demux;
+	struct cinergyt2 *cinergyt2 = demux->priv;	
+
+	if (--cinergyt2->streaming == 0) {
+		cinergyt2_control_stream_transfer(cinergyt2, 0);
+		cinergyt2_stop_stream_xfer(cinergyt2);
+		cinergyt2_control_sleep_mode(cinergyt2, 0);
+	}
+
+	return 0;
+}
+
+
+/**
+ *  convert linux-dvb frontend parameter set into TPS.
+ *  See ETSI ETS-300744, section 4.6.2, table 9 for details.
+ *
+ *  This function is probably reusable and may better get placed in a support
+ *  library.
+ *
+ *  We replace errornous fields by default TPS fields (the ones with value 0).
+ */
+
+static
+uint16_t compute_tps (struct dvb_frontend_parameters *param)
+{
+	uint16_t tps = 0;
+	struct dvb_ofdm_parameters *op = &param->u.ofdm;
+
+	switch (op->code_rate_HP) {
+		case FEC_2_3:
+			tps |= (1 << 9);
+			break;
+		case FEC_3_4:
+			tps |= (2 << 9);
+			break;
+		case FEC_5_6:
+			tps |= (3 << 9);
+			break;
+		case FEC_7_8:
+			tps |= (4 << 9);
+			break;
+		case FEC_1_2:
+		case FEC_AUTO:
+		default:
+			/* tps |= (0 << 9) */;
+	}
+
+	switch (op->code_rate_LP) {
+		case FEC_2_3:
+			tps |= (1 << 6);
+			break;
+		case FEC_3_4:
+			tps |= (2 << 6);
+			break;
+		case FEC_5_6:
+			tps |= (3 << 6);
+			break;
+		case FEC_7_8:
+			tps |= (4 << 6);
+			break;
+		case FEC_1_2:
+		case FEC_AUTO:
+		default:
+			/* tps |= (0 << 6) */;
+	}
+
+	switch (op->constellation) {
+		case QAM_16:
+			tps |= (1 << 14);
+			break;
+		case QAM_64:
+			tps |= (2 << 14);
+			break;
+		case QPSK:
+		default:
+			/* tps |= (0 << 14) */;
+	}
+
+	switch (op->transmission_mode) {
+		case TRANSMISSION_MODE_8K:
+			tps |= (1 << 1);
+			break;
+		case TRANSMISSION_MODE_2K:
+		default:
+			/* tps |= (0 << 1) */;
+	}
+
+	switch (op->guard_interval) {
+		case GUARD_INTERVAL_1_16:
+			tps |= (1 << 3);
+			break;
+		case GUARD_INTERVAL_1_8:
+			tps |= (2 << 3);
+			break;
+		case GUARD_INTERVAL_1_4:
+			tps |= (3 << 3);
+			break;
+		case GUARD_INTERVAL_1_32:
+		default:
+			/* tps |= (0 << 3) */;
+	}
+
+	switch (op->hierarchy_information) {
+		case HIERARCHY_1:
+			tps |= (1 << 12);
+			break;
+		case HIERARCHY_2:
+			tps |= (2 << 12);
+			break;
+		case HIERARCHY_4:
+			tps |= (3 << 12);
+			break;
+		case HIERARCHY_NONE:
+		default:
+			/* tps |= (0 << 12) */;
+	}
+
+	return tps;
+}
+
+
+struct dvbt_set_parameters_msg {
+	uint8_t cmd;
+	uint32_t freq;
+	uint8_t bandwidth;
+	uint16_t tps;
+	uint8_t flags;
+} __attribute__((packed));
+
+
+struct dvbt_get_parameters_msg {
+	uint32_t freq;
+	uint8_t bandwidth;
+	uint16_t tps;
+	uint8_t flags;
+	uint16_t gain;
+	uint8_t snr;
+	uint32_t viterbi_error_rate;
+	uint32_t rs_error_rate;
+	uint32_t uncorrected_block_count;
+	uint8_t lock_bits;
+	uint8_t prev_lock_bits;
+} __attribute__((packed));
+
+
+static
+int cinergyt2_fe_ioctl (struct dvb_frontend *fe, unsigned int ioctl_cmd, void *arg)
+{
+	struct cinergyt2 *cinergyt2 = fe->data;
+	int ret = 0;
+
+	if (!cinergyt2->streaming)
+		cinergyt2_control_sleep_mode(cinergyt2, 0);
+	
+	switch (ioctl_cmd) {
+	case FE_GET_INFO:
+		memcpy (arg, &cinergyt2_fe_info, sizeof(struct dvb_frontend_info));
+		break;
+
+	case FE_READ_STATUS:
+	{
+		struct dvbt_get_parameters_msg msg;
+		char cmd = CINERGYT2_EP1_GET_TUNER_STATUS;
+		fe_status_t *status = arg;
+
+		*status = 0;
+
+		cinergyt2_command(cinergyt2, &cmd, 1, (char *) &msg, sizeof(msg));
+		
+		if (msg.lock_bits & (1 << 6))
+			*status |= FE_HAS_LOCK;
+		if (msg.lock_bits & (1 << 5))
+			*status |= FE_HAS_SYNC;
+		if (msg.lock_bits & (1 << 4))
+			*status |= FE_HAS_CARRIER;
+		if (msg.lock_bits & (1 << 1))
+			*status |= FE_HAS_VITERBI;
+
+		break;
+	}
+
+	case FE_READ_BER:
+	{
+		struct dvbt_get_parameters_msg msg;
+		char cmd = CINERGYT2_EP1_GET_TUNER_STATUS;
+		u32 *ber = (u32 *) arg;
+
+		cinergyt2_command(cinergyt2, &cmd, 1, (char *) &msg, sizeof(msg));
+
+		*ber = le32_to_cpu(msg.viterbi_error_rate);
+
+		break;
+	}
+
+	case FE_READ_SIGNAL_STRENGTH:
+	{
+		struct dvbt_get_parameters_msg msg;
+		char cmd = CINERGYT2_EP1_GET_TUNER_STATUS;
+		u16 *signal = (u16 *) arg;
+
+		cinergyt2_command(cinergyt2, &cmd, 1, (char *) &msg, sizeof(msg));
+
+		*signal = ~(le16_to_cpu(msg.gain));
+
+		break;
+	}
+
+	case FE_READ_SNR:
+	{
+		struct dvbt_get_parameters_msg msg;
+		char cmd = CINERGYT2_EP1_GET_TUNER_STATUS;
+		u16 *snr = (u16 *) arg;
+
+		cinergyt2_command(cinergyt2, &cmd, 1, (char *) &msg, sizeof(msg));
+
+		*snr = (msg.snr << 8) | msg.snr;
+
+		break;
+	}
+
+	case FE_READ_UNCORRECTED_BLOCKS:
+	{
+		struct dvbt_get_parameters_msg msg;
+		char cmd = CINERGYT2_EP1_GET_TUNER_STATUS;
+		u32 *ubc = (u32 *) arg;
+
+		cinergyt2_command(cinergyt2, &cmd, 1, (char *) &msg, sizeof(msg));
+
+		*ubc = le32_to_cpu(msg.uncorrected_block_count);
+
+		break;
+	}
+	
+	case FE_SET_FRONTEND:
+	{
+		struct dvb_frontend_parameters *p = (void*) arg;
+		struct dvb_ofdm_parameters *op = &p->u.ofdm;
+		struct dvbt_set_parameters_msg msg;
+
+		msg.cmd = CINERGYT2_EP1_SET_TUNER_PARAMETERS;
+		msg.tps = cpu_to_le16(compute_tps(p));
+		msg.freq = cpu_to_le32(p->frequency / 1000);
+		msg.bandwidth = 8 - op->bandwidth - BANDWIDTH_8_MHZ;
+
+		cinergyt2_command(cinergyt2, (char *) &msg, sizeof(msg), NULL, 0);
+
+		break;
+	}
+
+	case FE_GET_FRONTEND:
+		/**
+		 *  trivial to implement (see struct dvbt_get_parameters_msg).
+		 *  equivalent to FE_READ ioctls, but needs 
+		 *  TPS -> linux-dvb parameter set conversion. Feel free
+		 *  to implement this and send us a patch if you need this
+		 *  functionality.
+		 */
+		break;
+
+	case FE_INIT:
+	case FE_SLEEP:
+		/* no need to do anything */
+		break;
+
+	default:
+		ret = -EOPNOTSUPP;
+		break;
+	}
+
+	if (!cinergyt2->streaming)
+		cinergyt2_control_sleep_mode(cinergyt2, 1);
+
+	return ret;
+}
+
+
+#ifdef ENABLE_RC
+static
+void cinergyt2_query_rc (void *data)
+{
+	struct cinergyt2 *cinergyt2 = (struct cinergyt2 *) data;
+	char buf [1] = { CINERGYT2_EP1_GET_RC_EVENTS };
+	struct cinergyt2_rc_event rc_events[12];
+	int n, len;
+
+	len = cinergyt2_command(cinergyt2, buf, sizeof(buf), 
+			     (char *) rc_events, sizeof(rc_events));
+
+	for (n=0; len>0 && n<(len/sizeof(rc_events[0])); n++) {
+		int i;
+
+		if (rc_events[n].type == CINERGYT2_RC_EVENT_TYPE_NEC &&
+		    rc_events[n].value == ~0)
+		{
+			/**
+			 * keyrepeat bit. If we would handle this properly
+			 * we would need to emit down events as long the
+			 * keyrepeat goes, a up event if no further 
+			 * repeat bits occur. Would need a timer to implement
+			 * and no other driver does this, so we simply
+			 * emit the last key up/down sequence again.
+			 */
+		} else {
+			cinergyt2->rc_input_event = KEY_MAX;
+			for (i=0; i<sizeof(rc_keys)/sizeof(rc_keys[0]); i+=3) {
+				if (rc_keys[i+0] == rc_events[n].type &&
+				    rc_keys[i+1] == rc_events[n].value)
+				{
+					cinergyt2->rc_input_event = rc_keys[i+2];
+					break;
+				}
+			}
+		}
+
+		if (cinergyt2->rc_input_event != KEY_MAX) {
+			input_report_key(&cinergyt2->rc_input_dev, cinergyt2->rc_input_event, 1);
+			input_report_key(&cinergyt2->rc_input_dev, cinergyt2->rc_input_event, 0);
+			input_sync(&cinergyt2->rc_input_dev);
+	    	}
+	}
+
+	schedule_delayed_work(&cinergyt2->rc_query_work, (HZ/5));
+}
+#endif
+
+
+static
+int cinergyt2_probe (struct usb_interface *intf,
+		  const struct usb_device_id *id)
+{
+	struct cinergyt2 *cinergyt2;
+	int i, err;
+
+	if (!(cinergyt2 = kmalloc (sizeof(struct cinergyt2), GFP_KERNEL))) {
+		printk ("%s: out of memory?!?\n", __FUNCTION__);
+		return -ENOMEM;
+	}
+
+	memset (cinergyt2, 0, sizeof (struct cinergyt2));
+	usb_set_intfdata (intf, (void *) cinergyt2);
+
+	init_MUTEX(&cinergyt2->sem);
+
+	cinergyt2->udev = interface_to_usbdev(intf);
+	
+	if (cinergyt2_alloc_stream_urbs (cinergyt2) < 0) {
+		printk("%s: dvb_dmx_init unable to allocate stream urbs\n",
+		       __FUNCTION__);
+		kfree(cinergyt2);
+		return -ENOMEM;
+	}
+
+	dvb_register_adapter(&cinergyt2->adapter, DRIVER_NAME, THIS_MODULE);
+
+	cinergyt2->demux.priv = cinergyt2;
+	cinergyt2->demux.filternum = 256;
+	cinergyt2->demux.feednum = 256;
+	cinergyt2->demux.start_feed = cinergyt2_start_feed;
+	cinergyt2->demux.stop_feed = cinergyt2_stop_feed;
+	cinergyt2->demux.dmx.capabilities = DMX_TS_FILTERING |
+					 DMX_SECTION_FILTERING |
+					 DMX_MEMORY_BASED_FILTERING;
+
+	if ((err = dvb_dmx_init(&cinergyt2->demux)) < 0) {
+		printk("cinergyt2_probe: dvb_dmx_init() failed (err = %d)\n", err);
+		goto bailout;
+	}
+
+	cinergyt2->dmxdev.filternum = cinergyt2->demux.filternum;
+	cinergyt2->dmxdev.demux = &cinergyt2->demux.dmx;
+	cinergyt2->dmxdev.capabilities = 0;
+
+	if ((err = dvb_dmxdev_init(&cinergyt2->dmxdev, cinergyt2->adapter)) < 0) {
+		printk("cinergyt2_probe: dvb_dmxdev_init() failed (err = %d)\n", err);
+		goto bailout;
+	}
+
+	if (dvb_net_init(cinergyt2->adapter, &cinergyt2->dvbnet, &cinergyt2->demux.dmx))
+		printk("cinergyt2_dvb: dvb_net_init failed!\n");
+
+	dvb_register_frontend(cinergyt2_fe_ioctl, cinergyt2->adapter, cinergyt2,
+			      &cinergyt2_fe_info, THIS_MODULE);
+
+#ifdef ENABLE_RC
+	init_input_dev(&cinergyt2->rc_input_dev);			
+
+	cinergyt2->rc_input_dev.evbit[0] = BIT(EV_KEY);
+	cinergyt2->rc_input_dev.keycodesize = sizeof(unsigned char);
+	cinergyt2->rc_input_dev.keycodemax = KEY_MAX;
+	cinergyt2->rc_input_dev.name = DRIVER_NAME " remote control";
+	cinergyt2->rc_input_dev.id.bustype = BUS_USB;
+	cinergyt2->rc_input_dev.id.vendor = 0x0001;
+	cinergyt2->rc_input_dev.id.product = 0x0001;
+	cinergyt2->rc_input_dev.id.version = 0x0100;
+
+	for (i=0; i<sizeof(rc_keys)/sizeof(rc_keys[0]); i+=3)
+		set_bit(rc_keys[i+2], cinergyt2->rc_input_dev.keybit);
+
+	input_register_device(&cinergyt2->rc_input_dev);
+
+	cinergyt2->rc_input_event = KEY_MAX;
+	
+	INIT_WORK(&cinergyt2->rc_query_work, cinergyt2_query_rc, cinergyt2);
+	schedule_delayed_work(&cinergyt2->rc_query_work, HZ);
+#endif
+
+	return 0;
+
+bailout:
+	dvb_dmxdev_release(&cinergyt2->dmxdev);
+	dvb_dmx_release(&cinergyt2->demux);
+	dvb_unregister_adapter (cinergyt2->adapter);
+	cinergyt2_free_stream_urbs (cinergyt2);
+	kfree(cinergyt2);
+	return -ENOMEM;
+}
+
+
+static
+void cinergyt2_disconnect (struct usb_interface *intf)
+{
+	struct cinergyt2 *cinergyt2 = usb_get_intfdata (intf);
+
+	printk("%s: \n", __FUNCTION__);
+
+#ifdef ENABLE_RC
+	cancel_delayed_work(&cinergyt2->rc_query_work);
+	flush_scheduled_work();
+	input_unregister_device(&cinergyt2->rc_input_dev);
+#endif
+
+	cinergyt2->demux.dmx.close(&cinergyt2->demux.dmx);
+	dvb_net_release(&cinergyt2->dvbnet);
+	dvb_dmxdev_release(&cinergyt2->dmxdev);
+	dvb_dmx_release(&cinergyt2->demux);
+
+	dvb_unregister_frontend(cinergyt2_fe_ioctl, cinergyt2->adapter);
+	dvb_unregister_adapter(cinergyt2->adapter);
+
+	cinergyt2_free_stream_urbs(cinergyt2);
+	kfree(cinergyt2);
+}
+
+
+static const
+struct usb_device_id cinergyt2_table [] __devinitdata = {
+	{ USB_DEVICE(0x0ccd, 0x0038) },
+	{ 0 }
+};
+
+
+
+MODULE_DEVICE_TABLE(usb, cinergyt2_table);
+
+static
+struct usb_driver cinergyt2_driver = {
+	.owner = THIS_MODULE,
+	.name = "cinergyt2",
+	.probe = cinergyt2_probe,
+	.disconnect = cinergyt2_disconnect,
+	.id_table = cinergyt2_table
+};
+
+
+
+static
+int __init cinergyt2_init (void)
+{
+	int err;
+
+	if ((err = usb_register(&cinergyt2_driver)) < 0) {
+		printk("%s: usb_register() failed! (err %i)\n", __FILE__, err);
+		return err;
+	}
+
+	return 0;
+}
+
+
+static
+void __exit cinergyt2_exit (void)
+{
+	printk ("%s: \n", __FUNCTION__);
+	usb_deregister(&cinergyt2_driver);
+}
+
+
+module_init (cinergyt2_init);
+module_exit (cinergyt2_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Holger Wächtler, Daniel Mack");
+