Commit 3169c9b2 authored by Michel Ludwig's avatar Michel Ludwig Committed by Mauro Carvalho Chehab
Browse files

V4L/DVB (12788): tm6000: Add initial DVB-T support 



Signed-off-by: default avatarMichel Ludwig <michel.ludwig@gmail.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent a4cf976c

drivers/staging/tm6000/Makefile

+4 −1
Original line number Diff line number Diff line 
tm6000-objs := tm6000-cards.o \

		   tm6000-core.o  \

		   tm6000-i2c.o   \

		   tm6000-video.o

		   tm6000-video.o \

		   tm6000-dvb.o \

		   hack.o \





obj-$(CONFIG_VIDEO_TM6000) += tm6000.o

drivers/staging/tm6000/hack.c

0 → 100644
+251 −0
Original line number Diff line number Diff line 












/*

   hack.h - hackish code that needs to be improved (or removed) at a

	    later point



   Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>



   This program is free software; you can redistribute it and/or modify

   it under the terms of the GNU General Public License as published by

   the Free Software Foundation version 2



   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 "hack.h"



#include "tm6000.h"



#include <linux/usb.h>



static inline int tm6000_snd_control_msg(struct tm6000_core *dev, __u8 request, __u16 value, __u16 index, void *data, __u16 size)

{

	return tm6000_read_write_usb (dev, USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, request, value, index, data, size);

}



static int pseudo_zl10353_pll(struct tm6000_core *tm6000_dev, struct dvb_frontend_parameters *p)

{

	int ret;

	u8 *data = kzalloc(50*sizeof(u8), GFP_KERNEL);



printk(KERN_ALERT "should set frequency %u\n", p->frequency);

printk(KERN_ALERT "and bandwith %u\n", p->u.ofdm.bandwidth);



	if(tm6000_dev->dvb->frontend->ops.tuner_ops.set_params) {

		tm6000_dev->dvb->frontend->ops.tuner_ops.set_params(tm6000_dev->dvb->frontend, p);

	}

	else {

		printk(KERN_ALERT "pseudo zl10353: couldn't set tuner parameters\n");

	}



	// init ZL10353

	data[0] = 0x0b;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x501e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x80;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x551e, 0x00, data, 0x1);

	msleep(100);

	data[0] = 0x01;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0xea1e, 0x00, data, 0x1);

	msleep(100);

	data[0] = 0x00;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0xea1e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x1c;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x561e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x40;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x5e1e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x36;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x641e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x67;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x651e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0xe5;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x661e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x19;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x6c1e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0xe9;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x6d1e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x44;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x511e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x46;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x521e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x15;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x531e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x0f;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x541e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x75;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x5c1e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x01;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x701e, 0x00, data, 0x1);

	msleep(15);

	data[0] = 0x00;

	ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x701e, 0x00, data, 0x1);

	msleep(15);



	msleep(50);



	switch(p->u.ofdm.bandwidth) {

		case BANDWIDTH_8_MHZ:

			data[0] = 0x00;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x701e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x36;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x641e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x67;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x651e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0xe5;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x661e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x19;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x6c1e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0xe9;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x6d1e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x44;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x511e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x46;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x521e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x15;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x531e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x0f;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x541e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x75;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x5c1e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x01;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x701e, 0x00, data, 0x1);

			msleep(15);

		break;



		default:

			printk(KERN_ALERT "tm6000: bandwidth not supported\n");

		case BANDWIDTH_7_MHZ:

			data[0] = 0x00;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x701e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x35;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x641e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x5a;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x651e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0xe9;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x661e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x19;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x6c1e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0xe9;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x6d1e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x44;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x511e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x46;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x521e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x15;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x531e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x0f;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x541e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x86;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x5c1e, 0x00, data, 0x1);

			msleep(15);

			data[0] = 0x01;

			ret = tm6000_snd_control_msg(tm6000_dev, 0x10, 0x701e, 0x00, data, 0x1);

			msleep(15);

		break;

	}



	kfree(data);



	return 0;

};







int pseudo_zl10353_set_frontend(struct dvb_frontend *fe,

				  struct dvb_frontend_parameters *p)

{

	struct tm6000_core *tm6000_dev = fe->dvb->priv;

	u32 status;



	if(p != NULL) {

// 		mutex_lock(&tm6000_dev->mutex);

		pseudo_zl10353_pll(tm6000_dev, p);

// 		mutex_unlock(&tm6000_dev->mutex);

	}



	if(tm6000_dev->dvb->frontend->ops.read_status) {

		tm6000_dev->dvb->frontend->ops.read_status(tm6000_dev->dvb->frontend, &status);

		printk(KERN_ALERT "demodulator status: FE_HAS_CARRIER %i \n", (status & FE_HAS_CARRIER));

		printk(KERN_ALERT "demodulator status: FE_HAS_VITERBI %i \n", (status & FE_HAS_VITERBI));

		printk(KERN_ALERT "demodulator status: FE_HAS_LOCK %i \n", (status & FE_HAS_LOCK));

		printk(KERN_ALERT "demodulator status: FE_HAS_SYNC %i \n", (status & FE_HAS_SYNC));

		printk(KERN_ALERT "demodulator status: FE_HAS_SIGNAL %i \n", (status & FE_HAS_SIGNAL));

	}

	else {

		printk(KERN_ALERT "pseudo zl10353: couldn't read demodulator status\n");

	}

	return 0;

}



int pseudo_zl10353_read_status(struct dvb_frontend *fe, fe_status_t *status)

{



	*status = FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK | FE_HAS_SIGNAL;



	return 0;

}



struct dvb_frontend* pseudo_zl10353_attach(struct tm6000_core *dev,

					   const struct zl10353_config *config,

								   struct i2c_adapter *i2c)

{

	struct tm6000_dvb *dvb = dev->dvb;



	dvb->frontend = zl10353_attach(config, i2c);

	if(!dvb->frontend) {

		return NULL;

	}



	/* override some functions with our implementations */

	dvb->frontend->ops.set_frontend = pseudo_zl10353_set_frontend;

	dvb->frontend->ops.read_status = pseudo_zl10353_read_status;

	dvb->frontend->frontend_priv = dev;



	return dvb->frontend;

}

