tm6000-core.c revision 4ef09889d7b4c7be2aa3e132efb77029f51c95b7
19701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/* 2e28f49b0b2a8e678af62745ffdc4e4f36d7283a6Dmitri Belimov tm6000-core.c - driver for TM5600/TM6000/TM6010 USB video capture devices 39701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 49701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org> 59701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 63169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com> 73169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig - DVB-T support 83169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig 99701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab it under the terms of the GNU General Public License as published by 119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab the Free Software Foundation version 2 129701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 139701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab This program is distributed in the hope that it will be useful, 149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab GNU General Public License for more details. 179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab You should have received a copy of the GNU General Public License 199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab along with this program; if not, write to the Free Software 209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 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 339701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab#define USB_TIMEOUT 5*HZ /* ms */ 349701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 359701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabint tm6000_read_write_usb (struct tm6000_core *dev, u8 req_type, u8 req, 369701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u16 value, u16 index, u8 *buf, u16 len) 379701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 389701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int ret, i; 399701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab unsigned int pipe; 409701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab static int ini=0, last=0, n=0; 419701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 *data=NULL; 429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 439701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (len) 449701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab data = kzalloc(len, GFP_KERNEL); 459701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 469701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 479701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 489701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab pipe=usb_rcvctrlpipe(dev->udev, 0); 499701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab else { 509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab pipe=usb_sndctrlpipe(dev->udev, 0); 519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab memcpy(data, buf, len); 529701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 539701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 54edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab if (tm6000_debug & V4L2_DEBUG_I2C) { 559701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (!ini) 569701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab last=ini=jiffies; 579701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 589701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("%06i (dev %p, pipe %08x): ", n, dev->udev, pipe); 599701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 609701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk( "%s: %06u ms %06u ms %02x %02x %02x %02x %02x %02x %02x %02x ", 619701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab (req_type & USB_DIR_IN)?" IN":"OUT", 629701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab jiffies_to_msecs(jiffies-last), 639701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab jiffies_to_msecs(jiffies-ini), 649701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab req_type, req,value&0xff,value>>8, index&0xff, index>>8, 659701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab len&0xff, len>>8); 669701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab last=jiffies; 679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab n++; 689701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 699701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if ( !(req_type & USB_DIR_IN) ) { 709701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk(">>> "); 719701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab for (i=0;i<len;i++) { 729701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk(" %02x",buf[i]); 739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 748ae1fc6e10cdf9be754cccee2a3ee551a981ab08Mauro Carvalho Chehab printk("\n"); 759701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 779701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 789701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index, data, 799701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab len, USB_TIMEOUT); 809701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab memcpy(buf, data, len); 839701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 84edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab if (tm6000_debug & V4L2_DEBUG_I2C) { 859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (ret<0) { 869701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 879701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("<<< (len=%d)\n",len); 889701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("%s: Error #%d\n", __FUNCTION__, ret); 909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else if (req_type & USB_DIR_IN) { 919701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("<<< "); 929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab for (i=0;i<len;i++) { 939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk(" %02x",buf[i]); 949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("\n"); 969701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 979701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 989701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 999701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab kfree(data); 1009701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 101a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig msleep(5); 102a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 1039701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return ret; 1049701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 1059701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1069701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabint tm6000_set_reg (struct tm6000_core *dev, u8 req, u16 value, u16 index) 1079701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1089701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 1099701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab tm6000_read_write_usb (dev, USB_DIR_OUT | USB_TYPE_VENDOR, 1109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab req, value, index, NULL, 0); 1119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 11229ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_set_reg); 1139701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabint tm6000_get_reg (struct tm6000_core *dev, u8 req, u16 value, u16 index) 1159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int rc; 1179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 buf[1]; 1189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab rc=tm6000_read_write_usb (dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 1209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab value, index, buf, 1); 1219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1229701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (rc<0) 1239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 1249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1259701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return *buf; 1269701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 12729ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_get_reg); 1289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabint tm6000_get_reg16 (struct tm6000_core *dev, u8 req, u16 value, u16 index) 1309701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1319701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int rc; 1329701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 buf[2]; 1339701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1349701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab rc=tm6000_read_write_usb (dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 1359701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab value, index, buf, 2); 1369701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1379701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (rc<0) 1389701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 1399701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1409701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return buf[1]|buf[0]<<8; 1419701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 1429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1432f7908848642c177b16b71a2ed52b57d614637efStefan Ringelint tm6000_get_reg32 (struct tm6000_core *dev, u8 req, u16 value, u16 index) 1442f7908848642c177b16b71a2ed52b57d614637efStefan Ringel{ 1452f7908848642c177b16b71a2ed52b57d614637efStefan Ringel int rc; 1462f7908848642c177b16b71a2ed52b57d614637efStefan Ringel u8 buf[4]; 1472f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1482f7908848642c177b16b71a2ed52b57d614637efStefan Ringel rc=tm6000_read_write_usb (dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 1492f7908848642c177b16b71a2ed52b57d614637efStefan Ringel value, index, buf, 4); 1502f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1512f7908848642c177b16b71a2ed52b57d614637efStefan Ringel if (rc<0) 1522f7908848642c177b16b71a2ed52b57d614637efStefan Ringel return rc; 1532f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1542f7908848642c177b16b71a2ed52b57d614637efStefan Ringel return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24; 1552f7908848642c177b16b71a2ed52b57d614637efStefan Ringel} 1562f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1572a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimovint tm6000_i2c_reset(struct tm6000_core *dev, u16 tsleep) 1582a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov{ 1592a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov int rc; 1602a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1612a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 0); 1622a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov if (rc < 0) 1632a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov return rc; 1642a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1652a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov msleep(tsleep); 1662a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1672a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 1); 1682a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov msleep(tsleep); 1692a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1702a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov return rc; 1712a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov} 1722a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabvoid tm6000_set_fourcc_format(struct tm6000_core *dev) 1749701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 175717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 1764223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab int val; 1774223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab 1784223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0) & 0xfc; 179717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 1804223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val); 181717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 1824223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val | 1); 1839701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 184717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 1859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 186717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 1879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0x90); 1889701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 1899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 1909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1919701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabint tm6000_init_analog_mode (struct tm6000_core *dev) 1929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 19329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 19429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab int val; 1959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 19629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Enable video */ 1979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0); 19829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab val |= 0x60; 1999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val); 200120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel val = tm6000_get_reg(dev, 201120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0); 202120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel val &= ~0x40; 203120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, val); 204120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel 205120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel /* Init teletext */ 206120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 207120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R41_TELETEXT_VBI_CODE1, 0x27); 208120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55); 209120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R43_VBI_DATA_TYPE_LINE7, 0x66); 210120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R44_VBI_DATA_TYPE_LINE8, 0x66); 211120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R45_VBI_DATA_TYPE_LINE9, 0x66); 212120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 213120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R46_VBI_DATA_TYPE_LINE10, 0x66); 214120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 215120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R47_VBI_DATA_TYPE_LINE11, 0x66); 216120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 217120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R48_VBI_DATA_TYPE_LINE12, 0x66); 218120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 219120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R49_VBI_DATA_TYPE_LINE13, 0x66); 220120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 221120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4A_VBI_DATA_TYPE_LINE14, 0x66); 222120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 223120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4B_VBI_DATA_TYPE_LINE15, 0x66); 224120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 225120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4C_VBI_DATA_TYPE_LINE16, 0x66); 226120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 227120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4D_VBI_DATA_TYPE_LINE17, 0x66); 228120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 229120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4E_VBI_DATA_TYPE_LINE18, 0x66); 230120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 231120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4F_VBI_DATA_TYPE_LINE19, 0x66); 232120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 233120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R50_VBI_DATA_TYPE_LINE20, 0x66); 234120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 235120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x66); 236120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 237120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R52_VBI_DATA_TYPE_LINE22, 0x66); 238120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 239120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R53_VBI_DATA_TYPE_LINE23, 0x00); 240120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 241120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R54_VBI_DATA_TYPE_RLINES, 0x00); 242120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 243120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01); 244120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 245120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R56_VBI_LOOP_FILTER_I_GAIN, 0x00); 246120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 247120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02); 248120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35); 249120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0); 250120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R5A_VBI_TELETEXT_DTO1, 0x11); 251120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R5B_VBI_TELETEXT_DTO0, 0x4c); 252120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R40_TELETEXT_VBI_CODE0, 0x01); 253120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 254120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel 255120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel 256120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel /* Init audio */ 257120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x00); 258120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R02_A_FIX_GAIN_CTRL, 0x04); 259120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00); 260120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0xa0); 261120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R05_A_STANDARD_MOD, 0x05); 262120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, 0x06); 263120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, 0x00); 264120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, 0x00); 265120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R09_A_MAIN_VOL, 0x08); 266120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, 0x91); 267120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R0B_A_ASD_THRES1, 0x20); 268120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R0C_A_ASD_THRES2, 0x12); 269120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R0D_A_AMD_THRES, 0x20); 270120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R0E_A_MONO_THRES1, 0xf0); 271120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R0F_A_MONO_THRES2, 0x80); 272120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R10_A_MUTE_THRES1, 0xc0); 273120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R11_A_MUTE_THRES2, 0x80); 274120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R12_A_AGC_U, 0x12); 275120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R13_A_AGC_ERR_T, 0xfe); 276120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R14_A_AGC_GAIN_INIT, 0x20); 277120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R15_A_AGC_STEP_THR, 0x14); 278120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R16_A_AGC_GAIN_MAX, 0xfe); 279120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R17_A_AGC_GAIN_MIN, 0x01); 280120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R18_A_TR_CTRL, 0xa0); 281120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R19_A_FH_2FH_GAIN, 0x32); 282120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R1A_A_NICAM_SER_MAX, 0x64); 283120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R1B_A_NICAM_SER_MIN, 0x20); 284120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1c, 0x00); 285120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1d, 0x00); 286120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R1E_A_GAIN_DEEMPH_OUT, 0x13); 287120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R1F_A_TEST_INTF_SEL, 0x00); 288120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R20_A_TEST_PIN_SEL, 0x00); 289120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf3); 290120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, 0x00); 291120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x80); 2929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 2939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 29429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Enables soft reset */ 2959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 29629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 29729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->scaler) { 2989afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20); 29929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } else { 30029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Enable Hfilter and disable TS Drop err */ 3019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80); 30229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 3039701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88); 3059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD8_IR_WAKEUP_SEL, 0x23); 3069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0); 3079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8); 3089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06); 3099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD8_IR_PULSE_CNT0, 0x1f); 3109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 31129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* AP Software reset */ 3129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 31529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_fourcc_format(dev); 3169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 31729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Disables soft reset */ 3189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 3199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 32029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* E3: Select input 0 - TV tuner */ 3219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RE3_OUT_SEL1, 0x00); 32229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xeb, 0x60); 3239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 32429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* This controls input */ 32529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_2, 0x0); 32629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_3, 0x01); 32729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 3289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(20); 3299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 33029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Tuner firmware can now be loaded */ 33129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 3329701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /*FIXME: Hack!!! */ 3339701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab struct v4l2_frequency f; 3349701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab mutex_lock(&dev->lock); 3359701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab f.frequency=dev->freq; 336427f7facb374b8651ff01b7700e690ef8ccae159Mauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 3379701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab mutex_unlock(&dev->lock); 3389701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3399701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(100); 3409701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab tm6000_set_standard (dev, &dev->norm); 3419701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab tm6000_set_audio_bitrate (dev,48000); 3429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 343f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led off */ 344f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 345f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 346f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x01); 347f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 348f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 3499701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 0; 3509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 3519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3523169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwigint tm6000_init_digital_mode (struct tm6000_core *dev) 3533169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig{ 354c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel if (dev->dev_type == TM6010) { 355c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel int val; 356c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel u8 buf[2]; 3573169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig 358c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel /* digital init */ 3599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0); 360c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel val &= ~0x60; 3619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val); 3629afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab val = tm6000_get_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0); 363c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel val |= 0x40; 3649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, val); 3659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28); 3669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc); 3679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff); 3689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfe); 369c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel tm6000_read_write_usb (dev, 0xc0, 0x0e, 0x00c2, 0x0008, buf, 2); 370c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel printk (KERN_INFO "buf %#x %#x \n", buf[0], buf[1]); 371c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel 372c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel 373c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } else { 3749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3769afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 3779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD8_IR_PULSE_CNT0, 0x08); 3789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RE2_OUT_SEL2, 0x0c); 3799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RE8_TYPESEL_MOS_I2S, 0xff); 380c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00eb, 0xd8); 3819afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40); 3829afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 3839afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09); 3849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD8_IR_WAKEUP_SEL, 0x37); 3859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8); 3869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0); 3879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60); 3889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 3899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RE2_OUT_SEL2, 0x0c); 3909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RE8_TYPESEL_MOS_I2S, 0xff); 391c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00eb, 0x08); 392c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 393c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel 394c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 395c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 396c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01); 397c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 398c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 399c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(100); 400c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } 401f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 402f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led on */ 403f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 404f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 405f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x00); 406f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 407f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 4083169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig return 0; 4093169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig} 4109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 41129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init { 41229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 req; 41329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 reg; 41429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 val; 41529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 41629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 4179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/* The meaning of those initializations are unknown */ 41829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init tm6000_init_tab[] = { 4199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* REG VALUE */ 4209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT0, 0x1f }, 4219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x08 }, 4229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x00 }, 4239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD5_POWERSAVE, 0x4f }, 4249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_WAKEUP_SEL, 0x23 }, 4259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_WAKEUP_ADD, 0x08 }, 4269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE2_OUT_SEL2, 0x00 }, 4279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE3_OUT_SEL1, 0x10 }, 4289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE5_REMOTE_WAKEUP, 0x00 }, 4299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE8_TYPESEL_MOS_I2S, 0x00 }, 43029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab { REQ_07_SET_GET_AVREG, 0xeb, 0x64 }, /* 48000 bits/sample, external input */ 43129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab { REQ_07_SET_GET_AVREG, 0xee, 0xc2 }, 4329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, /* Start of soft reset */ 4339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 4349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 4359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 4369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 4379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 4389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 4399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 4409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 4419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 4429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 4439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 4449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 4459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 4469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 4479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 4489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 4499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 4509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 4519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 4529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 4539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 4549afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 4559afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 4569afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 4579afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 4589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 4599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 4609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 4619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 4629afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 4639afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 4649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 4659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 4669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 4679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 4689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 4699afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 4709afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 4719afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 4729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 4739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 4749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 4759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 4769afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 4779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 4789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 4799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 4809afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 4819afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, /* End of the soft reset */ 4822415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 48329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 48429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 48529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init tm6010_init_tab[] = { 4869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 }, 4879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC4_HSTART0, 0xa0 }, 4889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC6_HEND0, 0x40 }, 4899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RCA_VEND0, 0x31 }, 4909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0xe1 }, 4919afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 }, 4929afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFE_POWER_DOWN, 0x7f }, 4939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 4949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 }, 4959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 }, 4969afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 }, 4979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 }, 4989afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 }, 4999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 }, 5009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 }, 5019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 }, 5029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc }, 5039afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 5049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, 5059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 5069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 5079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 5089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 5099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 5109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 5119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 5129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 5139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 5149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 5159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 5169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 5179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 5189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 5199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 5209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 5219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 5229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 5239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 5249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 5259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 5269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 5279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 5289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 5299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 5309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 5319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 5329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 5339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 5349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 5359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 5369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 5379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 5389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 5399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 5409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 5419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 5429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 5439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 5449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 5459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 5469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 5479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 5489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 5499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 5509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 5519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 5529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 5539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, 55429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5552415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 55629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5579afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_LEADER1, 0xaa }, 5589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_LEADER0, 0x30 }, 5599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT1, 0x20 }, 5609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT0, 0xd0 }, 561d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel { REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 }, 5629afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR, 0x2f }, 563d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel 56429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* set remote wakeup key:any key wakeup */ 5659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE5_REMOTE_WAKEUP, 0xfe }, 5669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_WAKEUP_SEL, 0xff }, 5679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}; 5689701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 5699701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabint tm6000_init (struct tm6000_core *dev) 5709701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 57129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab int board, rc=0, i, size; 57229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab struct reg_init *tab; 57329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 57429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 57529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab = tm6010_init_tab; 57629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab size = ARRAY_SIZE(tm6010_init_tab); 57729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } else { 57829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab = tm6000_init_tab; 57929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab size = ARRAY_SIZE(tm6000_init_tab); 58029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 5819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 5829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* Load board's initialization table */ 58329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab for (i=0; i< size; i++) { 58429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab rc= tm6000_set_reg (dev, tab[i].req, tab[i].reg, tab[i].val); 5859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (rc<0) { 58629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab printk (KERN_ERR "Error %i while setting req %d, " 58729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab "reg %d to value %d\n", rc, 58829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab[i].req,tab[i].reg, tab[i].val); 5899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 5909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 5919701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 5929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 59329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab msleep(5); /* Just to be conservative */ 59429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* Check board version - maybe 10Moons specific */ 5962f7908848642c177b16b71a2ed52b57d614637efStefan Ringel board=tm6000_get_reg32 (dev, REQ_40_GET_VERSION, 0, 0); 5979701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (board >=0) { 5982f7908848642c177b16b71a2ed52b57d614637efStefan Ringel printk (KERN_INFO "Board version = 0x%08x\n",board); 5999701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 6009701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk (KERN_ERR "Error %i while retrieving board version\n",board); 6019701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 6029701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 603e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab rc = tm6000_cards_setup(dev); 604a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 605e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab return rc; 6069701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 6079701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 60844351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho Chehabint tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate) 6099701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 6109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int val; 6119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6129701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab val=tm6000_get_reg (dev, REQ_07_SET_GET_AVREG, 0xeb, 0x0); 6139701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabprintk("Original value=%d\n",val); 6149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (val<0) 6159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return val; 6169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab val &= 0x0f; /* Preserve the audio input control bits */ 6189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab switch (bitrate) { 6199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab case 44100: 6209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab val|=0xd0; 621c13dd70411e87e1ad1ccca0ba9bc3cf0a555e5a0Mauro Carvalho Chehab dev->audio_bitrate=bitrate; 6229701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 6239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab case 48000: 6249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab val|=0x60; 625c13dd70411e87e1ad1ccca0ba9bc3cf0a555e5a0Mauro Carvalho Chehab dev->audio_bitrate=bitrate; 6269701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 6279701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 6289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab val=tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0xeb, val); 6299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6309701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return val; 6319701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 63244351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho ChehabEXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate); 6330439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6340439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_devlist); 6350439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic DEFINE_MUTEX(tm6000_devlist_mutex); 6360439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6370439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 6380439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * tm6000_realease_resource() 6390439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 6400439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6410439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_remove_from_devlist(struct tm6000_core *dev) 6420439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 6430439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 6440439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&dev->devlist); 6450439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 6460439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 6470439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6480439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_add_into_devlist(struct tm6000_core *dev) 6490439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 6500439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 6510439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&dev->devlist, &tm6000_devlist); 6520439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 6530439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 6540439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6550439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 6560439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * Extension interface 6570439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 6580439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6590439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_extension_devlist); 6600439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic DEFINE_MUTEX(tm6000_extension_devlist_lock); 6610439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6620439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelint tm6000_register_extension(struct tm6000_ops *ops) 6630439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 6640439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 6650439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6660439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 6670439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_extension_devlist_lock); 6680439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&ops->next, &tm6000_extension_devlist); 6690439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(dev, &tm6000_devlist, devlist) { 6700439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (dev) 6710439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->init(dev); 6720439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 6730439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel printk(KERN_INFO "tm6000: Initialized (%s) extension\n", ops->name); 6740439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_extension_devlist_lock); 6750439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 6760439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel return 0; 6770439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 6780439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_register_extension); 6790439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6800439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_unregister_extension(struct tm6000_ops *ops) 6810439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 6820439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 6830439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6840439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 6850439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(dev, &tm6000_devlist, devlist) { 6860439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (dev) 6870439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->fini(dev); 6880439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 6890439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6900439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_extension_devlist_lock); 6910439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name); 6920439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&ops->next); 6930439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_extension_devlist_lock); 6940439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 6950439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 6960439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_unregister_extension); 6970439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 6980439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_init_extension(struct tm6000_core *dev) 6990439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 7000439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 7010439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 7020439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_extension_devlist_lock); 7030439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 7040439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 7050439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->init) 7060439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->init(dev); 7070439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 7080439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 7090439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_extension_devlist_lock); 7100439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 7110439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 7120439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_close_extension(struct tm6000_core *dev) 7130439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 7140439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 7150439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 7160439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_extension_devlist_lock); 7170439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 7180439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 7190439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->fini) 7200439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->fini(dev); 7210439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 7220439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 7230439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_extension_devlist_lock); 7240439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 725