drivers/staging/tm6000/tm6000-core.c

   1 /*
   2  *  tm6000-core.c - driver for TM5600/TM6000/TM6010 USB video capture devices
   3  *
   4  *  Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>
   5  *
   6  *  Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>
   7  *      - DVB-T support
   8  *
   9  *  This program is free software; you can redistribute it and/or modify
  10  *  it under the terms of the GNU General Public License as published by
  11  *  the Free Software Foundation version 2
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21  */
  22
  23 #include <linux/module.h>
  24 #include <linux/kernel.h>
  25 #include <linux/slab.h>
  26 #include <linux/usb.h>
  27 #include <linux/i2c.h>
  28 #include "tm6000.h"
  29 #include "tm6000-regs.h"
  30 #include <media/v4l2-common.h>
  31 #include <media/tuner.h>
  32
  33 #define USB_TIMEOUT     (5 * HZ) /* ms */
  34
  35 int tm6000_read_write_usb(struct tm6000_core *dev, u8 req_type, u8 req,
  36                           u16 value, u16 index, u8 *buf, u16 len)
  37 {
  38         int          ret, i;
  39         unsigned int pipe;
  40         u8           *data = NULL;
  41
  42         if (len)
  43                 data = kzalloc(len, GFP_KERNEL);
  44
  45
  46         if (req_type & USB_DIR_IN)
  47                 pipe = usb_rcvctrlpipe(dev->udev, 0);
  48         else {
  49                 pipe = usb_sndctrlpipe(dev->udev, 0);
  50                 memcpy(data, buf, len);
  51         }
  52
  53         if (tm6000_debug & V4L2_DEBUG_I2C) {
  54                 printk("(dev %p, pipe %08x): ", dev->udev, pipe);
  55
  56                 printk("%s: %02x %02x %02x %02x %02x %02x %02x %02x ",
  57                         (req_type & USB_DIR_IN) ? " IN" : "OUT",
  58                         req_type, req, value&0xff, value>>8, index&0xff,
  59                         index>>8, len&0xff, len>>8);
  60
  61                 if (!(req_type & USB_DIR_IN)) {
  62                         printk(">>> ");
  63                         for (i = 0; i < len; i++)
  64                                 printk(" %02x", buf[i]);
  65                 printk("\n");
  66                 }
  67         }
  68
  69         ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index,
  70                               data, len, USB_TIMEOUT);
  71
  72         if (req_type &  USB_DIR_IN)
  73                 memcpy(buf, data, len);
  74
  75         if (tm6000_debug & V4L2_DEBUG_I2C) {
  76                 if (ret < 0) {
  77                         if (req_type &  USB_DIR_IN)
  78                                 printk("<<< (len=%d)\n", len);
  79
  80                         printk("%s: Error #%d\n", __FUNCTION__, ret);
  81                 } else if (req_type &  USB_DIR_IN) {
  82                         printk("<<< ");
  83                         for (i = 0; i < len; i++)
  84                                 printk(" %02x", buf[i]);
  85                         printk("\n");
  86                 }
  87         }
  88
  89         kfree(data);
  90
  91         msleep(5);
  92
  93         return ret;
  94 }
  95
  96 int tm6000_set_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index)
  97 {
  98         return
  99                 tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR,
 100                                       req, value, index, NULL, 0);
 101 }
 102 EXPORT_SYMBOL_GPL(tm6000_set_reg);
 103
 104 int tm6000_get_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index)
 105 {
 106         int rc;
 107         u8 buf[1];
 108
 109         rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
 110                                         value, index, buf, 1);
 111
 112         if (rc < 0)
 113                 return rc;
 114
 115         return *buf;
 116 }
 117 EXPORT_SYMBOL_GPL(tm6000_get_reg);
 118
 119 int tm6000_set_reg_mask(struct tm6000_core *dev, u8 req, u16 value,
 120                                                 u16 index, u16 mask)
 121 {
 122         int rc;
 123         u8 buf[1];
 124         u8 new_index;
 125
 126         rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
 127                                         value, index, buf, 1);
 128
 129         if (rc < 0)
 130                 return rc;
 131
 132         new_index = (buf[0] & ~mask) | (index & mask);
 133
 134         if (new_index == index)
 135                 return 0;
 136
 137         return tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR,
 138                                       req, value, new_index, NULL, 0);
 139 }
 140 EXPORT_SYMBOL_GPL(tm6000_set_reg_mask);
 141
 142 int tm6000_get_reg16(struct tm6000_core *dev, u8 req, u16 value, u16 index)
 143 {
 144         int rc;
 145         u8 buf[2];
 146
 147         rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
 148                                         value, index, buf, 2);
 149
 150         if (rc < 0)
 151                 return rc;
 152
 153         return buf[1]|buf[0]<<8;
 154 }
 155
 156 int tm6000_get_reg32(struct tm6000_core *dev, u8 req, u16 value, u16 index)
 157 {
 158         int rc;
 159         u8 buf[4];
 160
 161         rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
 162                                         value, index, buf, 4);
 163
 164         if (rc < 0)
 165                 return rc;
 166
 167         return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24;
 168 }
 169
 170 int tm6000_i2c_reset(struct tm6000_core *dev, u16 tsleep)
 171 {
 172         int rc;
 173
 174         rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 0);
 175         if (rc < 0)
 176                 return rc;
 177
 178         msleep(tsleep);
 179
 180         rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 1);
 181         msleep(tsleep);
 182
 183         return rc;
 184 }
 185
 186 void tm6000_set_fourcc_format(struct tm6000_core *dev)
 187 {
 188         if (dev->dev_type == TM6010) {
 189                 int val;
 190
 191                 val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0) & 0xfc;
 192                 if (dev->fourcc == V4L2_PIX_FMT_UYVY)
 193                         tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val);
 194                 else
 195                         tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val | 1);
 196         } else {
 197                 if (dev->fourcc == V4L2_PIX_FMT_UYVY)
 198                         tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0);
 199                 else
 200                         tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0x90);
 201         }
 202 }
 203
 204 static void tm6000_set_vbi(struct tm6000_core *dev)
 205 {
 206         /*
 207          * FIXME:
 208          * VBI lines and start/end are different between 60Hz and 50Hz
 209          * So, it is very likely that we need to change the config to
 210          * something that takes it into account, doing something different
 211          * if (dev->norm & V4L2_STD_525_60)
 212          */
 213
 214         if (dev->dev_type == TM6010) {
 215                 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
 216                 tm6000_set_reg(dev, TM6010_REQ07_R41_TELETEXT_VBI_CODE1, 0x27);
 217                 tm6000_set_reg(dev, TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55);
 218                 tm6000_set_reg(dev, TM6010_REQ07_R43_VBI_DATA_TYPE_LINE7, 0x66);
 219                 tm6000_set_reg(dev, TM6010_REQ07_R44_VBI_DATA_TYPE_LINE8, 0x66);
 220                 tm6000_set_reg(dev, TM6010_REQ07_R45_VBI_DATA_TYPE_LINE9, 0x66);
 221                 tm6000_set_reg(dev,
 222                         TM6010_REQ07_R46_VBI_DATA_TYPE_LINE10, 0x66);
 223                 tm6000_set_reg(dev,
 224                         TM6010_REQ07_R47_VBI_DATA_TYPE_LINE11, 0x66);
 225                 tm6000_set_reg(dev,
 226                         TM6010_REQ07_R48_VBI_DATA_TYPE_LINE12, 0x66);
 227                 tm6000_set_reg(dev,
 228                         TM6010_REQ07_R49_VBI_DATA_TYPE_LINE13, 0x66);
 229                 tm6000_set_reg(dev,
 230                         TM6010_REQ07_R4A_VBI_DATA_TYPE_LINE14, 0x66);
 231                 tm6000_set_reg(dev,
 232                         TM6010_REQ07_R4B_VBI_DATA_TYPE_LINE15, 0x66);
 233                 tm6000_set_reg(dev,
 234                         TM6010_REQ07_R4C_VBI_DATA_TYPE_LINE16, 0x66);
 235                 tm6000_set_reg(dev,
 236                         TM6010_REQ07_R4D_VBI_DATA_TYPE_LINE17, 0x66);
 237                 tm6000_set_reg(dev,
 238                         TM6010_REQ07_R4E_VBI_DATA_TYPE_LINE18, 0x66);
 239                 tm6000_set_reg(dev,
 240                         TM6010_REQ07_R4F_VBI_DATA_TYPE_LINE19, 0x66);
 241                 tm6000_set_reg(dev,
 242                         TM6010_REQ07_R50_VBI_DATA_TYPE_LINE20, 0x66);
 243                 tm6000_set_reg(dev,
 244                         TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x66);
 245                 tm6000_set_reg(dev,
 246                         TM6010_REQ07_R52_VBI_DATA_TYPE_LINE22, 0x66);
 247                 tm6000_set_reg(dev,
 248                         TM6010_REQ07_R53_VBI_DATA_TYPE_LINE23, 0x00);
 249                 tm6000_set_reg(dev,
 250                         TM6010_REQ07_R54_VBI_DATA_TYPE_RLINES, 0x00);
 251                 tm6000_set_reg(dev,
 252                         TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01);
 253                 tm6000_set_reg(dev,
 254                         TM6010_REQ07_R56_VBI_LOOP_FILTER_I_GAIN, 0x00);
 255                 tm6000_set_reg(dev,
 256                         TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02);
 257                 tm6000_set_reg(dev, TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35);
 258                 tm6000_set_reg(dev, TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0);
 259                 tm6000_set_reg(dev, TM6010_REQ07_R5A_VBI_TELETEXT_DTO1, 0x11);
 260                 tm6000_set_reg(dev, TM6010_REQ07_R5B_VBI_TELETEXT_DTO0, 0x4c);
 261                 tm6000_set_reg(dev, TM6010_REQ07_R40_TELETEXT_VBI_CODE0, 0x01);
 262                 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00);
 263         }
 264 }
 265
 266 int tm6000_init_analog_mode(struct tm6000_core *dev)
 267 {
 268         struct v4l2_frequency f;
 269
 270         if (dev->dev_type == TM6010) {
 271                 /* Enable video */
 272
 273                 tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF,
 274                                                         0x60, 0x60);
 275                 tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE,
 276                                                         0x00, 0x40);
 277                 tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc);
 278
 279         } else {
 280                 /* Enables soft reset */
 281                 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
 282
 283                 if (dev->scaler)
 284                         tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20);
 285                 else    /* Enable Hfilter and disable TS Drop err */
 286                         tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80);
 287
 288                 tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88);
 289                 tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x23);
 290                 tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0);
 291                 tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8);
 292                 tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06);
 293                 tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f);
 294
 295                 /* AP Software reset */
 296                 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08);
 297                 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00);
 298
 299                 tm6000_set_fourcc_format(dev);
 300
 301                 /* Disables soft reset */
 302                 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00);
 303
 304                 /* E3: Select input 0 - TV tuner */
 305                 tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x00);
 306                 tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x60);
 307
 308                 /* This controls input */
 309                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_2, 0x0);
 310                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_3, 0x01);
 311         }
 312         msleep(20);
 313
 314         /* Tuner firmware can now be loaded */
 315
 316         /*
 317          * FIXME: This is a hack! xc3028 "sleeps" when no channel is detected
 318          * for more than a few seconds. Not sure why, as this behavior does
 319          * not happen on other devices with xc3028. So, I suspect that it
 320          * is yet another bug at tm6000. After start sleeping, decoding
 321          * doesn't start automatically. Instead, it requires some
 322          * I2C commands to wake it up. As we want to have image at the
 323          * beginning, we needed to add this hack. The better would be to
 324          * discover some way to make tm6000 to wake up without this hack.
 325          */
 326         f.frequency = dev->freq;
 327         v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f);
 328
 329         msleep(100);
 330         tm6000_set_standard(dev, &dev->norm);
 331         tm6000_set_vbi(dev);
 332         tm6000_set_audio_bitrate(dev, 48000);
 333
 334         /* switch dvb led off */
 335         if (dev->gpio.dvb_led) {
 336                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
 337                         dev->gpio.dvb_led, 0x01);
 338         }
 339
 340         return 0;
 341 }
 342
 343 int tm6000_init_digital_mode(struct tm6000_core *dev)
 344 {
 345         if (dev->dev_type == TM6010) {
 346                 int val;
 347                 u8 buf[2];
 348
 349                 /* digital init */
 350                 val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0);
 351                 val &= ~0x60;
 352                 tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, val);
 353                 val = tm6000_get_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0);
 354                 val |= 0x40;
 355                 tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, val);
 356                 tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28);
 357                 tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc);
 358                 tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff);
 359                 tm6000_read_write_usb(dev, 0xc0, 0x0e, 0x00c2, 0x0008, buf, 2);
 360                 printk(KERN_INFO"buf %#x %#x\n", buf[0], buf[1]);
 361         } else  {
 362                 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08);
 363                 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00);
 364                 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
 365                 tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x08);
 366                 tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c);
 367                 tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff);
 368                 tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0xd8);
 369                 tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40);
 370                 tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0);
 371                 tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09);
 372                 tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x37);
 373                 tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8);
 374                 tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0);
 375                 tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60);
 376
 377                 tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c);
 378                 tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff);
 379                 tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x08);
 380                 msleep(50);
 381
 382                 tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
 383                 msleep(50);
 384                 tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01);
 385                 msleep(50);
 386                 tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
 387                 msleep(100);
 388         }
 389
 390         /* switch dvb led on */
 391         if (dev->gpio.dvb_led) {
 392                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
 393                         dev->gpio.dvb_led, 0x00);
 394         }
 395
 396         return 0;
 397 }
 398 EXPORT_SYMBOL(tm6000_init_digital_mode);
 399
 400 struct reg_init {
 401         u8 req;
 402         u8 reg;
 403         u8 val;
 404 };
 405
 406 /* The meaning of those initializations are unknown */
 407 struct reg_init tm6000_init_tab[] = {
 408         /* REG  VALUE */
 409         { TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f },
 410         { TM6010_REQ07_RFF_SOFT_RESET, 0x08 },
 411         { TM6010_REQ07_RFF_SOFT_RESET, 0x00 },
 412         { TM6010_REQ07_RD5_POWERSAVE, 0x4f },
 413         { TM6000_REQ07_RDA_CLK_SEL, 0x23 },
 414         { TM6000_REQ07_RDB_OUT_SEL, 0x08 },
 415         { TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x00 },
 416         { TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10 },
 417         { TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00 },
 418         { TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00 },
 419         { TM6000_REQ07_REB_VADC_AADC_MODE, 0x64 },      /* 48000 bits/sample, external input */
 420         { TM6000_REQ07_REE_VADC_CTRL_SEL_CONTROL, 0xc2 },
 421
 422         { TM6010_REQ07_R3F_RESET, 0x01 },               /* Start of soft reset */
 423         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
 424         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 },
 425         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 426         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
 427         { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 },
 428         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 },
 429         { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 },
 430         { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 },
 431         { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 },
 432         { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a },
 433         { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 },
 434         { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 },
 435         { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b },
 436         { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 },
 437         { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f },
 438         { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd },
 439         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
 440         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
 441         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
 442         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
 443         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 444         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 445         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 446         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 447         { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c },
 448         { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c },
 449         { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 },
 450         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
 451         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
 452         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
 453         { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 },
 454         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
 455         { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 },
 456         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 457         { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a },
 458         { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 },
 459         { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 },
 460         { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a },
 461         { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 },
 462         { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 },
 463         { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 },
 464         { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 },
 465         { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 },
 466         { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 },
 467         { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 },
 468         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
 469         { TM6010_REQ07_RC1_TRESHOLD, 0xd0 },
 470         { TM6010_REQ07_RC3_HSTART1, 0x88 },
 471         { TM6010_REQ07_R3F_RESET, 0x00 },               /* End of the soft reset */
 472         { TM6010_REQ05_R18_IMASK7, 0x00 },
 473 };
 474
 475 struct reg_init tm6010_init_tab[] = {
 476         { TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 },
 477         { TM6010_REQ07_RC4_HSTART0, 0xa0 },
 478         { TM6010_REQ07_RC6_HEND0, 0x40 },
 479         { TM6010_REQ07_RCA_VEND0, 0x31 },
 480         { TM6010_REQ07_RCC_ACTIVE_VIDEO_IF, 0xe1 },
 481         { TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 },
 482         { TM6010_REQ07_RFE_POWER_DOWN, 0x7f },
 483
 484         { TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 },
 485         { TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 },
 486         { TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 },
 487         { TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 },
 488         { TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 },
 489         { TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 },
 490         { TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 },
 491         { TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 },
 492         { TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00},
 493         { TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0x80},
 494         { TM6010_REQ08_R0C_A_ASD_THRES2, 0x0a},
 495         { TM6010_REQ08_R0D_A_AMD_THRES, 0x40},
 496         { TM6010_REQ08_R1A_A_NICAM_SER_MAX, 0x64},
 497         { TM6010_REQ08_R1B_A_NICAM_SER_MIN, 0x20},
 498         { TM6010_REQ08_R16_A_AGC_GAIN_MAX, 0xfe},
 499         { TM6010_REQ08_R17_A_AGC_GAIN_MIN, 0x01},
 500         { TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc },
 501
 502         { TM6010_REQ07_R3F_RESET, 0x01 },
 503         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
 504         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 },
 505         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 506         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
 507         { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 },
 508         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 },
 509         { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 },
 510         { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 },
 511         { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 },
 512         { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a },
 513         { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 },
 514         { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 },
 515         { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b },
 516         { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 },
 517         { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f },
 518         { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd },
 519         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
 520         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
 521         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
 522         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
 523         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 524         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 525         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 526         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 527         { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c },
 528         { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c },
 529         { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 },
 530         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
 531         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
 532         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
 533         { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 },
 534         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
 535         { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 },
 536         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 537         { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a },
 538         { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 },
 539         { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 },
 540         { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a },
 541         { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 },
 542         { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 },
 543         { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 },
 544         { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 },
 545         { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 },
 546         { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 },
 547         { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 },
 548         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
 549         { TM6010_REQ07_RC1_TRESHOLD, 0xd0 },
 550         { TM6010_REQ07_RC3_HSTART1, 0x88 },
 551         { TM6010_REQ07_R3F_RESET, 0x00 },
 552
 553         { TM6010_REQ05_R18_IMASK7, 0x00 },
 554
 555         { TM6010_REQ07_RD8_IR_LEADER1, 0xaa },
 556         { TM6010_REQ07_RD8_IR_LEADER0, 0x30 },
 557         { TM6010_REQ07_RD8_IR_PULSE_CNT1, 0x20 },
 558         { TM6010_REQ07_RD8_IR_PULSE_CNT0, 0xd0 },
 559         { REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 },
 560         { TM6010_REQ07_RD8_IR, 0x2f },
 561
 562         /* set remote wakeup key:any key wakeup */
 563         { TM6010_REQ07_RE5_REMOTE_WAKEUP,  0xfe },
 564         { TM6010_REQ07_RD8_IR_WAKEUP_SEL,  0xff },
 565 };
 566
 567 int tm6000_init(struct tm6000_core *dev)
 568 {
 569         int board, rc = 0, i, size;
 570         struct reg_init *tab;
 571
 572         /* Check board revision */
 573         board = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0);
 574         if (board >= 0) {
 575                 switch (board & 0xff) {
 576                 case 0xf3:
 577                         printk(KERN_INFO "Found tm6000\n");
 578                         if (dev->dev_type != TM6000)
 579                                 dev->dev_type = TM6000;
 580                         break;
 581                 case 0xf4:
 582                         printk(KERN_INFO "Found tm6010\n");
 583                         if (dev->dev_type != TM6010)
 584                                 dev->dev_type = TM6010;
 585                         break;
 586                 default:
 587                         printk(KERN_INFO "Unknown board version = 0x%08x\n", board);
 588                 }
 589         } else
 590                 printk(KERN_ERR "Error %i while retrieving board version\n", board);
 591
 592         if (dev->dev_type == TM6010) {
 593                 tab = tm6010_init_tab;
 594                 size = ARRAY_SIZE(tm6010_init_tab);
 595         } else {
 596                 tab = tm6000_init_tab;
 597                 size = ARRAY_SIZE(tm6000_init_tab);
 598         }
 599
 600         /* Load board's initialization table */
 601         for (i = 0; i < size; i++) {
 602                 rc = tm6000_set_reg(dev, tab[i].req, tab[i].reg, tab[i].val);
 603                 if (rc < 0) {
 604                         printk(KERN_ERR "Error %i while setting req %d, "
 605                                         "reg %d to value %d\n", rc,
 606                                         tab[i].req, tab[i].reg, tab[i].val);
 607                         return rc;
 608                 }
 609         }
 610
 611         msleep(5); /* Just to be conservative */
 612
 613         rc = tm6000_cards_setup(dev);
 614
 615         return rc;
 616 }
 617
 618 int tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate)
 619 {
 620         int val = 0;
 621         u8 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */
 622         u8 areg_0a = 0x91; /* SIF 48KHz */
 623
 624         switch (bitrate) {
 625         case 48000:
 626                 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */
 627                 areg_0a = 0x91; /* SIF 48KHz */
 628                 dev->audio_bitrate = bitrate;
 629                 break;
 630         case 32000:
 631                 areg_f0 = 0x00; /* ADC MCLK = 375 Fs */
 632                 areg_0a = 0x90; /* SIF 32KHz */
 633                 dev->audio_bitrate = bitrate;
 634                 break;
 635         default:
 636                 return -EINVAL;
 637         }
 638
 639
 640         /* enable I2S, if we use sif or external I2S device */
 641         if (dev->dev_type == TM6010) {
 642                 val = tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, areg_0a);
 643                 if (val < 0)
 644                         return val;
 645
 646                 val = tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 647                                                         areg_f0, 0xf0);
 648                 if (val < 0)
 649                         return val;
 650         } else {
 651                 val = tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE,
 652                                                         areg_f0, 0xf0);
 653                 if (val < 0)
 654                         return val;
 655         }
 656         return 0;
 657 }
 658 EXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate);
 659
 660 int tm6000_set_audio_input(struct tm6000_core *dev, enum tm6000_inaudio ainp)
 661 {
 662         if (dev->dev_type == TM6010) {
 663                 /* Audio crossbar setting, default SIF1 */
 664                 u8 areg_f0 = 0x03;
 665
 666                 switch (ainp) {
 667                 case TM6000_AIP_SIF1:
 668                 case TM6000_AIP_SIF2:
 669                         areg_f0 = 0x03;
 670                         break;
 671                 case TM6000_AIP_LINE1:
 672                         areg_f0 = 0x00;
 673                         break;
 674                 case TM6000_AIP_LINE2:
 675                         areg_f0 = 0x08;
 676                         break;
 677                 default:
 678                         return 0;
 679                         break;
 680                 }
 681                 /* Set audio input crossbar */
 682                 tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 683                                                         areg_f0, 0x0f);
 684         } else {
 685                 /* Audio setting, default LINE1 */
 686                 u8 areg_eb = 0x00;
 687
 688                 switch (ainp) {
 689                 case TM6000_AIP_LINE1:
 690                         areg_eb = 0x00;
 691                         break;
 692                 case TM6000_AIP_LINE2:
 693                         areg_eb = 0x04;
 694                         break;
 695                 default:
 696                         return 0;
 697                         break;
 698                 }
 699                 /* Set audio input */
 700                 tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE,
 701                                                         areg_eb, 0x0f);
 702         }
 703         return 0;
 704 }
 705 EXPORT_SYMBOL_GPL(tm6000_set_audio_input);
 706
 707 void tm6010_set_mute_sif(struct tm6000_core *dev, u8 mute)
 708 {
 709         u8 mute_reg = 0;
 710
 711         if (mute)
 712                 mute_reg = 0x08;
 713
 714         tm6000_set_reg_mask(dev, TM6010_REQ08_R0A_A_I2S_MOD, mute_reg, 0x08);
 715 }
 716
 717 void tm6010_set_mute_adc(struct tm6000_core *dev, u8 mute)
 718 {
 719         u8 mute_reg = 0;
 720
 721         if (mute)
 722                 mute_reg = 0x20;
 723
 724         if (dev->dev_type == TM6010) {
 725                 tm6000_set_reg_mask(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL,
 726                                                         mute_reg, 0x20);
 727                 tm6000_set_reg_mask(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL,
 728                                                         mute_reg, 0x20);
 729         } else {
 730                 tm6000_set_reg_mask(dev, TM6000_REQ07_REC_VADC_AADC_LVOL,
 731                                                         mute_reg, 0x20);
 732                 tm6000_set_reg_mask(dev, TM6000_REQ07_RED_VADC_AADC_RVOL,
 733                                                         mute_reg, 0x20);
 734         }
 735 }
 736
 737 int tm6000_tvaudio_set_mute(struct tm6000_core *dev, u8 mute)
 738 {
 739         enum tm6000_inaudio ainp;
 740
 741         if (dev->radio)
 742                 ainp = dev->aradio;
 743         else
 744                 ainp = dev->avideo;
 745
 746         switch (ainp) {
 747         case TM6000_AIP_SIF1:
 748         case TM6000_AIP_SIF2:
 749                 if (dev->dev_type == TM6010)
 750                         tm6010_set_mute_sif(dev, mute);
 751                 else {
 752                         printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has"
 753                                         " SIF audio inputs. Please check the %s"
 754                                         " configuration.\n", dev->name);
 755                         return -EINVAL;
 756                 }
 757                 break;
 758         case TM6000_AIP_LINE1:
 759         case TM6000_AIP_LINE2:
 760                 tm6010_set_mute_adc(dev, mute);
 761                 break;
 762         default:
 763                 return -EINVAL;
 764                 break;
 765         }
 766         return 0;
 767 }
 768 EXPORT_SYMBOL_GPL(tm6000_tvaudio_set_mute);
 769
 770 void tm6010_set_volume_sif(struct tm6000_core *dev, int vol)
 771 {
 772         u8 vol_reg;
 773
 774         vol_reg = vol & 0x0F;
 775
 776         if (vol < 0)
 777                 vol_reg |= 0x40;
 778
 779         tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, vol_reg);
 780         tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, vol_reg);
 781 }
 782
 783 void tm6010_set_volume_adc(struct tm6000_core *dev, int vol)
 784 {
 785         u8 vol_reg;
 786
 787         vol_reg = (vol + 0x10) & 0x1f;
 788
 789         if (dev->dev_type == TM6010) {
 790                 tm6000_set_reg(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, vol_reg);
 791                 tm6000_set_reg(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, vol_reg);
 792         } else {
 793                 tm6000_set_reg(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, vol_reg);
 794                 tm6000_set_reg(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, vol_reg);
 795         }
 796 }
 797
 798 void tm6000_set_volume(struct tm6000_core *dev, int vol)
 799 {
 800         enum tm6000_inaudio ainp;
 801
 802         if (dev->radio) {
 803                 ainp = dev->aradio;
 804                 vol += 8; /* Offset to 0 dB */
 805         } else
 806                 ainp = dev->avideo;
 807
 808         switch (ainp) {
 809         case TM6000_AIP_SIF1:
 810         case TM6000_AIP_SIF2:
 811                 if (dev->dev_type == TM6010)
 812                         tm6010_set_volume_sif(dev, vol);
 813                 else
 814                         printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has"
 815                                         " SIF audio inputs. Please check the %s"
 816                                         " configuration.\n", dev->name);
 817                 break;
 818         case TM6000_AIP_LINE1:
 819         case TM6000_AIP_LINE2:
 820                 tm6010_set_volume_adc(dev, vol);
 821                 break;
 822         default:
 823                 break;
 824         }
 825 }
 826 EXPORT_SYMBOL_GPL(tm6000_set_volume);
 827
 828 static LIST_HEAD(tm6000_devlist);
 829 static DEFINE_MUTEX(tm6000_devlist_mutex);
 830
 831 /*
 832  * tm6000_realease_resource()
 833  */
 834
 835 void tm6000_remove_from_devlist(struct tm6000_core *dev)
 836 {
 837         mutex_lock(&tm6000_devlist_mutex);
 838         list_del(&dev->devlist);
 839         mutex_unlock(&tm6000_devlist_mutex);
 840 };
 841
 842 void tm6000_add_into_devlist(struct tm6000_core *dev)
 843 {
 844         mutex_lock(&tm6000_devlist_mutex);
 845         list_add_tail(&dev->devlist, &tm6000_devlist);
 846         mutex_unlock(&tm6000_devlist_mutex);
 847 };
 848
 849 /*
 850  * Extension interface
 851  */
 852
 853 static LIST_HEAD(tm6000_extension_devlist);
 854
 855 int tm6000_call_fillbuf(struct tm6000_core *dev, enum tm6000_ops_type type,
 856                         char *buf, int size)
 857 {
 858         struct tm6000_ops *ops = NULL;
 859
 860         /* FIXME: tm6000_extension_devlist_lock should be a spinlock */
 861
 862         if (!list_empty(&tm6000_extension_devlist)) {
 863                 list_for_each_entry(ops, &tm6000_extension_devlist, next) {
 864                         if (ops->fillbuf && ops->type == type)
 865                                 ops->fillbuf(dev, buf, size);
 866                 }
 867         }
 868
 869         return 0;
 870 }
 871
 872 int tm6000_register_extension(struct tm6000_ops *ops)
 873 {
 874         struct tm6000_core *dev = NULL;
 875
 876         mutex_lock(&tm6000_devlist_mutex);
 877         list_add_tail(&ops->next, &tm6000_extension_devlist);
 878         list_for_each_entry(dev, &tm6000_devlist, devlist) {
 879                 ops->init(dev);
 880                 printk(KERN_INFO "%s: Initialized (%s) extension\n",
 881                        dev->name, ops->name);
 882         }
 883         mutex_unlock(&tm6000_devlist_mutex);
 884         return 0;
 885 }
 886 EXPORT_SYMBOL(tm6000_register_extension);
 887
 888 void tm6000_unregister_extension(struct tm6000_ops *ops)
 889 {
 890         struct tm6000_core *dev = NULL;
 891
 892         mutex_lock(&tm6000_devlist_mutex);
 893         list_for_each_entry(dev, &tm6000_devlist, devlist)
 894                 ops->fini(dev);
 895
 896         printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name);
 897         list_del(&ops->next);
 898         mutex_unlock(&tm6000_devlist_mutex);
 899 }
 900 EXPORT_SYMBOL(tm6000_unregister_extension);
 901
 902 void tm6000_init_extension(struct tm6000_core *dev)
 903 {
 904         struct tm6000_ops *ops = NULL;
 905
 906         mutex_lock(&tm6000_devlist_mutex);
 907         if (!list_empty(&tm6000_extension_devlist)) {
 908                 list_for_each_entry(ops, &tm6000_extension_devlist, next) {
 909                         if (ops->init)
 910                                 ops->init(dev);
 911                 }
 912         }
 913         mutex_unlock(&tm6000_devlist_mutex);
 914 }
 915
 916 void tm6000_close_extension(struct tm6000_core *dev)
 917 {
 918         struct tm6000_ops *ops = NULL;
 919
 920         mutex_lock(&tm6000_devlist_mutex);
 921         if (!list_empty(&tm6000_extension_devlist)) {
 922                 list_for_each_entry(ops, &tm6000_extension_devlist, next) {
 923                         if (ops->fini)
 924                                 ops->fini(dev);
 925                 }
 926         }
 927         mutex_unlock(&tm6000_devlist_mutex);
 928 }