drivers/staging/tm6000/hack.h

0 → 100644
+45 −0
Original line number Diff line number Diff line 
/*

   hack.h - hackish code that needs to be improved (or removed) at a

	    later point



   Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>



   This program is free software; you can redistribute it and/or modify

   it under the terms of the GNU General Public License as published by

   the Free Software Foundation version 2



   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.

 */



#ifndef HACK_H

#define HACK_H



#include <linux/i2c.h>



#include "zl10353.h"

#include "dvb_frontend.h"



struct tm6000_core;



int pseudo_zl103530_init(struct dvb_frontend *fe);



int pseudo_zl10353_set_frontend(struct dvb_frontend *fe, struct dvb_frontend_parameters *p);



int pseudo_zl10353_read_status(struct dvb_frontend *fe, fe_status_t *status);



int pseudo_zl10353_read_signal_strength(struct dvb_frontend* fe, u16* strength);



int pseudo_zl10353_read_snr(struct dvb_frontend *fe, u16 *snr);



struct dvb_frontend* pseudo_zl10353_attach(struct tm6000_core *dev,

					   const struct zl10353_config *config,

								   struct i2c_adapter *i2c);



#endif

drivers/staging/tm6000/tm6000-cards.c

+18 −1
Original line number Diff line number Diff line
@@ -185,7 +185,19 @@ static int tm6000_init_dev(struct tm6000_core *dev) 
	dev->freq = f.frequency;



	tm6000_i2c_call_clients(dev, VIDIOC_S_FREQUENCY, &f);



	if(dev->caps.has_dvb) {

		dev->dvb = kzalloc(sizeof(*(dev->dvb)), GFP_KERNEL);

		if(!dev->dvb) {

			rc = -ENOMEM;

			goto err;

		}

		rc = tm6000_dvb_register(dev);

		if(rc < 0) {

			kfree(dev->dvb);

			dev->dvb = NULL;

			goto err;

		}

	}

err:

	mutex_unlock(&dev->lock);

	return rc;
@@ -389,6 +401,11 @@ static void tm6000_usb_disconnect(struct usb_interface *interface) 


	mutex_lock(&dev->lock);



	if(dev->dvb) {

		tm6000_dvb_unregister(dev);

		kfree(dev->dvb);

	}



	tm6000_v4l2_unregister(dev);



	tm6000_i2c_unregister(dev);

drivers/staging/tm6000/tm6000-core.c

+29 −0
Original line number Diff line number Diff line
@@ -3,6 +3,9 @@ 


   Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>



   Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>

       - DVB-T support



   This program is free software; you can redistribute it and/or modify

   it under the terms of the GNU General Public License as published by

   the Free Software Foundation version 2
@@ -207,6 +210,32 @@ int tm6000_init_analog_mode (struct tm6000_core *dev) 
	return 0;

}



int tm6000_init_digital_mode (struct tm6000_core *dev)

{

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00ff, 0x08);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00ff, 0x00);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x003f, 0x01);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00df, 0x08);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00e2, 0x0c);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00e8, 0xff);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00eb, 0xd8);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00c0, 0x40);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00c1, 0xd0);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00c3, 0x09);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00da, 0x37);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00d1, 0xd8);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00d2, 0xc0);

	tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00d6, 0x60);

	msleep(50);



	tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);

	tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01);

	tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);



	msleep(100);



	return 0;

}



/* The meaning of those initializations are unknown */

u8 init_tab[][2] = {