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