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; 413874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET int delay = 5000; 429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 4388b404c435ffb6c103faf85cc1b41077dcd03bf9Dan Carpenter if (len) { 449701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab data = kzalloc(len, GFP_KERNEL); 4588b404c435ffb6c103faf85cc1b41077dcd03bf9Dan Carpenter if (!data) 4688b404c435ffb6c103faf85cc1b41077dcd03bf9Dan Carpenter return -ENOMEM; 4788b404c435ffb6c103faf85cc1b41077dcd03bf9Dan Carpenter } 4888b404c435ffb6c103faf85cc1b41077dcd03bf9Dan Carpenter 4988b404c435ffb6c103faf85cc1b41077dcd03bf9Dan Carpenter mutex_lock(&dev->usb_lock); 509701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 519701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 5252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov pipe = usb_rcvctrlpipe(dev->udev, 0); 539701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab else { 5452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov pipe = usb_sndctrlpipe(dev->udev, 0); 559701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab memcpy(data, buf, len); 569701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 579701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 58edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab if (tm6000_debug & V4L2_DEBUG_I2C) { 5945dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_DEBUG "(dev %p, pipe %08x): ", dev->udev, pipe); 609701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6145dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT "%s: %02x %02x %02x %02x %02x %02x %02x %02x ", 6252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov (req_type & USB_DIR_IN) ? " IN" : "OUT", 6352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov req_type, req, value&0xff, value>>8, index&0xff, 6452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov index>>8, len&0xff, len>>8); 659701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (!(req_type & USB_DIR_IN)) { 6745dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT ">>> "); 6852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < len; i++) 6945dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT " %02x", buf[i]); 7045dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT "\n"); 719701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 729701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 7452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index, 7552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov data, len, USB_TIMEOUT); 769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 779701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 789701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab memcpy(buf, data, len); 799701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 80edecce0a31b4447ee75dd0df34c7c5fc90ba6f6bMauro Carvalho Chehab if (tm6000_debug & V4L2_DEBUG_I2C) { 8152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (ret < 0) { 829701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab if (req_type & USB_DIR_IN) 8345dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_DEBUG "<<< (len=%d)\n", len); 849701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 8545dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT "%s: Error #%d\n", __func__, ret); 869701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else if (req_type & USB_DIR_IN) { 8745dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT "<<< "); 8852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < len; i++) 8945dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT " %02x", buf[i]); 9045dbf0db5ac974fb699fec39330d01642dff98dcMauro Carvalho Chehab printk(KERN_CONT "\n"); 919701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 939701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 949701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab kfree(data); 95fcd44b9efb0b33208a8575e5e776f4319d3b9698Thierry Reding 963874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET if (dev->quirks & TM6000_QUIRK_NO_USB_DELAY) 973874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET delay = 0; 983874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET 993874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET if (req == REQ_16_SET_GET_I2C_WR1_RDN && !(req_type & USB_DIR_IN)) { 1003874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET unsigned int tsleep; 1013874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET /* Calculate delay time, 14000us for 64 bytes */ 1023874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET tsleep = (len * 200) + 200; 1033874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET if (tsleep < delay) 1043874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET tsleep = delay; 1053874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET usleep_range(tsleep, tsleep + 1000); 1063874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET } 1073874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET else if (delay) 1083874cd7796ef1a03cd6d2a2d886e3ac4c35af09cMatthieu CASTET usleep_range(delay, delay + 1000); 109a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 110fc4eab2cbae547fb278c2583b77ee0ff7f5832d3Thierry Reding mutex_unlock(&dev->usb_lock); 1119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return ret; 1129701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 1139701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 11452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_set_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 11752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR, 11852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov req, value, index, NULL, 0); 1199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 12029ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_set_reg); 1219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 12252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1249701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int rc; 1259701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 buf[1]; 1269701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 12752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 12852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov value, index, buf, 1); 1299701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 13052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) 1319701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 1329701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1339701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return *buf; 1349701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 13529ec15e90ba9e20ff33da4824c32721bbc6bcfadRandy DunlapEXPORT_SYMBOL_GPL(tm6000_get_reg); 1369701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1378aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovint tm6000_set_reg_mask(struct tm6000_core *dev, u8 req, u16 value, 1388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u16 index, u16 mask) 1398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 1408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov int rc; 1418aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 buf[1]; 1428aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 new_index; 1438aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1448aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 145c00ecc97bc638919ff35117290b4fab01354e8d7Stefan Ringel value, 0, buf, 1); 1468aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1478aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (rc < 0) 1488aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return rc; 1498aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1508aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov new_index = (buf[0] & ~mask) | (index & mask); 1518aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 152c00ecc97bc638919ff35117290b4fab01354e8d7Stefan Ringel if (new_index == buf[0]) 1538aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 1548aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 1558aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR, 1568aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov req, value, new_index, NULL, 0); 1578aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 1588aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri BelimovEXPORT_SYMBOL_GPL(tm6000_set_reg_mask); 1598aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 16052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg16(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1619701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 1629701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab int rc; 1639701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab u8 buf[2]; 1649701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 16552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 16652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov value, index, buf, 2); 1679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 16852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) 1699701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 1709701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 1719701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return buf[1]|buf[0]<<8; 1729701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 1739701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 17452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_get_reg32(struct tm6000_core *dev, u8 req, u16 value, u16 index) 1752f7908848642c177b16b71a2ed52b57d614637efStefan Ringel{ 1762f7908848642c177b16b71a2ed52b57d614637efStefan Ringel int rc; 1772f7908848642c177b16b71a2ed52b57d614637efStefan Ringel u8 buf[4]; 1782f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 17952e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req, 18052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov value, index, buf, 4); 1812f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 18252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) 1832f7908848642c177b16b71a2ed52b57d614637efStefan Ringel return rc; 1842f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1852f7908848642c177b16b71a2ed52b57d614637efStefan Ringel return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24; 1862f7908848642c177b16b71a2ed52b57d614637efStefan Ringel} 1872f7908848642c177b16b71a2ed52b57d614637efStefan Ringel 1882a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimovint tm6000_i2c_reset(struct tm6000_core *dev, u16 tsleep) 1892a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov{ 1902a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov int rc; 1912a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1922a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 0); 1932a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov if (rc < 0) 1942a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov return rc; 1952a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1962a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov msleep(tsleep); 1972a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 1982a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 1); 1992a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov msleep(tsleep); 2002a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 2012a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov return rc; 2022a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov} 2032a15ac7ad625dc22885446016d730a451df1b7d4Dmitri Belimov 2049701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehabvoid tm6000_set_fourcc_format(struct tm6000_core *dev) 2059701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 206717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 2074223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab int val; 2084223871357a2b64248b3c41c8d89fbf03c2531eaMauro Carvalho Chehab 2094129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, 0) & 0xfc; 210717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 2114129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, val); 212717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 2134129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, val | 1); 2149701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 215717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab if (dev->fourcc == V4L2_PIX_FMT_UYVY) 2169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 217717ecd2b9a71970698c04f34239c6a1e5d08fbc2Mauro Carvalho Chehab else 2189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0x90); 2199701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 2209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 2219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 222589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehabstatic void tm6000_set_vbi(struct tm6000_core *dev) 2239701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 224589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab /* 225589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * FIXME: 226589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * VBI lines and start/end are different between 60Hz and 50Hz 227589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * So, it is very likely that we need to change the config to 228589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * something that takes it into account, doing something different 229589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab * if (dev->norm & V4L2_STD_525_60) 230589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab */ 23194d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab 23229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 233120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 234120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R41_TELETEXT_VBI_CODE1, 0x27); 235120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55); 236120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R43_VBI_DATA_TYPE_LINE7, 0x66); 237120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R44_VBI_DATA_TYPE_LINE8, 0x66); 238120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R45_VBI_DATA_TYPE_LINE9, 0x66); 239120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 240120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R46_VBI_DATA_TYPE_LINE10, 0x66); 241120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 242120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R47_VBI_DATA_TYPE_LINE11, 0x66); 243120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 244120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R48_VBI_DATA_TYPE_LINE12, 0x66); 245120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 246120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R49_VBI_DATA_TYPE_LINE13, 0x66); 247120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 248120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4A_VBI_DATA_TYPE_LINE14, 0x66); 249120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 250120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4B_VBI_DATA_TYPE_LINE15, 0x66); 251120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 252120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4C_VBI_DATA_TYPE_LINE16, 0x66); 253120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 254120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4D_VBI_DATA_TYPE_LINE17, 0x66); 255120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 256120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4E_VBI_DATA_TYPE_LINE18, 0x66); 257120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 258120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R4F_VBI_DATA_TYPE_LINE19, 0x66); 259120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 260120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R50_VBI_DATA_TYPE_LINE20, 0x66); 261120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 262120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x66); 263120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 264120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R52_VBI_DATA_TYPE_LINE22, 0x66); 265120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 266120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R53_VBI_DATA_TYPE_LINE23, 0x00); 267120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 268120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R54_VBI_DATA_TYPE_RLINES, 0x00); 269120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 270120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01); 271120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 272120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R56_VBI_LOOP_FILTER_I_GAIN, 0x00); 273120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, 274120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02); 275120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35); 276120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0); 277120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R5A_VBI_TELETEXT_DTO1, 0x11); 278120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R5B_VBI_TELETEXT_DTO0, 0x4c); 279120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R40_TELETEXT_VBI_CODE0, 0x01); 280120756e10e86a193e64c3e8a6f73ae8ffdbd5bcfStefan Ringel tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 281589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab } 282589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab} 283589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab 284589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehabint tm6000_init_analog_mode(struct tm6000_core *dev) 285589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab{ 286589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab struct v4l2_frequency f; 287589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab 288589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab if (dev->dev_type == TM6010) { 289873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding u8 active = TM6010_REQ07_RCC_ACTIVE_IF_AUDIO_ENABLE; 290873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding 291873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding if (!dev->radio) 292873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding active |= TM6010_REQ07_RCC_ACTIVE_IF_VIDEO_ENABLE; 293873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding 294f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Enable video and audio */ 2954129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_IF, 296873545820a52e8ab6f6d54a748b1759b98f9354aThierry Reding active, 0x60); 297f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable TS input */ 2988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 2998aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 0x00, 0x40); 3009701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } else { 30129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Enables soft reset */ 3029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 30329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 30452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (dev->scaler) 305f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable Hfilter and Enable TS Drop err */ 3069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20); 30752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov else /* Enable Hfilter and disable TS Drop err */ 3089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80); 3099701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88); 3119839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x23); 3129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0); 3139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8); 3149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06); 3159839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f); 3169701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 31729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* AP Software reset */ 3189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3209701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 32129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tm6000_set_fourcc_format(dev); 3229701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 32329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Disables soft reset */ 3249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00); 32529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 3269701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(20); 3279701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 32829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* Tuner firmware can now be loaded */ 32929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 33094d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab /* 33194d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * FIXME: This is a hack! xc3028 "sleeps" when no channel is detected 33294d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * for more than a few seconds. Not sure why, as this behavior does 33394d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * not happen on other devices with xc3028. So, I suspect that it 3343d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Reding * is yet another bug at tm6000. After start sleeping, decoding 33594d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * doesn't start automatically. Instead, it requires some 33694d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * I2C commands to wake it up. As we want to have image at the 33794d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * beginning, we needed to add this hack. The better would be to 33894d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab * discover some way to make tm6000 to wake up without this hack. 33994d4350c544066d590eee93582220128e8be8b1cMauro Carvalho Chehab */ 34052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov f.frequency = dev->freq; 341427f7facb374b8651ff01b7700e690ef8ccae159Mauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 3429701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 3439701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab msleep(100); 3440f6040e8929731d4294f1cffdbcb9be1523d60f0Stefan Ringel tm6000_set_standard(dev); 345589851d5990f85cce884f831ec70b9aa40b7ad5fMauro Carvalho Chehab tm6000_set_vbi(dev); 34652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_audio_bitrate(dev, 48000); 3479701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 348f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led off */ 349f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 350f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 351f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x01); 352f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 353f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 3549701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return 0; 3559701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 3569701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 35752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init_digital_mode(struct tm6000_core *dev) 3583169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig{ 359c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel if (dev->dev_type == TM6010) { 360f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Disable video and audio */ 3614129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_IF, 362f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel 0x00, 0x60); 363f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* Enable TS input */ 364f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 365f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel 0x40, 0x40); 366f010dca2e52d8dcc0445d695192df19241afacdbStefan Ringel /* all power down, but not the digital data port */ 3679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28); 3689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc); 3699afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff); 370c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } else { 3719afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08); 3729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00); 3739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01); 3749839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x08); 3759839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c); 3769839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff); 3779839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0xd8); 3789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40); 3799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0); 3809afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09); 3819839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x37); 3829afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8); 3839afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0); 3849afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60); 3859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 3869839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c); 3879839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff); 3889839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x08); 389c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 390c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel 39152e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 392c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 39352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01); 394c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(50); 39552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00); 396c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel msleep(100); 397c733a4d5b8c75ecf8d3369c2c2ba3bb1438d67f1Stefan Ringel } 398f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 399f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel /* switch dvb led on */ 400f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel if (dev->gpio.dvb_led) { 401f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, 402f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel dev->gpio.dvb_led, 0x00); 403f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel } 404f36cc0342df21fc6820b53cdfba3e98ee5943f46Stefan Ringel 4053169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig return 0; 4063169c9b26fffa180bc3bc81dc247df2f4824ee7dMichel Ludwig} 407cee3926f5f245811ef7172405253815e7f3e15e1Stefan RingelEXPORT_SYMBOL(tm6000_init_digital_mode); 4089701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 40929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehabstruct reg_init { 41029c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 req; 41129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 reg; 41229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab u8 val; 41329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 41429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 4159701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab/* The meaning of those initializations are unknown */ 4163d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic struct reg_init tm6000_init_tab[] = { 4179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* REG VALUE */ 4189839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f }, 4199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x08 }, 4209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFF_SOFT_RESET, 0x00 }, 4219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RD5_POWERSAVE, 0x4f }, 4229839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDA_CLK_SEL, 0x23 }, 4239839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RDB_OUT_SEL, 0x08 }, 4249839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x00 }, 4259839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10 }, 4269839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00 }, 4279839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00 }, 4289839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_REB_VADC_AADC_MODE, 0x64 }, /* 48000 bits/sample, external input */ 4299839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel { TM6000_REQ07_REE_VADC_CTRL_SEL_CONTROL, 0xc2 }, 4309839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel 4319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, /* Start of soft reset */ 4329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 4339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 4349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 4359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 4369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 4379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 4389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 4399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 4409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 4419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 4429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 4439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 4449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 4459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 4469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 4479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 4489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 4499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 4509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 4519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 4529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 4539afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 4549afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 4559afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 4569afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 4579afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 4589afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 4599afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 4609afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 4619afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 4629afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 4639afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 4649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 4659afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 4669afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 4679afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 4689afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 4699afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 4709afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 4719afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 4729afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 4739afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 4749afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 4759afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 4769afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 4779afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 4789afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 4799afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 4809afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, /* End of the soft reset */ 4812415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 48229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab}; 48329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 4843d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic struct reg_init tm6010_init_tab[] = { 4859afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 }, 4869afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC4_HSTART0, 0xa0 }, 4879afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC6_HEND0, 0x40 }, 4889afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RCA_VEND0, 0x31 }, 4894129e560fb92a9b2e90e1b80ee6ea8b416724e80Thierry Reding { TM6010_REQ07_RCC_ACTIVE_IF, 0xe1 }, 4909afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 }, 4919afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RFE_POWER_DOWN, 0x7f }, 4929afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 4939afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 }, 4949afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 }, 4959afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 }, 4969afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 }, 4979afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 }, 4989afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 }, 4999afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 }, 5009afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 }, 5019afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc }, 5029afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab 5039afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x01 }, 5049afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 }, 5059afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 }, 5069afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f }, 5079afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 }, 5089afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 }, 5099afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 }, 5109afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 }, 5119afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 }, 5129afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 }, 5139afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a }, 5149afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 }, 5159afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 }, 5169afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b }, 5179afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 }, 5189afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f }, 5199afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd }, 5209afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e }, 5219afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b }, 5229afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 }, 5239afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 }, 5249afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c }, 5259afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc }, 5269afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc }, 5279afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd }, 5289afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c }, 5299afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c }, 5309afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 }, 5319afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 }, 5329afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 }, 5339afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 }, 5349afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 }, 5359afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c }, 5369afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 }, 5379afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c }, 5389afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a }, 5399afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 }, 5409afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 }, 5419afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a }, 5429afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 }, 5439afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 }, 5449afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 }, 5459afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 }, 5469afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 }, 5479afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 }, 5489afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 }, 5499afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 }, 5509afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC1_TRESHOLD, 0xd0 }, 5519afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RC3_HSTART1, 0x88 }, 5529afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_R3F_RESET, 0x00 }, 55329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 5542415a2c14ef5fde98d61e3af4c5ff6e019659799Mauro Carvalho Chehab { TM6010_REQ05_R18_IMASK7, 0x00 }, 55529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 55615a295ec31fbef374ebda5f286a908e498a4579aMauro Carvalho Chehab { TM6010_REQ07_RDC_IR_LEADER1, 0xaa }, 55715a295ec31fbef374ebda5f286a908e498a4579aMauro Carvalho Chehab { TM6010_REQ07_RDD_IR_LEADER0, 0x30 }, 55815a295ec31fbef374ebda5f286a908e498a4579aMauro Carvalho Chehab { TM6010_REQ07_RDE_IR_PULSE_CNT1, 0x20 }, 55915a295ec31fbef374ebda5f286a908e498a4579aMauro Carvalho Chehab { TM6010_REQ07_RDF_IR_PULSE_CNT0, 0xd0 }, 560d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel { REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 }, 5614a83b0115066ae5a8111938df97231e65d0f88e3Mauro Carvalho Chehab { TM6010_REQ07_RD8_IR, 0x0f }, 562d46ca93255d260dceccfdcb60965ed205d2bd274Stefan Ringel 56329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab /* set remote wakeup key:any key wakeup */ 5649afec493e2fe1a477305a09f933267d805fe4c8cMauro Carvalho Chehab { TM6010_REQ07_RE5_REMOTE_WAKEUP, 0xfe }, 56515a295ec31fbef374ebda5f286a908e498a4579aMauro Carvalho Chehab { TM6010_REQ07_RDA_IR_WAKEUP_SEL, 0xff }, 5669701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab}; 5679701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 56852e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimovint tm6000_init(struct tm6000_core *dev) 5699701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 57052e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov int board, rc = 0, i, size; 57129c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab struct reg_init *tab; 57229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 573c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel /* Check board revision */ 574c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel board = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0); 575c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (board >= 0) { 576c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel switch (board & 0xff) { 577c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel case 0xf3: 578c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Found tm6000\n"); 579c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (dev->dev_type != TM6000) 580c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel dev->dev_type = TM6000; 581c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel break; 582c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel case 0xf4: 583c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Found tm6010\n"); 584c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel if (dev->dev_type != TM6010) 585c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel dev->dev_type = TM6010; 586c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel break; 587c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel default: 588c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_INFO "Unknown board version = 0x%08x\n", board); 589c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel } 590c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel } else 591c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel printk(KERN_ERR "Error %i while retrieving board version\n", board); 592c1937f8e3490fedec2c75383df07cd8a7154c545Stefan Ringel 59329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab if (dev->dev_type == TM6010) { 59429c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab = tm6010_init_tab; 59529c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab size = ARRAY_SIZE(tm6010_init_tab); 59629c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } else { 59729c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab tab = tm6000_init_tab; 59829c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab size = ARRAY_SIZE(tm6000_init_tab); 59929c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab } 6009701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6019701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab /* Load board's initialization table */ 60252e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov for (i = 0; i < size; i++) { 60352e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov rc = tm6000_set_reg(dev, tab[i].req, tab[i].reg, tab[i].val); 60452e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov if (rc < 0) { 60552e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov printk(KERN_ERR "Error %i while setting req %d, " 60652e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov "reg %d to value %d\n", rc, 60752e0a72a0c6f61c26a16b5684f4eb30a6fbf8b83Timofey Trofimov tab[i].req, tab[i].reg, tab[i].val); 6089701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab return rc; 6099701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 6109701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 6119701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 61229c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab msleep(5); /* Just to be conservative */ 61329c389be1ceb714739cdcd41fec6547d19b32864Mauro Carvalho Chehab 614e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab rc = tm6000_cards_setup(dev); 615a5adfbed09ffedb4ffa8e9a93dbd757096020470Michel Ludwig 616e3ee9e5ec17767a24848035a1d759af8a03c971fMauro Carvalho Chehab return rc; 6179701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 6189701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 619dd0c8abf2ac853dad9a360f5e9d3d1cb5e5f7621Thierry Reding 62044351aa0ee98b745986c94e139e0b1fdbd270015Mauro Carvalho Chehabint tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate) 6219701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab{ 6228aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov int val = 0; 6238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */ 6248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 areg_0a = 0x91; /* SIF 48KHz */ 6258aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6268aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov switch (bitrate) { 6278aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov case 48000: 6288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x60; /* ADC MCLK = 250 Fs */ 6298aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_0a = 0x91; /* SIF 48KHz */ 6308aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov dev->audio_bitrate = bitrate; 6318aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6328aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov case 32000: 6338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x00; /* ADC MCLK = 375 Fs */ 6348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_0a = 0x90; /* SIF 32KHz */ 6358aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov dev->audio_bitrate = bitrate; 6368aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6378aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 6388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 6398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 6419701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6429839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel /* enable I2S, if we use sif or external I2S device */ 643a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab if (dev->dev_type == TM6010) { 6448aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, areg_0a); 645a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab if (val < 0) 646a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab return val; 647a59bff3714a0f568f25816772ee939796cc7741dMauro Carvalho Chehab 6488aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 6498aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0xf0); 6509839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel if (val < 0) 6519839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel return val; 6529839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel } else { 6538aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov val = tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 6548aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0xf0); 6559839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel if (val < 0) 6569839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel return val; 6579839029b052f094b9c14cb60e7c729950dd28712Stefan Ringel } 6588aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6598aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 6608aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri BelimovEXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate); 6619701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 6620f6040e8929731d4294f1cffdbcb9be1523d60f0Stefan Ringelint tm6000_set_audio_rinput(struct tm6000_core *dev) 6638aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 6648aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 6658aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Audio crossbar setting, default SIF1 */ 666fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel u8 areg_f0; 66732f6f3ac5468bbbe0263d29daa16f38d04c2274fMauro Carvalho Chehab u8 areg_07 = 0x10; 6688aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 669fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (dev->rinput.amux) { 670fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 671fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 6728aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x03; 67332f6f3ac5468bbbe0263d29daa16f38d04c2274fMauro Carvalho Chehab areg_07 = 0x30; 6748aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 675fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 6768aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x00; 6778aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 678fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 6798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0 = 0x08; 6808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 681fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_I2S: 682fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel areg_f0 = 0x04; 683fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel break; 6848aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 685fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel printk(KERN_INFO "%s: audio input dosn't support\n", 686fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel dev->name); 6878aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 6888aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 6898aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 6908aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Set audio input crossbar */ 6918aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 6928aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_f0, 0x0f); 69332f6f3ac5468bbbe0263d29daa16f38d04c2274fMauro Carvalho Chehab /* Mux overflow workaround */ 69432f6f3ac5468bbbe0263d29daa16f38d04c2274fMauro Carvalho Chehab tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL, 69532f6f3ac5468bbbe0263d29daa16f38d04c2274fMauro Carvalho Chehab areg_07, 0xf0); 6968aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 697fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel u8 areg_eb; 6988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Audio setting, default LINE1 */ 699fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (dev->rinput.amux) { 700fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 7018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb = 0x00; 7028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 703fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 7048aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb = 0x04; 7058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 7068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 707fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel printk(KERN_INFO "%s: audio input dosn't support\n", 708fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel dev->name); 7098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 7108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 7118aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7128aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov /* Set audio input */ 7138aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 7148aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov areg_eb, 0x0f); 7158aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7168aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 7178aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7188aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7193d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_mute_sif(struct tm6000_core *dev, u8 mute) 7208aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7218aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 mute_reg = 0; 7228aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (mute) 7248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg = 0x08; 7258aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7268aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_R0A_A_I2S_MOD, mute_reg, 0x08); 7278aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7293d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_mute_adc(struct tm6000_core *dev, u8 mute) 7308aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7318aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 mute_reg = 0; 7328aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (mute) 7348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg = 0x20; 7358aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7368aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 7378aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, 7388aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7398aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, 7408aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7418aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 7428aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, 7438aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7448aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg_mask(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, 7458aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov mute_reg, 0x20); 7468aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7478aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7488aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7498aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovint tm6000_tvaudio_set_mute(struct tm6000_core *dev, u8 mute) 7508aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 751fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel enum tm6000_mux mux; 7528aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7538aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->radio) 754fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->rinput.amux; 7558aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else 756fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->vinput[dev->input].amux; 7578aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 758fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (mux) { 759fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 760fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 7618aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) 7628aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_mute_sif(dev, mute); 7638aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else { 7648aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has" 7658aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " SIF audio inputs. Please check the %s" 7668aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " configuration.\n", dev->name); 7678aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 7688aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 7699701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 770fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 771fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 7728aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_mute_adc(dev, mute); 7738aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 7748aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 7758aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return -EINVAL; 7769701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab break; 7779701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab } 7788aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov return 0; 7798aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 7808aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7813d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_volume_sif(struct tm6000_core *dev, int vol) 7828aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7838aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 vol_reg; 7849701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab 7858aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg = vol & 0x0F; 7868aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7878aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (vol < 0) 7888aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg |= 0x40; 7898aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7908aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, vol_reg); 7918aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, vol_reg); 7929701dc94a14e54a33c3c99744ec3a761f6385fc6Mauro Carvalho Chehab} 7938aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7943d1a51db7e908cd7b3440ecb4cbf00f15a8f33bfThierry Redingstatic void tm6010_set_volume_adc(struct tm6000_core *dev, int vol) 7958aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 7968aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov u8 vol_reg; 7978aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 7988aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol_reg = (vol + 0x10) & 0x1f; 7998aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 8008aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) { 8018aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, vol_reg); 8028aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, vol_reg); 8038aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else { 8048aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, vol_reg); 8058aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6000_set_reg(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, vol_reg); 8068aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 8078aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 8088aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 8098aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimovvoid tm6000_set_volume(struct tm6000_core *dev, int vol) 8108aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov{ 811fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel enum tm6000_mux mux; 8128aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 8138aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->radio) { 814fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->rinput.amux; 8158aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov vol += 8; /* Offset to 0 dB */ 8168aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } else 817fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel mux = dev->vinput[dev->input].amux; 8188aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov 819fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel switch (mux) { 820fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF1: 821fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_SIF2: 8228aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov if (dev->dev_type == TM6010) 8238aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_volume_sif(dev, vol); 8248aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov else 8258aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has" 8268aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " SIF audio inputs. Please check the %s" 8278aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov " configuration.\n", dev->name); 8288aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 829fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC1: 830fb7ef9831a432a6ae82587d1477103c18f99be73Stefan Ringel case TM6000_AMUX_ADC2: 8318aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov tm6010_set_volume_adc(dev, vol); 8328aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 8338aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov default: 8348aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov break; 8358aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov } 8368aff8ba95155dff265de5ea6f5d5d92caa7bc728Dmitri Belimov} 8370439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8380439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_devlist); 8390439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic DEFINE_MUTEX(tm6000_devlist_mutex); 8400439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8410439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 8420439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * tm6000_realease_resource() 8430439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 8440439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8450439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_remove_from_devlist(struct tm6000_core *dev) 8460439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8470439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8480439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&dev->devlist); 8490439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8500439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 8510439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8520439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_add_into_devlist(struct tm6000_core *dev) 8530439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8540439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8550439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&dev->devlist, &tm6000_devlist); 8560439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8570439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel}; 8580439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8590439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel/* 8600439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel * Extension interface 8610439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel */ 8620439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8630439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelstatic LIST_HEAD(tm6000_extension_devlist); 8640439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 865b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehabint tm6000_call_fillbuf(struct tm6000_core *dev, enum tm6000_ops_type type, 866b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab char *buf, int size) 867b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab{ 868b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab struct tm6000_ops *ops = NULL; 869b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 870b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab /* FIXME: tm6000_extension_devlist_lock should be a spinlock */ 871b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 872b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab if (!list_empty(&tm6000_extension_devlist)) { 873b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab list_for_each_entry(ops, &tm6000_extension_devlist, next) { 874b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab if (ops->fillbuf && ops->type == type) 875b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab ops->fillbuf(dev, buf, size); 876b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab } 877b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab } 878b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 879b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab return 0; 880b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab} 881b17b86991a6a17560ddd97ed9a970fc38427217dMauro Carvalho Chehab 8820439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelint tm6000_register_extension(struct tm6000_ops *ops) 8830439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 8840439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 8850439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8860439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 8870439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_add_tail(&ops->next, &tm6000_extension_devlist); 8880439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(dev, &tm6000_devlist, devlist) { 8893f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab ops->init(dev); 8903f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab printk(KERN_INFO "%s: Initialized (%s) extension\n", 8913f23a81a101889711e878240908a2b81b94a268aMauro Carvalho Chehab dev->name, ops->name); 8920439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 8930439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 8940439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel return 0; 8950439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 8960439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_register_extension); 8970439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 8980439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_unregister_extension(struct tm6000_ops *ops) 8990439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 9000439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_core *dev = NULL; 9010439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9020439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_lock(&tm6000_devlist_mutex); 903a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall list_for_each_entry(dev, &tm6000_devlist, devlist) 904a3d7fc5ce9f5985ce5230e336f104608835693a1Julia Lawall ops->fini(dev); 9050439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9060439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name); 9070439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_del(&ops->next); 9080439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel mutex_unlock(&tm6000_devlist_mutex); 9090439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 9100439db75c1fbb28a3b314ae354582e4f180daf52Stefan RingelEXPORT_SYMBOL(tm6000_unregister_extension); 9110439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9120439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_init_extension(struct tm6000_core *dev) 9130439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 9140439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 9150439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9164ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_lock(&tm6000_devlist_mutex); 9170439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 9180439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 9190439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->init) 9200439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->init(dev); 9210439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 9220439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 9234ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_unlock(&tm6000_devlist_mutex); 9240439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 9250439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9260439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringelvoid tm6000_close_extension(struct tm6000_core *dev) 9270439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel{ 9280439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel struct tm6000_ops *ops = NULL; 9290439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel 9304ae18398008d9a7fdddc6beb2e0b85fcc9cf093dMauro Carvalho Chehab mutex_lock(&tm6000_devlist_mutex); 9310439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (!list_empty(&tm6000_extension_devlist)) { 9320439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel list_for_each_entry(ops, &tm6000_extension_devlist, next) { 9330439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel if (ops->fini) 9340439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel ops->fini(dev); 9350439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 9360439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel } 937427aacfe1d0c540bf80e5243d18ba1272f9b756fDmitri Belimov mutex_unlock(&tm6000_devlist_mutex); 9380439db75c1fbb28a3b314ae354582e4f180daf52Stefan Ringel} 939