tm6000-core.c revision 873545820a52e8ab6f6d54a748b1759b98f9354a
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 if (req_type & USB_DIR_IN) 4652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov pipe = usb_rcvctrlpipe(dev->udev, 0); 479701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab else { 4852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov pipe = usb_sndctrlpipe(dev->udev, 0); 499701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab memcpy(data, buf, len); 509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 52edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab if (tm6000_debug & V4L2_DEBUG_I2C) { 53638054ab0276c40eca7cf49ae107e3d6f67ebf38Mauro Carvalho Chehab printk("(dev %p, pipe %08x): ", dev->udev, pipe); 549701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 55638054ab0276c40eca7cf49ae107e3d6f67ebf38Mauro Carvalho Chehab printk("%s: %02x %02x %02x %02x %02x %02x %02x %02x ", 5652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov (req_type & USB_DIR_IN) ? " IN" : "OUT", 5752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov req_type, req, value&0xff, value>>8, index&0xff, 5852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov index>>8, len&0xff, len>>8); 599701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (!(req_type & USB_DIR_IN)) { 619701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk(">>> "); 6252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < len; i++) 6352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov printk(" %02x", buf[i]); 643d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Reding printk("\n"); 659701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 669701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index, 6952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov data, len, USB_TIMEOUT); 709701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 719701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 729701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab memcpy(buf, data, len); 739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 74edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab if (tm6000_debug & V4L2_DEBUG_I2C) { 7552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (ret < 0) { 769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 7752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov printk("<<< (len=%d)\n", len); 789701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 799701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("%s: Error #%d\n", __FUNCTION__, ret); 809701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else if (req_type & USB_DIR_IN) { 819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("<<< "); 8252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < len; i++) 8352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov printk(" %02x", buf[i]); 849701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab printk("\n"); 859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 869701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 879701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 889701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab kfree(data); 899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 90a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig msleep(5); 91a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return ret; 939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 9552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_set_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index) 969701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 979701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 9852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR, 9952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov req, value, index, NULL, 0); 1009701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 10129ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_set_reg); 1029701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 10352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1049701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1059701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int rc; 1069701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 buf[1]; 1079701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 10852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 10952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov value, index, buf, 1); 1109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 11152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) 1129701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 1139701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return *buf; 1159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 11629ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_get_reg); 1179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1188aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovint tm6000_set_reg_mask(struct tm6000_core *dev, u8 req, u16 value, 1198aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u16 index, u16 mask) 1208aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 1218aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov int rc; 1228aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 buf[1]; 1238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 new_index; 1248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1258aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 1268aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov value, index, buf, 1); 1278aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (rc < 0) 1298aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return rc; 1308aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1318aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov new_index = (buf[0] & ~mask) | (index & mask); 1328aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (new_index == index) 1348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 1358aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1368aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR, 1378aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov req, value, new_index, NULL, 0); 1388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 1398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri BelimovEXPORT_SYMBOL_GPL(tm6000_set_reg_mask); 1408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 14152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg16(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1439701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int rc; 1449701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 buf[2]; 1459701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 14652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 14752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov value, index, buf, 2); 1489701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 14952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) 1509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 1519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1529701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return buf[1]|buf[0]<<8; 1539701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 1549701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 15552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg32(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1562f7908848642c177b16b71a2ed52b57d614637efStefan Ringel{ 1572f7908848642c177b16b71a2ed52b57d614637efStefan Ringel int rc; 1582f7908848642c177b16b71a2ed52b57d614637efStefan Ringel u8 buf[4]; 1592f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 16052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 16152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov value, index, buf, 4); 1622f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 16352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) 1642f7908848642c177b16b71a2ed52b57d614637efStefan Ringel return rc; 1652f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1662f7908848642c177b16b71a2ed52b57d614637efStefan Ringel return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24; 1672f7908848642c177b16b71a2ed52b57d614637efStefan Ringel} 1682f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1692a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimovint tm6000_i2c_reset(struct tm6000_core *dev, u16 tsleep) 1702a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov{ 1712a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov int rc; 1722a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1732a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 0); 1742a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov if (rc < 0) 1752a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov return rc; 1762a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1772a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov msleep(tsleep); 1782a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1792a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 1); 1802a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov msleep(tsleep); 1812a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1822a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov return rc; 1832a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov} 1842a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabvoid tm6000_set_fourcc_format(struct tm6000_core *dev) 1869701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 187717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 1884223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab int val; 1894223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab 1904129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, 0) & 0xfc; 191717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 1924129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, val); 193717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 1944129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, val | 1); 1959701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 196717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 1979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 198717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 1999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0x90); 2009701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 2019701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 2029701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 203589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehabstatic void tm6000_set_vbi(struct tm6000_core *dev) 2049701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 205589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab /* 206589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * FIXME: 207589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * VBI lines and start/end are different between 60Hz and 50Hz 208589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * So, it is very likely that we need to change the config to 209589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * something that takes it into account, doing something different 210589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * if (dev->norm & V4L2_STD_525_60) 211589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab */ 21294d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab 21329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 214120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 215120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R41_TELETEXT_VBI_CODE1, 0x27); 216120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55); 217120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R43_VBI_DATA_TYPE_LINE7, 0x66); 218120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R44_VBI_DATA_TYPE_LINE8, 0x66); 219120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R45_VBI_DATA_TYPE_LINE9, 0x66); 220120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 221120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R46_VBI_DATA_TYPE_LINE10, 0x66); 222120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 223120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R47_VBI_DATA_TYPE_LINE11, 0x66); 224120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 225120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R48_VBI_DATA_TYPE_LINE12, 0x66); 226120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 227120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R49_VBI_DATA_TYPE_LINE13, 0x66); 228120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 229120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4A_VBI_DATA_TYPE_LINE14, 0x66); 230120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 231120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4B_VBI_DATA_TYPE_LINE15, 0x66); 232120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 233120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4C_VBI_DATA_TYPE_LINE16, 0x66); 234120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 235120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4D_VBI_DATA_TYPE_LINE17, 0x66); 236120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 237120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4E_VBI_DATA_TYPE_LINE18, 0x66); 238120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 239120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4F_VBI_DATA_TYPE_LINE19, 0x66); 240120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 241120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R50_VBI_DATA_TYPE_LINE20, 0x66); 242120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 243120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x66); 244120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 245120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R52_VBI_DATA_TYPE_LINE22, 0x66); 246120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 247120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R53_VBI_DATA_TYPE_LINE23, 0x00); 248120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 249120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R54_VBI_DATA_TYPE_RLINES, 0x00); 250120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 251120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01); 252120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 253120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R56_VBI_LOOP_FILTER_I_GAIN, 0x00); 254120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 255120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02); 256120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35); 257120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0); 258120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R5A_VBI_TELETEXT_DTO1, 0x11); 259120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R5B_VBI_TELETEXT_DTO0, 0x4c); 260120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R40_TELETEXT_VBI_CODE0, 0x01); 261120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 262589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab } 263589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab} 264589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab 265589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehabint tm6000_init_analog_mode(struct tm6000_core *dev) 266589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab{ 267589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab struct v4l2_frequency f; 268589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab 269589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab if (dev->dev_type == TM6010) { 270873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding u8 active = TM6010_REQ07_RCC_ACTIVE_IF_AUDIO_ENABLE; 271873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding 272873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding if (!dev->radio) 273873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding active |= TM6010_REQ07_RCC_ACTIVE_IF_VIDEO_ENABLE; 274873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding 275f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Enable video and audio */ 2764129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_IF, 277873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding active, 0x60); 278f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable TS input */ 2798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 2808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 0x00, 0x40); 2819701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 28229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Enables soft reset */ 2839afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 28429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 28552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (dev->scaler) 286f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable Hfilter and Enable TS Drop err */ 2879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20); 28852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov else /* Enable Hfilter and disable TS Drop err */ 2899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80); 2909701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 2919afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88); 2929839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x23); 2939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0); 2949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8); 2959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06); 2969839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f); 2979701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 29829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* AP Software reset */ 2999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3019701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 30229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_fourcc_format(dev); 3039701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 30429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Disables soft reset */ 3059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 30629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 3079701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(20); 3089701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 30929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Tuner firmware can now be loaded */ 31029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 31194d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab /* 31294d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * FIXME: This is a hack! xc3028 "sleeps" when no channel is detected 31394d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * for more than a few seconds. Not sure why, as this behavior does 31494d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * not happen on other devices with xc3028. So, I suspect that it 3153d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Reding * is yet another bug at tm6000. After start sleeping, decoding 31694d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * doesn't start automatically. Instead, it requires some 31794d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * I2C commands to wake it up. As we want to have image at the 31894d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * beginning, we needed to add this hack. The better would be to 31994d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * discover some way to make tm6000 to wake up without this hack. 32094d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab */ 32152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov f.frequency = dev->freq; 322427f7facb374b8651ff01b7700e690ef8ccae159Mauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 3239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(100); 3250f6040e8929731d4294f1cffdbcb9be1523d60f0Stefan Ringel tm6000_set_standard(dev); 326589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab tm6000_set_vbi(dev); 32752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_audio_bitrate(dev, 48000); 3289701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 329f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led off */ 330f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 331f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 332f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x01); 333f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 334f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 3359701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 0; 3369701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 3379701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 33852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init_digital_mode(struct tm6000_core *dev) 3393169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig{ 340c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel if (dev->dev_type == TM6010) { 341f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable video and audio */ 3424129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_IF, 343f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel 0x00, 0x60); 344f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Enable TS input */ 345f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 346f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel 0x40, 0x40); 347f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* all power down, but not the digital data port */ 3489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28); 3499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc); 3509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff); 351c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } else { 3529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3549afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 3559839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x08); 3569839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c); 3579839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff); 3589839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0xd8); 3599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40); 3609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 3619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09); 3629839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x37); 3639afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8); 3649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0); 3659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60); 3669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 3679839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c); 3689839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff); 3699839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x08); 370c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 371c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel 37252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 373c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 37452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01); 375c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 37652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 377c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(100); 378c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } 379f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 380f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led on */ 381f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 382f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 383f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x00); 384f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 385f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 3863169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig return 0; 3873169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig} 388cee3926f5f245811ef7172405253815e7f3e15e1Stefan RingelEXPORT_SYMBOL(tm6000_init_digital_mode); 3899701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 39029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init { 39129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 req; 39229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 reg; 39329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 val; 39429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 39529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 3969701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/* The meaning of those initializations are unknown */ 3973d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic struct reg_init tm6000_init_tab[] = { 3989701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* REG VALUE */ 3999839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f }, 4009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x08 }, 4019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x00 }, 4029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD5_POWERSAVE, 0x4f }, 4039839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDA_CLK_SEL, 0x23 }, 4049839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDB_OUT_SEL, 0x08 }, 4059839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x00 }, 4069839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10 }, 4079839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00 }, 4089839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00 }, 4099839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_REB_VADC_AADC_MODE, 0x64 }, /* 48000 bits/sample, external input */ 4109839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_REE_VADC_CTRL_SEL_CONTROL, 0xc2 }, 4119839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel 4129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, /* Start of soft reset */ 4139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 4149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 4159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 4169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 4179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 4189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 4199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 4209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 4219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 4229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 4239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 4249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 4259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 4269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 4279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 4289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 4299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 4309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 4319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 4329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 4339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 4349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 4359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 4369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 4379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 4389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 4399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 4409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 4419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 4429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 4439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 4449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 4459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 4469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 4479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 4489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 4499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 4509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 4519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 4529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 4539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 4549afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 4559afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 4569afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 4579afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 4589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 4599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 4609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 4619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, /* End of the soft reset */ 4622415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 46329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 46429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 4653d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic struct reg_init tm6010_init_tab[] = { 4669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 }, 4679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC4_HSTART0, 0xa0 }, 4689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC6_HEND0, 0x40 }, 4699afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RCA_VEND0, 0x31 }, 4704129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding { TM6010_REQ07_RCC_ACTIVE_IF, 0xe1 }, 4719afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 }, 4729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFE_POWER_DOWN, 0x7f }, 4739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 4749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 }, 4759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 }, 4769afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 }, 4779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 }, 4789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 }, 4799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 }, 4809afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 }, 4819afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 }, 4829afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc }, 4839afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 4849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, 4859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 4869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 4879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 4889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 4899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 4909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 4919afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 4929afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 4939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 4949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 4959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 4969afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 4979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 4989afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 4999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 5009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 5019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 5029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 5039afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 5049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 5059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 5069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 5079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 5089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 5099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 5109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 5119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 5129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 5139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 5149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 5159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 5169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 5179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 5189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 5199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 5209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 5219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 5229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 5239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 5249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 5259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 5269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 5279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 5289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 5299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 5309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 5319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 5329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 5339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, 53429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5352415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 53629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_LEADER1, 0xaa }, 5389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_LEADER0, 0x30 }, 5399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT1, 0x20 }, 5409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT0, 0xd0 }, 541d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel { REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 }, 5429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR, 0x2f }, 543d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel 54429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* set remote wakeup key:any key wakeup */ 5459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE5_REMOTE_WAKEUP, 0xfe }, 5469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_WAKEUP_SEL, 0xff }, 5479701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}; 5489701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 54952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init(struct tm6000_core *dev) 5509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 55152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov int board, rc = 0, i, size; 55229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab struct reg_init *tab; 55329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 554c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel /* Check board revision */ 555c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel board = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0); 556c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (board >= 0) { 557c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel switch (board & 0xff) { 558c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel case 0xf3: 559c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Found tm6000\n"); 560c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (dev->dev_type != TM6000) 561c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel dev->dev_type = TM6000; 562c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel break; 563c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel case 0xf4: 564c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Found tm6010\n"); 565c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (dev->dev_type != TM6010) 566c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel dev->dev_type = TM6010; 567c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel break; 568c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel default: 569c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Unknown board version = 0x%08x\n", board); 570c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel } 571c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel } else 572c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_ERR "Error %i while retrieving board version\n", board); 573c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel 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 */ 58352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < size; i++) { 58452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_set_reg(dev, tab[i].req, tab[i].reg, tab[i].val); 58552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) { 58652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov printk(KERN_ERR "Error %i while setting req %d, " 58752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov "reg %d to value %d\n", rc, 58852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov 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 595e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab rc = tm6000_cards_setup(dev); 596a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 597e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab return rc; 5989701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 5999701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 60044351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho Chehabint tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate) 6019701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 6028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov int val = 0; 6038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */ 6048aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 areg_0a = 0x91; /* SIF 48KHz */ 6058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov switch (bitrate) { 6078aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov case 48000: 6088aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x60; /* ADC MCLK = 250 Fs */ 6098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_0a = 0x91; /* SIF 48KHz */ 6108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov dev->audio_bitrate = bitrate; 6118aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6128aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov case 32000: 6138aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x00; /* ADC MCLK = 375 Fs */ 6148aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_0a = 0x90; /* SIF 32KHz */ 6158aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov dev->audio_bitrate = bitrate; 6168aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6178aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 6188aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 6198aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6208aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6229839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel /* enable I2S, if we use sif or external I2S device */ 623a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab if (dev->dev_type == TM6010) { 6248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, areg_0a); 625a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab if (val < 0) 626a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab return val; 627a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab 6288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 6298aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0xf0); 6309839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel if (val < 0) 6319839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel return val; 6329839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel } else { 6338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 6348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0xf0); 6359839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel if (val < 0) 6369839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel return val; 6379839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel } 6388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 6408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri BelimovEXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate); 6419701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6420f6040e8929731d4294f1cffdbcb9be1523d60f0Stefan Ringelint tm6000_set_audio_rinput(struct tm6000_core *dev) 6438aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 6448aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 6458aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Audio crossbar setting, default SIF1 */ 646fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel u8 areg_f0; 6478aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 648fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (dev->rinput.amux) { 649fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 650fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 6518aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x03; 6528aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 653fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 6548aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x00; 6558aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 656fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 6578aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x08; 6588aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 659fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_I2S: 660fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel areg_f0 = 0x04; 661fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel break; 6628aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 663fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel printk(KERN_INFO "%s: audio input dosn't support\n", 664fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel dev->name); 6658aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6668aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6678aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6688aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Set audio input crossbar */ 6698aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 6708aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0x0f); 6718aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 672fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel u8 areg_eb; 6738aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Audio setting, default LINE1 */ 674fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (dev->rinput.amux) { 675fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 6768aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb = 0x00; 6778aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 678fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 6798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb = 0x04; 6808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6818aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 682fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel printk(KERN_INFO "%s: audio input dosn't support\n", 683fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel dev->name); 6848aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6858aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6868aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6878aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Set audio input */ 6888aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 6898aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb, 0x0f); 6908aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6918aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6928aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 6938aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6943d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_mute_sif(struct tm6000_core *dev, u8 mute) 6958aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 6968aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 mute_reg = 0; 6978aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (mute) 6998aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg = 0x08; 7008aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_R0A_A_I2S_MOD, mute_reg, 0x08); 7028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7043d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_mute_adc(struct tm6000_core *dev, u8 mute) 7058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 mute_reg = 0; 7078aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7088aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (mute) 7098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg = 0x20; 7108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7118aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 7128aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, 7138aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7148aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, 7158aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7168aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 7178aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, 7188aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7198aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, 7208aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7218aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7228aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovint tm6000_tvaudio_set_mute(struct tm6000_core *dev, u8 mute) 7258aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 726fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel enum tm6000_mux mux; 7278aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->radio) 729fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->rinput.amux; 7308aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else 731fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->vinput[dev->input].amux; 7328aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 733fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (mux) { 734fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 735fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 7368aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) 7378aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_mute_sif(dev, mute); 7388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else { 7398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has" 7408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " SIF audio inputs. Please check the %s" 7418aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " configuration.\n", dev->name); 7428aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 7438aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7449701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 745fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 746fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 7478aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_mute_adc(dev, mute); 7488aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 7498aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 7508aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 7519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 7529701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 7538aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 7548aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7558aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7563d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_volume_sif(struct tm6000_core *dev, int vol) 7578aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7588aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 vol_reg; 7599701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 7608aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg = vol & 0x0F; 7618aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7628aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (vol < 0) 7638aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg |= 0x40; 7648aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7658aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, vol_reg); 7668aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, vol_reg); 7679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 7688aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7693d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_volume_adc(struct tm6000_core *dev, int vol) 7708aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7718aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 vol_reg; 7728aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7738aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg = (vol + 0x10) & 0x1f; 7748aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7758aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 7768aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, vol_reg); 7778aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, vol_reg); 7788aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 7798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, vol_reg); 7808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, vol_reg); 7818aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7828aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7838aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7848aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovvoid tm6000_set_volume(struct tm6000_core *dev, int vol) 7858aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 786fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel enum tm6000_mux mux; 7878aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7888aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->radio) { 789fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->rinput.amux; 7908aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol += 8; /* Offset to 0 dB */ 7918aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else 792fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->vinput[dev->input].amux; 7938aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 794fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (mux) { 795fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 796fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 7978aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) 7988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_volume_sif(dev, vol); 7998aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else 8008aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has" 8018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " SIF audio inputs. Please check the %s" 8028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " configuration.\n", dev->name); 8038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 804fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 805fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 8068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_volume_adc(dev, vol); 8078aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 8088aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 8098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 8108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 8118aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 8120439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8130439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_devlist); 8140439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic DEFINE_MUTEX(tm6000_devlist_mutex); 8150439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8160439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 8170439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * tm6000_realease_resource() 8180439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 8190439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8200439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_remove_from_devlist(struct tm6000_core *dev) 8210439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8220439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8230439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&dev->devlist); 8240439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8250439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 8260439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8270439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_add_into_devlist(struct tm6000_core *dev) 8280439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8290439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8300439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&dev->devlist, &tm6000_devlist); 8310439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8320439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 8330439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8340439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 8350439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * Extension interface 8360439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 8370439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8380439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_extension_devlist); 8390439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 840b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehabint tm6000_call_fillbuf(struct tm6000_core *dev, enum tm6000_ops_type type, 841b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab char *buf, int size) 842b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab{ 843b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab struct tm6000_ops *ops = NULL; 844b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 845b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab /* FIXME: tm6000_extension_devlist_lock should be a spinlock */ 846b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 847b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab if (!list_empty(&tm6000_extension_devlist)) { 848b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab list_for_each_entry(ops, &tm6000_extension_devlist, next) { 849b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab if (ops->fillbuf && ops->type == type) 850b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab ops->fillbuf(dev, buf, size); 851b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab } 852b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab } 853b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 854b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab return 0; 855b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab} 856b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 8570439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelint tm6000_register_extension(struct tm6000_ops *ops) 8580439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8590439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 8600439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8610439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8620439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&ops->next, &tm6000_extension_devlist); 8630439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(dev, &tm6000_devlist, devlist) { 8643f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab ops->init(dev); 8653f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab printk(KERN_INFO "%s: Initialized (%s) extension\n", 8663f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab dev->name, ops->name); 8670439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8680439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8690439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel return 0; 8700439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 8710439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_register_extension); 8720439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8730439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_unregister_extension(struct tm6000_ops *ops) 8740439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8750439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 8760439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8770439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 878a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall list_for_each_entry(dev, &tm6000_devlist, devlist) 879a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall ops->fini(dev); 8800439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8810439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name); 8820439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&ops->next); 8830439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8840439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 8850439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_unregister_extension); 8860439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8870439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_init_extension(struct tm6000_core *dev) 8880439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8890439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 8900439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8914ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_lock(&tm6000_devlist_mutex); 8920439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 8930439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 8940439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->init) 8950439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->init(dev); 8960439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8970439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8984ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_unlock(&tm6000_devlist_mutex); 8990439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 9000439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9010439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_close_extension(struct tm6000_core *dev) 9020439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 9030439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 9040439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9054ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_lock(&tm6000_devlist_mutex); 9060439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 9070439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 9080439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->fini) 9090439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->fini(dev); 9100439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 9110439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 912427aacfe1d0c540bf80e5243d18ba1272f9b756fDmitri Belimov mutex_unlock(&tm6000_devlist_mutex); 9130439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 914