tm6000-core.c revision 3d1a51db7e908cd7b3440ecb4cbf00f15a8f33bf
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 1904223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0) & 0xfc; 191717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 1924223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val); 193717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 1944223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_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) { 270f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Enable video and audio */ 2718aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 2728aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 0x60, 0x60); 273f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable TS input */ 2748aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 2758aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 0x00, 0x40); 2769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 27729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Enables soft reset */ 2789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 27929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 28052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (dev->scaler) 281f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable Hfilter and Enable TS Drop err */ 2829afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20); 28352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov else /* Enable Hfilter and disable TS Drop err */ 2849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80); 2859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 2869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88); 2879839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x23); 2889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0); 2899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8); 2909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06); 2919839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f); 2929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 29329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* AP Software reset */ 2949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 2959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 2969701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 29729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_fourcc_format(dev); 2989701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 29929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Disables soft reset */ 3009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 30129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 3029701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(20); 3039701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 30429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Tuner firmware can now be loaded */ 30529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 30694d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab /* 30794d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * FIXME: This is a hack! xc3028 "sleeps" when no channel is detected 30894d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * for more than a few seconds. Not sure why, as this behavior does 30994d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * not happen on other devices with xc3028. So, I suspect that it 3103d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Reding * is yet another bug at tm6000. After start sleeping, decoding 31194d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * doesn't start automatically. Instead, it requires some 31294d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * I2C commands to wake it up. As we want to have image at the 31394d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * beginning, we needed to add this hack. The better would be to 31494d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * discover some way to make tm6000 to wake up without this hack. 31594d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab */ 31652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov f.frequency = dev->freq; 317427f7facb374b8651ff01b7700e690ef8ccae159Mauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 3189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(100); 3200f6040e8929731d4294f1cffdbcb9be1523d60f0Stefan Ringel tm6000_set_standard(dev); 321589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab tm6000_set_vbi(dev); 32252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_audio_bitrate(dev, 48000); 3239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 324f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led off */ 325f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 326f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 327f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x01); 328f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 329f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 3309701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 0; 3319701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 3329701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 33352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init_digital_mode(struct tm6000_core *dev) 3343169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig{ 335c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel if (dev->dev_type == TM6010) { 336f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable video and audio */ 337f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 338f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel 0x00, 0x60); 339f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Enable TS input */ 340f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 341f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel 0x40, 0x40); 342f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* all power down, but not the digital data port */ 3439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28); 3449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc); 3459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff); 346c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } else { 3479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 3509839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x08); 3519839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c); 3529839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff); 3539839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0xd8); 3549afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40); 3559afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 3569afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09); 3579839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x37); 3589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8); 3599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0); 3609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60); 3619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 3629839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c); 3639839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff); 3649839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x08); 365c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 366c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel 36752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 368c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 36952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01); 370c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 37152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 372c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(100); 373c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } 374f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 375f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led on */ 376f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 377f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 378f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x00); 379f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 380f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 3813169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig return 0; 3823169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig} 383cee3926f5f245811ef7172405253815e7f3e15e1Stefan RingelEXPORT_SYMBOL(tm6000_init_digital_mode); 3849701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 38529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init { 38629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 req; 38729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 reg; 38829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 val; 38929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 39029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 3919701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/* The meaning of those initializations are unknown */ 3923d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic struct reg_init tm6000_init_tab[] = { 3939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* REG VALUE */ 3949839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f }, 3959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x08 }, 3969afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x00 }, 3979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD5_POWERSAVE, 0x4f }, 3989839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDA_CLK_SEL, 0x23 }, 3999839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDB_OUT_SEL, 0x08 }, 4009839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x00 }, 4019839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10 }, 4029839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00 }, 4039839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00 }, 4049839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_REB_VADC_AADC_MODE, 0x64 }, /* 48000 bits/sample, external input */ 4059839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_REE_VADC_CTRL_SEL_CONTROL, 0xc2 }, 4069839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel 4079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, /* Start of soft reset */ 4089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 4099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 4109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 4119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 4129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 4139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 4149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 4159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 4169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 4179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 4189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 4199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 4209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 4219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 4229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 4239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 4249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 4259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 4269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 4279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 4289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 4299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 4309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 4319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 4329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 4339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 4349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 4359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 4369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 4379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 4389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 4399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 4409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 4419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 4429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 4439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 4449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 4459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 4469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 4479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 4489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 4499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 4509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 4519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 4529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 4539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 4549afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 4559afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 4569afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, /* End of the soft reset */ 4572415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 45829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 45929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 4603d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic struct reg_init tm6010_init_tab[] = { 4619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 }, 4629afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC4_HSTART0, 0xa0 }, 4639afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC6_HEND0, 0x40 }, 4649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RCA_VEND0, 0x31 }, 4659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0xe1 }, 4669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 }, 4679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFE_POWER_DOWN, 0x7f }, 4689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 4699afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 }, 4709afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 }, 4719afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 }, 4729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 }, 4739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 }, 4749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 }, 4759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 }, 4769afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 }, 4779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc }, 4789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 4799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, 4809afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 4819afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 4829afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 4839afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 4849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 4859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 4869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 4879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 4889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 4899afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 4909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 4919afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 4929afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 4939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 4949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 4959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 4969afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 4979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 4989afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 4999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 5009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 5019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 5029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 5039afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 5049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 5059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 5069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 5079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 5089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 5099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 5109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 5119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 5129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 5139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 5149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 5159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 5169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 5179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 5189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 5199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 5209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 5219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 5229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 5239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 5249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 5259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 5269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 5279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 5289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, 52929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5302415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 53129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_LEADER1, 0xaa }, 5339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_LEADER0, 0x30 }, 5349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT1, 0x20 }, 5359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_PULSE_CNT0, 0xd0 }, 536d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel { REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 }, 5379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR, 0x2f }, 538d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel 53929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* set remote wakeup key:any key wakeup */ 5409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE5_REMOTE_WAKEUP, 0xfe }, 5419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD8_IR_WAKEUP_SEL, 0xff }, 5429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}; 5439701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 54452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init(struct tm6000_core *dev) 5459701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 54652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov int board, rc = 0, i, size; 54729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab struct reg_init *tab; 54829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 549c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel /* Check board revision */ 550c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel board = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0); 551c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (board >= 0) { 552c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel switch (board & 0xff) { 553c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel case 0xf3: 554c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Found tm6000\n"); 555c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (dev->dev_type != TM6000) 556c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel dev->dev_type = TM6000; 557c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel break; 558c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel case 0xf4: 559c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Found tm6010\n"); 560c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (dev->dev_type != TM6010) 561c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel dev->dev_type = TM6010; 562c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel break; 563c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel default: 564c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Unknown board version = 0x%08x\n", board); 565c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel } 566c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel } else 567c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_ERR "Error %i while retrieving board version\n", board); 568c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel 56929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 57029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab = tm6010_init_tab; 57129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab size = ARRAY_SIZE(tm6010_init_tab); 57229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } else { 57329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab = tm6000_init_tab; 57429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab size = ARRAY_SIZE(tm6000_init_tab); 57529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 5769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 5779701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* Load board's initialization table */ 57852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < size; i++) { 57952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_set_reg(dev, tab[i].req, tab[i].reg, tab[i].val); 58052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) { 58152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov printk(KERN_ERR "Error %i while setting req %d, " 58252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov "reg %d to value %d\n", rc, 58352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tab[i].req, tab[i].reg, tab[i].val); 5849701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 5859701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 5869701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 5879701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 58829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab msleep(5); /* Just to be conservative */ 58929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 590e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab rc = tm6000_cards_setup(dev); 591a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 592e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab return rc; 5939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 5949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 59544351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho Chehabint tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate) 5969701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 5978aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov int val = 0; 5988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */ 5998aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 areg_0a = 0x91; /* SIF 48KHz */ 6008aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov switch (bitrate) { 6028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov case 48000: 6038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x60; /* ADC MCLK = 250 Fs */ 6048aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_0a = 0x91; /* SIF 48KHz */ 6058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov dev->audio_bitrate = bitrate; 6068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6078aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov case 32000: 6088aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x00; /* ADC MCLK = 375 Fs */ 6098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_0a = 0x90; /* SIF 32KHz */ 6108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov dev->audio_bitrate = bitrate; 6118aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6128aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 6138aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 6148aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6158aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6179839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel /* enable I2S, if we use sif or external I2S device */ 618a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab if (dev->dev_type == TM6010) { 6198aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, areg_0a); 620a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab if (val < 0) 621a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab return val; 622a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab 6238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 6248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0xf0); 6259839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel if (val < 0) 6269839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel return val; 6279839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel } else { 6288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 6298aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0xf0); 6309839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel if (val < 0) 6319839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel return val; 6329839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel } 6338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 6358aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri BelimovEXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate); 6369701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6370f6040e8929731d4294f1cffdbcb9be1523d60f0Stefan Ringelint tm6000_set_audio_rinput(struct tm6000_core *dev) 6388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 6398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 6408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Audio crossbar setting, default SIF1 */ 641fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel u8 areg_f0; 6428aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 643fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (dev->rinput.amux) { 644fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 645fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 6468aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x03; 6478aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 648fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 6498aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x00; 6508aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 651fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 6528aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x08; 6538aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 654fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_I2S: 655fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel areg_f0 = 0x04; 656fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel break; 6578aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 658fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel printk(KERN_INFO "%s: audio input dosn't support\n", 659fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel dev->name); 6608aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6618aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6628aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6638aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Set audio input crossbar */ 6648aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 6658aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0x0f); 6668aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 667fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel u8 areg_eb; 6688aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Audio setting, default LINE1 */ 669fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (dev->rinput.amux) { 670fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 6718aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb = 0x00; 6728aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 673fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 6748aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb = 0x04; 6758aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6768aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 677fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel printk(KERN_INFO "%s: audio input dosn't support\n", 678fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel dev->name); 6798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6818aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6828aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Set audio input */ 6838aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 6848aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb, 0x0f); 6858aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6868aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6878aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 6888aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6893d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_mute_sif(struct tm6000_core *dev, u8 mute) 6908aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 6918aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 mute_reg = 0; 6928aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6938aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (mute) 6948aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg = 0x08; 6958aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6968aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_R0A_A_I2S_MOD, mute_reg, 0x08); 6978aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 6988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6993d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_mute_adc(struct tm6000_core *dev, u8 mute) 7008aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 mute_reg = 0; 7028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (mute) 7048aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg = 0x20; 7058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 7078aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, 7088aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, 7108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7118aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 7128aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, 7138aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7148aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, 7158aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7168aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7178aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7188aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7198aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovint tm6000_tvaudio_set_mute(struct tm6000_core *dev, u8 mute) 7208aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 721fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel enum tm6000_mux mux; 7228aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->radio) 724fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->rinput.amux; 7258aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else 726fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->vinput[dev->input].amux; 7278aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 728fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (mux) { 729fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 730fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 7318aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) 7328aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_mute_sif(dev, mute); 7338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else { 7348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has" 7358aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " SIF audio inputs. Please check the %s" 7368aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " configuration.\n", dev->name); 7378aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 7388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7399701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 740fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 741fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 7428aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_mute_adc(dev, mute); 7438aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 7448aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 7458aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 7469701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 7479701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 7488aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 7498aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7508aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7513d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_volume_sif(struct tm6000_core *dev, int vol) 7528aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7538aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 vol_reg; 7549701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 7558aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg = vol & 0x0F; 7568aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7578aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (vol < 0) 7588aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg |= 0x40; 7598aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7608aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, vol_reg); 7618aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, vol_reg); 7629701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 7638aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7643d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_volume_adc(struct tm6000_core *dev, int vol) 7658aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7668aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 vol_reg; 7678aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7688aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg = (vol + 0x10) & 0x1f; 7698aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7708aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 7718aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, vol_reg); 7728aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, vol_reg); 7738aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 7748aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, vol_reg); 7758aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, vol_reg); 7768aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7778aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7788aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovvoid tm6000_set_volume(struct tm6000_core *dev, int vol) 7808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 781fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel enum tm6000_mux mux; 7828aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7838aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->radio) { 784fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->rinput.amux; 7858aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol += 8; /* Offset to 0 dB */ 7868aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else 787fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->vinput[dev->input].amux; 7888aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 789fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (mux) { 790fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 791fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 7928aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) 7938aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_volume_sif(dev, vol); 7948aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else 7958aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has" 7968aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " SIF audio inputs. Please check the %s" 7978aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " configuration.\n", dev->name); 7988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 799fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 800fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 8018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_volume_adc(dev, vol); 8028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 8038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 8048aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 8058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 8068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 8070439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8080439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_devlist); 8090439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic DEFINE_MUTEX(tm6000_devlist_mutex); 8100439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8110439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 8120439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * tm6000_realease_resource() 8130439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 8140439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8150439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_remove_from_devlist(struct tm6000_core *dev) 8160439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8170439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8180439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&dev->devlist); 8190439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8200439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 8210439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8220439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_add_into_devlist(struct tm6000_core *dev) 8230439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8240439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8250439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&dev->devlist, &tm6000_devlist); 8260439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8270439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 8280439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8290439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 8300439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * Extension interface 8310439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 8320439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8330439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_extension_devlist); 8340439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 835b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehabint tm6000_call_fillbuf(struct tm6000_core *dev, enum tm6000_ops_type type, 836b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab char *buf, int size) 837b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab{ 838b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab struct tm6000_ops *ops = NULL; 839b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 840b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab /* FIXME: tm6000_extension_devlist_lock should be a spinlock */ 841b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 842b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab if (!list_empty(&tm6000_extension_devlist)) { 843b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab list_for_each_entry(ops, &tm6000_extension_devlist, next) { 844b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab if (ops->fillbuf && ops->type == type) 845b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab ops->fillbuf(dev, buf, size); 846b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab } 847b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab } 848b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 849b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab return 0; 850b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab} 851b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 8520439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelint tm6000_register_extension(struct tm6000_ops *ops) 8530439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8540439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 8550439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8560439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8570439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&ops->next, &tm6000_extension_devlist); 8580439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(dev, &tm6000_devlist, devlist) { 8593f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab ops->init(dev); 8603f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab printk(KERN_INFO "%s: Initialized (%s) extension\n", 8613f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab dev->name, ops->name); 8620439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8630439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8640439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel return 0; 8650439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 8660439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_register_extension); 8670439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8680439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_unregister_extension(struct tm6000_ops *ops) 8690439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8700439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 8710439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8720439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 873a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall list_for_each_entry(dev, &tm6000_devlist, devlist) 874a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall ops->fini(dev); 8750439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8760439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name); 8770439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&ops->next); 8780439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8790439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 8800439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_unregister_extension); 8810439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8820439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_init_extension(struct tm6000_core *dev) 8830439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8840439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 8850439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8864ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_lock(&tm6000_devlist_mutex); 8870439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 8880439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 8890439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->init) 8900439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->init(dev); 8910439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8920439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8934ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_unlock(&tm6000_devlist_mutex); 8940439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 8950439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8960439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_close_extension(struct tm6000_core *dev) 8970439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8980439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 8990439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9004ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_lock(&tm6000_devlist_mutex); 9010439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 9020439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 9030439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->fini) 9040439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->fini(dev); 9050439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 9060439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 907427aacfe1d0c540bf80e5243d18ba1272f9b756fDmitri Belimov mutex_unlock(&tm6000_devlist_mutex); 9080439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 909