tm6000-core.c revision 9839029b052f094b9c14cb60e7c729950dd28712
19701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/*
2d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  tm6000-core.c - driver for TM5600/TM6000/TM6010 USB video capture devices
3d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *
4d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>
5d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *
6d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>
7d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *      - DVB-T support
8d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *
9d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  This program is free software; you can redistribute it and/or modify
10d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  it under the terms of the GNU General Public License as published by
11d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  the Free Software Foundation version 2
12d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *
13d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  This program is distributed in the hope that it will be useful,
14d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  but WITHOUT ANY WARRANTY; without even the implied warranty of
15d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  GNU General Public License for more details.
17d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *
18d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  You should have received a copy of the GNU General Public License
19d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  along with this program; if not, write to the Free Software
20d0058645c682a04c261516e917414ed8e39b2296Ruslan Pisarev *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab */
229701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include <linux/module.h>
249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include <linux/kernel.h>
254ef09889d7b4c7be2aa3e132efb77029f51c95b7Tejun Heo#include <linux/slab.h>
269701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include <linux/usb.h>
279701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include <linux/i2c.h>
289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include "tm6000.h"
299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include "tm6000-regs.h"
309701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include <media/v4l2-common.h>
319701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#include <media/tuner.h>
329701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
334363a0b8343747a429df526249d2f3194403365cRuslan Pisarev#define USB_TIMEOUT	(5 * HZ) /* ms */
349701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
3552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_read_write_usb(struct tm6000_core *dev, u8 req_type, u8 req,
3652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			  u16 value, u16 index, u8 *buf, u16 len)
379701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
389701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	int          ret, i;
399701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	unsigned int pipe;
4052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	u8	     *data = NULL;
419701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	if (len)
439701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		data = kzalloc(len, GFP_KERNEL);
449701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
459701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
469701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	if (req_type & USB_DIR_IN)
4752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		pipe = usb_rcvctrlpipe(dev->udev, 0);
489701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	else {
4952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		pipe = usb_sndctrlpipe(dev->udev, 0);
509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		memcpy(data, buf, len);
519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	}
529701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
53edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab	if (tm6000_debug & V4L2_DEBUG_I2C) {
54638054ab0276c40eca7cf49ae107e3d6f67ebf38Mauro Carvalho Chehab		printk("(dev %p, pipe %08x): ", dev->udev, pipe);
559701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
56638054ab0276c40eca7cf49ae107e3d6f67ebf38Mauro Carvalho Chehab		printk("%s: %02x %02x %02x %02x %02x %02x %02x %02x ",
5752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			(req_type & USB_DIR_IN) ? " IN" : "OUT",
5852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			req_type, req, value&0xff, value>>8, index&0xff,
5952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			index>>8, len&0xff, len>>8);
609701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
6152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		if (!(req_type & USB_DIR_IN)) {
629701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab			printk(">>> ");
6352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			for (i = 0; i < len; i++)
6452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov				printk(" %02x", buf[i]);
658ae1fc6e10cdf9be754cccee2a3ee551a981ab08Mauro Carvalho Chehab		printk("\n");
669701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		}
679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	}
689701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
6952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index,
7052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			      data, len, USB_TIMEOUT);
719701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
729701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	if (req_type &  USB_DIR_IN)
739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		memcpy(buf, data, len);
749701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
75edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab	if (tm6000_debug & V4L2_DEBUG_I2C) {
7652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		if (ret < 0) {
779701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab			if (req_type &  USB_DIR_IN)
7852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov				printk("<<< (len=%d)\n", len);
799701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
809701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab			printk("%s: Error #%d\n", __FUNCTION__, ret);
819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		} else if (req_type &  USB_DIR_IN) {
829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab			printk("<<< ");
8352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			for (i = 0; i < len; i++)
8452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov				printk(" %02x", buf[i]);
859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab			printk("\n");
869701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		}
879701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	}
889701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	kfree(data);
909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
91a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig	msleep(5);
92a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig
939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	return ret;
949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
9652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_set_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index)
979701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
989701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	return
9952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR,
10052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov				      req, value, index, NULL, 0);
1019701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
10229ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_set_reg);
1039701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
10452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index)
1059701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
1069701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	int rc;
1079701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	u8 buf[1];
1089701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
10952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
11052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov					value, index, buf, 1);
1119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
11252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	if (rc < 0)
1139701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		return rc;
1149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
1159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	return *buf;
1169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
11729ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_get_reg);
1189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
11952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg16(struct tm6000_core *dev, u8 req, u16 value, u16 index)
1209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
1219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	int rc;
1229701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	u8 buf[2];
1239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
12452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
12552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov					value, index, buf, 2);
1269701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
12752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	if (rc < 0)
1289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		return rc;
1299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
1309701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	return buf[1]|buf[0]<<8;
1319701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
1329701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
13352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg32(struct tm6000_core *dev, u8 req, u16 value, u16 index)
1342f7908848642c177b16b71a2ed52b57d614637efStefan Ringel{
1352f7908848642c177b16b71a2ed52b57d614637efStefan Ringel	int rc;
1362f7908848642c177b16b71a2ed52b57d614637efStefan Ringel	u8 buf[4];
1372f7908848642c177b16b71a2ed52b57d614637efStefan Ringel
13852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
13952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov					value, index, buf, 4);
1402f7908848642c177b16b71a2ed52b57d614637efStefan Ringel
14152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	if (rc < 0)
1422f7908848642c177b16b71a2ed52b57d614637efStefan Ringel		return rc;
1432f7908848642c177b16b71a2ed52b57d614637efStefan Ringel
1442f7908848642c177b16b71a2ed52b57d614637efStefan Ringel	return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24;
1452f7908848642c177b16b71a2ed52b57d614637efStefan Ringel}
1462f7908848642c177b16b71a2ed52b57d614637efStefan Ringel
1472a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimovint tm6000_i2c_reset(struct tm6000_core *dev, u16 tsleep)
1482a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov{
1492a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	int rc;
1502a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov
1512a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 0);
1522a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	if (rc < 0)
1532a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov		return rc;
1542a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov
1552a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	msleep(tsleep);
1562a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov
1572a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 1);
1582a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	msleep(tsleep);
1592a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov
1602a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov	return rc;
1612a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov}
1622a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov
1639701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabvoid tm6000_set_fourcc_format(struct tm6000_core *dev)
1649701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
165717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab	if (dev->dev_type == TM6010) {
1664223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab		int val;
1674223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab
1684223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab		val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0) & 0xfc;
169717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab		if (dev->fourcc == V4L2_PIX_FMT_UYVY)
1704223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab			tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val);
171717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab		else
1724223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab			tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val | 1);
1739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	} else {
174717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab		if (dev->fourcc == V4L2_PIX_FMT_UYVY)
1759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab			tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0);
176717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab		else
1779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab			tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0x90);
1789701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	}
1799701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
1809701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
181589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehabstatic void tm6000_set_vbi(struct tm6000_core *dev)
1829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
183589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	/*
184589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	 * FIXME:
185589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	 * VBI lines and start/end are different between 60Hz and 50Hz
186589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	 * So, it is very likely that we need to change the config to
187589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	 * something that takes it into account, doing something different
188589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	 * if (dev->norm & V4L2_STD_525_60)
189589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	 */
19094d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab
19129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	if (dev->dev_type == TM6010) {
192120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
193120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R41_TELETEXT_VBI_CODE1, 0x27);
194120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55);
195120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R43_VBI_DATA_TYPE_LINE7, 0x66);
196120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R44_VBI_DATA_TYPE_LINE8, 0x66);
197120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R45_VBI_DATA_TYPE_LINE9, 0x66);
198120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
199120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R46_VBI_DATA_TYPE_LINE10, 0x66);
200120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
201120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R47_VBI_DATA_TYPE_LINE11, 0x66);
202120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
203120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R48_VBI_DATA_TYPE_LINE12, 0x66);
204120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
205120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R49_VBI_DATA_TYPE_LINE13, 0x66);
206120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
207120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R4A_VBI_DATA_TYPE_LINE14, 0x66);
208120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
209120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R4B_VBI_DATA_TYPE_LINE15, 0x66);
210120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
211120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R4C_VBI_DATA_TYPE_LINE16, 0x66);
212120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
213120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R4D_VBI_DATA_TYPE_LINE17, 0x66);
214120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
215120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R4E_VBI_DATA_TYPE_LINE18, 0x66);
216120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
217120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R4F_VBI_DATA_TYPE_LINE19, 0x66);
218120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
219120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R50_VBI_DATA_TYPE_LINE20, 0x66);
220120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
221120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x66);
222120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
223120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R52_VBI_DATA_TYPE_LINE22, 0x66);
224120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
225120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R53_VBI_DATA_TYPE_LINE23, 0x00);
226120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
227120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R54_VBI_DATA_TYPE_RLINES, 0x00);
228120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
229120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01);
230120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
231120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R56_VBI_LOOP_FILTER_I_GAIN, 0x00);
232120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev,
233120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel			TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02);
234120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35);
235120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0);
236120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R5A_VBI_TELETEXT_DTO1, 0x11);
237120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R5B_VBI_TELETEXT_DTO0, 0x4c);
238120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R40_TELETEXT_VBI_CODE0, 0x01);
239120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel		tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00);
240589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	}
241589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab}
242589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab
243589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehabint tm6000_init_analog_mode(struct tm6000_core *dev)
244589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab{
245589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	struct v4l2_frequency f;
246589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab
247589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	if (dev->dev_type == TM6010) {
248589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		int val;
249589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab
250589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		/* Enable video */
251589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0);
252589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		val |= 0x60;
253589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val);
254589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		val = tm6000_get_reg(dev,
255589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab			TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0);
256589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		val &= ~0x40;
257589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, val);
258589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab
259589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc);
260589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab
2619701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	} else {
26229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		/* Enables soft reset */
2639afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
26429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
26552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		if (dev->scaler)
2669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab			tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20);
26752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		else	/* Enable Hfilter and disable TS Drop err */
2689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab			tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80);
2699701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
2709afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88);
2719839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x23);
2729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0);
2739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8);
2749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06);
2759839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f);
2769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
27729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		/* AP Software reset */
2789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08);
2799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00);
2809701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
28129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		tm6000_set_fourcc_format(dev);
2829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
28329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		/* Disables soft reset */
2849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00);
2859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
28629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		/* E3: Select input 0 - TV tuner */
2879839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x00);
2889839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x60);
2899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
29029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		/* This controls input */
29129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_2, 0x0);
29229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_3, 0x01);
29329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	}
2949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	msleep(20);
2959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
29629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	/* Tuner firmware can now be loaded */
29729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
29894d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	/*
29994d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * FIXME: This is a hack! xc3028 "sleeps" when no channel is detected
30094d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * for more than a few seconds. Not sure why, as this behavior does
30194d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * not happen on other devices with xc3028. So, I suspect that it
30294d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * is yet another bug at tm6000. After start sleeping, decoding
30394d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * doesn't start automatically. Instead, it requires some
30494d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * I2C commands to wake it up. As we want to have image at the
30594d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * beginning, we needed to add this hack. The better would be to
30694d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 * discover some way to make tm6000 to wake up without this hack.
30794d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab	 */
30852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	f.frequency = dev->freq;
309427f7facb374b8651ff01b7700e690ef8ccae159Mauro Carvalho Chehab	v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f);
3109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
3119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	msleep(100);
31252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	tm6000_set_standard(dev, &dev->norm);
313589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab	tm6000_set_vbi(dev);
31452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	tm6000_set_audio_bitrate(dev, 48000);
3159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
316f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel	/* switch dvb led off */
317f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel	if (dev->gpio.dvb_led) {
318f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel		tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
319f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel			dev->gpio.dvb_led, 0x01);
320f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel	}
321f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel
3229701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	return 0;
3239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
3249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
32552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init_digital_mode(struct tm6000_core *dev)
3263169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig{
327c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel	if (dev->dev_type == TM6010) {
328c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		int val;
329c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		u8 buf[2];
3303169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig
331c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		/* digital init */
3329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0);
333c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		val &= ~0x60;
3349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val);
3359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		val = tm6000_get_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0);
336c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		val |= 0x40;
3379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, val);
3389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28);
3399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc);
3409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff);
34152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		tm6000_read_write_usb(dev, 0xc0, 0x0e, 0x00c2, 0x0008, buf, 2);
34252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		printk(KERN_INFO"buf %#x %#x\n", buf[0], buf[1]);
343c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel	} else  {
3449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08);
3459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00);
3469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
3479839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x08);
3489839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c);
3499839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff);
3509839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0xd8);
3519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40);
3529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0);
3539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09);
3549839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x37);
3559afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8);
3569afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0);
3579afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab		tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60);
3589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab
3599839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c);
3609839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff);
3619839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x08);
362c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		msleep(50);
363c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel
36452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
365c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		msleep(50);
36652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01);
367c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		msleep(50);
36852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
369c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel		msleep(100);
370c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel	}
371f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel
372f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel	/* switch dvb led on */
373f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel	if (dev->gpio.dvb_led) {
374f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel		tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
375f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel			dev->gpio.dvb_led, 0x00);
376f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel	}
377f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel
3783169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig	return 0;
3793169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig}
380cee3926f5f245811ef7172405253815e7f3e15e1Stefan RingelEXPORT_SYMBOL(tm6000_init_digital_mode);
3819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
38229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init {
38329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	u8 req;
38429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	u8 reg;
38529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	u8 val;
38629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab};
38729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
3889701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/* The meaning of those initializations are unknown */
38929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init tm6000_init_tab[] = {
3909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	/* REG  VALUE */
3919839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f },
3929afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RFF_SOFT_RESET, 0x08 },
3939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RFF_SOFT_RESET, 0x00 },
3949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD5_POWERSAVE, 0x4f },
3959839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RDA_CLK_SEL, 0x23 },
3969839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RDB_OUT_SEL, 0x08 },
3979839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x00 },
3989839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10 },
3999839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00 },
4009839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00 },
4019839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_REB_VADC_AADC_MODE, 0x64 },	/* 48000 bits/sample, external input */
4029839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	{ TM6000_REQ07_REE_VADC_CTRL_SEL_CONTROL, 0xc2 },
4039839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel
4049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R3F_RESET, 0x01 },		/* Start of soft reset */
4059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
4069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 },
4079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
4089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
4099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 },
4109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 },
4119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 },
4129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 },
4139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 },
4149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a },
4159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 },
4169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 },
4179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b },
4189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 },
4199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f },
4209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd },
4219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
4229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
4239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
4249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
4259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
4269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
4279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
4289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
4299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c },
4309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c },
4319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 },
4329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
4339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
4349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
4359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 },
4369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
4379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 },
4389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
4399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a },
4409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 },
4419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 },
4429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a },
4439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 },
4449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 },
4459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 },
4469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 },
4479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 },
4489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 },
4499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 },
4509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
4519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC1_TRESHOLD, 0xd0 },
4529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC3_HSTART1, 0x88 },
4539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R3F_RESET, 0x00 },		/* End of the soft reset */
4542415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab	{ TM6010_REQ05_R18_IMASK7, 0x00 },
45529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab};
45629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
45729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init tm6010_init_tab[] = {
4589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 },
4599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC4_HSTART0, 0xa0 },
4609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC6_HEND0, 0x40 },
4619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RCA_VEND0, 0x31 },
4629afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0xe1 },
4639afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 },
4649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RFE_POWER_DOWN, 0x7f },
4659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab
4669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 },
4679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 },
4689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 },
4699afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 },
4709afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 },
4719afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 },
4729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 },
4739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 },
4749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc },
4759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab
4769afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R3F_RESET, 0x01 },
4779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
4789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 },
4799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
4809afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
4819afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 },
4829afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 },
4839afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 },
4849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 },
4859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 },
4869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a },
4879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 },
4889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 },
4899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b },
4909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 },
4919afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f },
4929afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd },
4939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
4949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
4959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
4969afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
4979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
4989afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
4999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
5009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
5019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c },
5029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c },
5039afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 },
5049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
5059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
5069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
5079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 },
5089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
5099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 },
5109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
5119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a },
5129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 },
5139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 },
5149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a },
5159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 },
5169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 },
5179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 },
5189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 },
5199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 },
5209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 },
5219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 },
5229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
5239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC1_TRESHOLD, 0xd0 },
5249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RC3_HSTART1, 0x88 },
5259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_R3F_RESET, 0x00 },
52629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
5272415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab	{ TM6010_REQ05_R18_IMASK7, 0x00 },
52829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
5299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD8_IR_LEADER1, 0xaa },
5309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD8_IR_LEADER0, 0x30 },
5319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD8_IR_PULSE_CNT1, 0x20 },
5329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD8_IR_PULSE_CNT0, 0xd0 },
533d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel	{ REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 },
5349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD8_IR, 0x2f },
535d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel
53629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	/* set remote wakeup key:any key wakeup */
5379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RE5_REMOTE_WAKEUP,  0xfe },
5389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab	{ TM6010_REQ07_RD8_IR_WAKEUP_SEL,  0xff },
5399701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab};
5409701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
54152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init(struct tm6000_core *dev)
5429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
54352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	int board, rc = 0, i, size;
54429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	struct reg_init *tab;
54529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
546c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel	/* Check board revision */
547c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel	board = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0);
548c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel	if (board >= 0) {
549c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel		switch (board & 0xff) {
550c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel		case 0xf3:
551c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			printk(KERN_INFO "Found tm6000\n");
552c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			if (dev->dev_type != TM6000)
553c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel				dev->dev_type = TM6000;
554c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			break;
555c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel		case 0xf4:
556c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			printk(KERN_INFO "Found tm6010\n");
557c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			if (dev->dev_type != TM6010)
558c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel				dev->dev_type = TM6010;
559c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			break;
560c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel		default:
561c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel			printk(KERN_INFO "Unknown board version = 0x%08x\n", board);
562c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel		}
563c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel	} else
564c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel		printk(KERN_ERR "Error %i while retrieving board version\n", board);
565c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel
56629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	if (dev->dev_type == TM6010) {
56729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		tab = tm6010_init_tab;
56829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		size = ARRAY_SIZE(tm6010_init_tab);
56929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	} else {
57029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		tab = tm6000_init_tab;
57129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab		size = ARRAY_SIZE(tm6000_init_tab);
57229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	}
5739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
5749701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	/* Load board's initialization table */
57552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov	for (i = 0; i < size; i++) {
57652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		rc = tm6000_set_reg(dev, tab[i].req, tab[i].reg, tab[i].val);
57752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		if (rc < 0) {
57852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov			printk(KERN_ERR "Error %i while setting req %d, "
57952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov					"reg %d to value %d\n", rc,
58052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov					tab[i].req, tab[i].reg, tab[i].val);
5819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab			return rc;
5829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		}
5839701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	}
5849701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
58529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab	msleep(5); /* Just to be conservative */
58629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab
587e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab	rc = tm6000_cards_setup(dev);
588a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig
589e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab	return rc;
5909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
5919701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
59244351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho Chehabint tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate)
5939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{
5949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	int val;
5959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
5969839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	/* enable I2S, if we use sif or external I2S device */
597a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab	if (dev->dev_type == TM6010) {
598a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab		val = tm6000_get_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, 0);
599a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab		if (val < 0)
600a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab			return val;
601a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab		val = (val & 0xf0) | 0x1; /* 48 kHz, not muted */
602a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab		val = tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, val);
603a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab		if (val < 0)
604a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab			return val;
605a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab	}
606a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab
6079839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	/* different reg's to set audio bitrate */
6089839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	if (dev->dev_type == TM6010) {
6099839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		val = tm6000_get_reg(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
6109839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel			0x0);
6119839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		if (val < 0)
6129839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel			return val;
6139839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	} else {
6149839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		val = tm6000_get_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x0);
6159839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		if (val < 0)
6169839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel			return val;
6179839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	}
6189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
6199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	val &= 0x0f;		/* Preserve the audio input control bits */
6209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	switch (bitrate) {
6219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	case 44100:
62252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		val |= 0xd0;
62352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		dev->audio_bitrate = bitrate;
6249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		break;
6259701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	case 48000:
62652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		val |= 0x60;
62752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov		dev->audio_bitrate = bitrate;
6289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab		break;
6299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	}
6309839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	if (dev->dev_type == TM6010)
6319839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		val = tm6000_set_reg(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
6329839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel			val);
6339839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel	else
6349839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel		val = tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, val);
6359701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab
6369701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab	return val;
6379701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}
63844351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho ChehabEXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate);
6390439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6400439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_devlist);
6410439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic DEFINE_MUTEX(tm6000_devlist_mutex);
6420439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6430439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/*
6440439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * tm6000_realease_resource()
6450439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */
6460439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6470439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_remove_from_devlist(struct tm6000_core *dev)
6480439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{
6490439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_lock(&tm6000_devlist_mutex);
6500439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	list_del(&dev->devlist);
6510439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_unlock(&tm6000_devlist_mutex);
6520439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel};
6530439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6540439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_add_into_devlist(struct tm6000_core *dev)
6550439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{
6560439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_lock(&tm6000_devlist_mutex);
6570439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	list_add_tail(&dev->devlist, &tm6000_devlist);
6580439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_unlock(&tm6000_devlist_mutex);
6590439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel};
6600439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6610439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/*
6620439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * Extension interface
6630439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */
6640439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6650439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_extension_devlist);
6660439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
667b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehabint tm6000_call_fillbuf(struct tm6000_core *dev, enum tm6000_ops_type type,
668b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab			char *buf, int size)
669b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab{
670b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab	struct tm6000_ops *ops = NULL;
671b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab
672b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab	/* FIXME: tm6000_extension_devlist_lock should be a spinlock */
673b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab
674b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab	if (!list_empty(&tm6000_extension_devlist)) {
675b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab		list_for_each_entry(ops, &tm6000_extension_devlist, next) {
676b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab			if (ops->fillbuf && ops->type == type)
677b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab				ops->fillbuf(dev, buf, size);
678b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab		}
679b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab	}
680b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab
681b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab	return 0;
682b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab}
683b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab
6840439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelint tm6000_register_extension(struct tm6000_ops *ops)
6850439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{
6860439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	struct tm6000_core *dev = NULL;
6870439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
6880439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_lock(&tm6000_devlist_mutex);
6890439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	list_add_tail(&ops->next, &tm6000_extension_devlist);
6900439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	list_for_each_entry(dev, &tm6000_devlist, devlist) {
6913f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab		ops->init(dev);
6923f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab		printk(KERN_INFO "%s: Initialized (%s) extension\n",
6933f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab		       dev->name, ops->name);
6940439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	}
6950439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_unlock(&tm6000_devlist_mutex);
6960439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	return 0;
6970439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}
6980439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_register_extension);
6990439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7000439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_unregister_extension(struct tm6000_ops *ops)
7010439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{
7020439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	struct tm6000_core *dev = NULL;
7030439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7040439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_lock(&tm6000_devlist_mutex);
705a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall	list_for_each_entry(dev, &tm6000_devlist, devlist)
706a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall		ops->fini(dev);
7070439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7080439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name);
7090439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	list_del(&ops->next);
7100439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	mutex_unlock(&tm6000_devlist_mutex);
7110439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}
7120439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_unregister_extension);
7130439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7140439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_init_extension(struct tm6000_core *dev)
7150439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{
7160439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	struct tm6000_ops *ops = NULL;
7170439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7184ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab	mutex_lock(&tm6000_devlist_mutex);
7190439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	if (!list_empty(&tm6000_extension_devlist)) {
7200439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel		list_for_each_entry(ops, &tm6000_extension_devlist, next) {
7210439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel			if (ops->init)
7220439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel				ops->init(dev);
7230439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel		}
7240439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	}
7254ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab	mutex_unlock(&tm6000_devlist_mutex);
7260439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}
7270439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7280439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_close_extension(struct tm6000_core *dev)
7290439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{
7300439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	struct tm6000_ops *ops = NULL;
7310439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel
7324ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab	mutex_lock(&tm6000_devlist_mutex);
7330439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	if (!list_empty(&tm6000_extension_devlist)) {
7340439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel		list_for_each_entry(ops, &tm6000_extension_devlist, next) {
7350439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel			if (ops->fini)
7360439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel				ops->fini(dev);
7370439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel		}
7380439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel	}
739427aacfe1d0c540bf80e5243d18ba1272f9b756fDmitri Belimov	mutex_unlock(&tm6000_devlist_mutex);
7400439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}
741