SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/staging/tm6000/tm6000-core.c

   1 /*
   2    tm6000-core.c - driver for TM5600/TM6000 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/usb.h>
  26 #include <linux/i2c.h>
  27 #include <linux/video_decoder.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         static int   ini=0, last=0, n=0;
  41         u8           *data=NULL;
  42
  43         if (len)
  44                 data = kzalloc(len, GFP_KERNEL);
  45
  46
  47         if (req_type & USB_DIR_IN)
  48                 pipe=usb_rcvctrlpipe(dev->udev, 0);
  49         else {
  50                 pipe=usb_sndctrlpipe(dev->udev, 0);
  51                 memcpy(data, buf, len);
  52         }
  53
  54         if (tm6000_debug & V4L2_DEBUG_I2C) {
  55                 if (!ini)
  56                         last=ini=jiffies;
  57
  58                 printk("%06i (dev %p, pipe %08x): ", n, dev->udev, pipe);
  59
  60                 printk( "%s: %06u ms %06u ms %02x %02x %02x %02x %02x %02x %02x %02x ",
  61                         (req_type & USB_DIR_IN)?" IN":"OUT",
  62                         jiffies_to_msecs(jiffies-last),
  63                         jiffies_to_msecs(jiffies-ini),
  64                         req_type, req,value&0xff,value>>8, index&0xff, index>>8,
  65                         len&0xff, len>>8);
  66                 last=jiffies;
  67                 n++;
  68
  69                 if ( !(req_type & USB_DIR_IN) ) {
  70                         printk(">>> ");
  71                         for (i=0;i<len;i++) {
  72                                 printk(" %02x",buf[i]);
  73                         }
  74                 printk("\n");
  75                 }
  76         }
  77
  78         ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index, data,
  79                               len, USB_TIMEOUT);
  80
  81         if (req_type &  USB_DIR_IN)
  82                 memcpy(buf, data, len);
  83
  84         if (tm6000_debug & V4L2_DEBUG_I2C) {
  85                 if (ret<0) {
  86                         if (req_type &  USB_DIR_IN)
  87                                 printk("<<< (len=%d)\n",len);
  88
  89                         printk("%s: Error #%d\n", __FUNCTION__, ret);
  90                 } else if (req_type &  USB_DIR_IN) {
  91                         printk("<<< ");
  92                         for (i=0;i<len;i++) {
  93                                 printk(" %02x",buf[i]);
  94                         }
  95                         printk("\n");
  96                 }
  97         }
  98
  99         kfree(data);
 100
 101         msleep(5);
 102
 103         return ret;
 104 }
 105
 106 int tm6000_set_reg (struct tm6000_core *dev, u8 req, u16 value, u16 index)
 107 {
 108         return
 109                 tm6000_read_write_usb (dev, USB_DIR_OUT | USB_TYPE_VENDOR,
 110                                        req, value, index, NULL, 0);
 111 }
 112
 113 int tm6000_get_reg (struct tm6000_core *dev, u8 req, u16 value, u16 index)
 114 {
 115         int rc;
 116         u8 buf[1];
 117
 118         rc=tm6000_read_write_usb (dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
 119                                        value, index, buf, 1);
 120
 121         if (rc<0)
 122                 return rc;
 123
 124         return *buf;
 125 }
 126
 127 int tm6000_get_reg16 (struct tm6000_core *dev, u8 req, u16 value, u16 index)
 128 {
 129         int rc;
 130         u8 buf[2];
 131
 132         rc=tm6000_read_write_usb (dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
 133                                        value, index, buf, 2);
 134
 135         if (rc<0)
 136                 return rc;
 137
 138         return buf[1]|buf[0]<<8;
 139 }
 140
 141 void tm6000_set_fourcc_format(struct tm6000_core *dev)
 142 {
 143         if (dev->dev_type == TM6010) {
 144                 if (dev->fourcc == V4L2_PIX_FMT_UYVY)
 145                         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0xc1, 0xfc);
 146                 else
 147                         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0xc1, 0xfd);
 148         } else {
 149                 if (dev->fourcc == V4L2_PIX_FMT_UYVY)
 150                         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0xc1, 0xd0);
 151                 else
 152                         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0xc1, 0x90);
 153         }
 154 }
 155
 156 int tm6000_init_analog_mode (struct tm6000_core *dev)
 157 {
 158         if (dev->dev_type == TM6010) {
 159                 int val;
 160
 161                 /* Enable video */
 162                 val = tm6000_get_reg(dev, REQ_07_SET_GET_AVREG, 0xcc, 0);
 163                 val |= 0x60;
 164                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xcc, val);
 165                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xfe, 0xcf);
 166
 167         } else {
 168                 /* Enables soft reset */
 169                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0x3f, 0x01);
 170
 171                 if (dev->scaler) {
 172                         tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xc0, 0x20);
 173                 } else {
 174                         /* Enable Hfilter and disable TS Drop err */
 175                         tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xc0, 0x80);
 176                 }
 177
 178                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xc3, 0x88);
 179                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xda, 0x23);
 180                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xd1, 0xc0);
 181                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xd2, 0xd8);
 182                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xd6, 0x06);
 183                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xdf, 0x1f);
 184
 185                 /* AP Software reset */
 186                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xff, 0x08);
 187                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xff, 0x00);
 188
 189                 tm6000_set_fourcc_format(dev);
 190
 191                 /* Disables soft reset */
 192                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0x3f, 0x00);
 193
 194                 /* E3: Select input 0 - TV tuner */
 195                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xe3, 0x00);
 196                 tm6000_set_reg(dev, REQ_07_SET_GET_AVREG, 0xeb, 0x60);
 197
 198                 /* This controls input */
 199                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_2, 0x0);
 200                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_3, 0x01);
 201         }
 202         msleep(20);
 203
 204         /* Tuner firmware can now be loaded */
 205
 206         /*FIXME: Hack!!! */
 207         struct v4l2_frequency f;
 208         mutex_lock(&dev->lock);
 209         f.frequency=dev->freq;
 210         v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f);
 211         mutex_unlock(&dev->lock);
 212
 213         msleep(100);
 214         tm6000_set_standard (dev, &dev->norm);
 215         tm6000_set_audio_bitrate (dev,48000);
 216
 217         return 0;
 218 }
 219
 220 int tm6000_init_digital_mode (struct tm6000_core *dev)
 221 {
 222         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00ff, 0x08);
 223         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00ff, 0x00);
 224         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x003f, 0x01);
 225         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00df, 0x08);
 226         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00e2, 0x0c);
 227         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00e8, 0xff);
 228         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00eb, 0xd8);
 229         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00c0, 0x40);
 230         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00c1, 0xd0);
 231         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00c3, 0x09);
 232         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00da, 0x37);
 233         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00d1, 0xd8);
 234         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00d2, 0xc0);
 235         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00d6, 0x60);
 236
 237         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00e2, 0x0c);
 238         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00e8, 0xff);
 239         tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0x00eb, 0x08);
 240         msleep(50);
 241
 242         tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
 243         msleep(50);
 244         tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01);
 245         msleep(50);
 246         tm6000_set_reg (dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
 247         msleep(100);
 248
 249         return 0;
 250 }
 251
 252 struct reg_init {
 253         u8 req;
 254         u8 reg;
 255         u8 val;
 256 };
 257
 258 /* The meaning of those initializations are unknown */
 259 struct reg_init tm6000_init_tab[] = {
 260         /* REG  VALUE */
 261         { REQ_07_SET_GET_AVREG,  0xdf, 0x1f },
 262         { REQ_07_SET_GET_AVREG,  0xff, 0x08 },
 263         { REQ_07_SET_GET_AVREG,  0xff, 0x00 },
 264         { REQ_07_SET_GET_AVREG,  0xd5, 0x4f },
 265         { REQ_07_SET_GET_AVREG,  0xda, 0x23 },
 266         { REQ_07_SET_GET_AVREG,  0xdb, 0x08 },
 267         { REQ_07_SET_GET_AVREG,  0xe2, 0x00 },
 268         { REQ_07_SET_GET_AVREG,  0xe3, 0x10 },
 269         { REQ_07_SET_GET_AVREG,  0xe5, 0x00 },
 270         { REQ_07_SET_GET_AVREG,  0xe8, 0x00 },
 271         { REQ_07_SET_GET_AVREG,  0xeb, 0x64 },          /* 48000 bits/sample, external input */
 272         { REQ_07_SET_GET_AVREG,  0xee, 0xc2 },
 273         { REQ_07_SET_GET_AVREG,  0x3f, 0x01 },          /* Start of soft reset */
 274         { REQ_07_SET_GET_AVREG,  0x00, 0x00 },
 275         { REQ_07_SET_GET_AVREG,  0x01, 0x07 },
 276         { REQ_07_SET_GET_AVREG,  0x02, 0x5f },
 277         { REQ_07_SET_GET_AVREG,  0x03, 0x00 },
 278         { REQ_07_SET_GET_AVREG,  0x05, 0x64 },
 279         { REQ_07_SET_GET_AVREG,  0x07, 0x01 },
 280         { REQ_07_SET_GET_AVREG,  0x08, 0x82 },
 281         { REQ_07_SET_GET_AVREG,  0x09, 0x36 },
 282         { REQ_07_SET_GET_AVREG,  0x0a, 0x50 },
 283         { REQ_07_SET_GET_AVREG,  0x0c, 0x6a },
 284         { REQ_07_SET_GET_AVREG,  0x11, 0xc9 },
 285         { REQ_07_SET_GET_AVREG,  0x12, 0x07 },
 286         { REQ_07_SET_GET_AVREG,  0x13, 0x3b },
 287         { REQ_07_SET_GET_AVREG,  0x14, 0x47 },
 288         { REQ_07_SET_GET_AVREG,  0x15, 0x6f },
 289         { REQ_07_SET_GET_AVREG,  0x17, 0xcd },
 290         { REQ_07_SET_GET_AVREG,  0x18, 0x1e },
 291         { REQ_07_SET_GET_AVREG,  0x19, 0x8b },
 292         { REQ_07_SET_GET_AVREG,  0x1a, 0xa2 },
 293         { REQ_07_SET_GET_AVREG,  0x1b, 0xe9 },
 294         { REQ_07_SET_GET_AVREG,  0x1c, 0x1c },
 295         { REQ_07_SET_GET_AVREG,  0x1d, 0xcc },
 296         { REQ_07_SET_GET_AVREG,  0x1e, 0xcc },
 297         { REQ_07_SET_GET_AVREG,  0x1f, 0xcd },
 298         { REQ_07_SET_GET_AVREG,  0x20, 0x3c },
 299         { REQ_07_SET_GET_AVREG,  0x21, 0x3c },
 300         { REQ_07_SET_GET_AVREG,  0x2d, 0x48 },
 301         { REQ_07_SET_GET_AVREG,  0x2e, 0x88 },
 302         { REQ_07_SET_GET_AVREG,  0x30, 0x22 },
 303         { REQ_07_SET_GET_AVREG,  0x31, 0x61 },
 304         { REQ_07_SET_GET_AVREG,  0x32, 0x74 },
 305         { REQ_07_SET_GET_AVREG,  0x33, 0x1c },
 306         { REQ_07_SET_GET_AVREG,  0x34, 0x74 },
 307         { REQ_07_SET_GET_AVREG,  0x35, 0x1c },
 308         { REQ_07_SET_GET_AVREG,  0x36, 0x7a },
 309         { REQ_07_SET_GET_AVREG,  0x37, 0x26 },
 310         { REQ_07_SET_GET_AVREG,  0x38, 0x40 },
 311         { REQ_07_SET_GET_AVREG,  0x39, 0x0a },
 312         { REQ_07_SET_GET_AVREG,  0x42, 0x55 },
 313         { REQ_07_SET_GET_AVREG,  0x51, 0x11 },
 314         { REQ_07_SET_GET_AVREG,  0x55, 0x01 },
 315         { REQ_07_SET_GET_AVREG,  0x57, 0x02 },
 316         { REQ_07_SET_GET_AVREG,  0x58, 0x35 },
 317         { REQ_07_SET_GET_AVREG,  0x59, 0xa0 },
 318         { REQ_07_SET_GET_AVREG,  0x80, 0x15 },
 319         { REQ_07_SET_GET_AVREG,  0x82, 0x42 },
 320         { REQ_07_SET_GET_AVREG,  0xc1, 0xd0 },
 321         { REQ_07_SET_GET_AVREG,  0xc3, 0x88 },
 322         { REQ_07_SET_GET_AVREG,  0x3f, 0x00 },          /* End of the soft reset */
 323         { REQ_05_SET_GET_USBREG, 0x18, 0x00 },
 324 };
 325
 326 struct reg_init tm6010_init_tab[] = {
 327         { REQ_07_SET_GET_AVREG, 0xc0, 0x00 },
 328         { REQ_07_SET_GET_AVREG, 0xc4, 0xa0 },
 329         { REQ_07_SET_GET_AVREG, 0xc6, 0x40 },
 330         { REQ_07_SET_GET_AVREG, 0xca, 0x31 },
 331         { REQ_07_SET_GET_AVREG, 0xcc, 0xe1 },
 332         { REQ_07_SET_GET_AVREG, 0xe0, 0x03 },
 333         { REQ_07_SET_GET_AVREG, 0xfe, 0x7f },
 334
 335         { REQ_08_SET_GET_AVREG_BIT, 0xe2, 0xf0 },
 336         { REQ_08_SET_GET_AVREG_BIT, 0xe3, 0xf4 },
 337         { REQ_08_SET_GET_AVREG_BIT, 0xe4, 0xf8 },
 338         { REQ_08_SET_GET_AVREG_BIT, 0xe6, 0x00 },
 339         { REQ_08_SET_GET_AVREG_BIT, 0xea, 0xf2 },
 340         { REQ_08_SET_GET_AVREG_BIT, 0xeb, 0xf0 },
 341         { REQ_08_SET_GET_AVREG_BIT, 0xec, 0xc2 },
 342         { REQ_08_SET_GET_AVREG_BIT, 0xf0, 0x60 },
 343         { REQ_08_SET_GET_AVREG_BIT, 0xf1, 0xfc },
 344
 345         { REQ_07_SET_GET_AVREG, 0x3f, 0x01 },
 346         { REQ_07_SET_GET_AVREG, 0x00, 0x00 },
 347         { REQ_07_SET_GET_AVREG, 0x01, 0x07 },
 348         { REQ_07_SET_GET_AVREG, 0x02, 0x5f },
 349         { REQ_07_SET_GET_AVREG, 0x03, 0x00 },
 350         { REQ_07_SET_GET_AVREG, 0x05, 0x64 },
 351         { REQ_07_SET_GET_AVREG, 0x07, 0x01 },
 352         { REQ_07_SET_GET_AVREG, 0x08, 0x82 },
 353         { REQ_07_SET_GET_AVREG, 0x09, 0x36 },
 354         { REQ_07_SET_GET_AVREG, 0x0a, 0x50 },
 355         { REQ_07_SET_GET_AVREG, 0x0c, 0x6a },
 356         { REQ_07_SET_GET_AVREG, 0x11, 0xc9 },
 357         { REQ_07_SET_GET_AVREG, 0x12, 0x07 },
 358         { REQ_07_SET_GET_AVREG, 0x13, 0x3b },
 359         { REQ_07_SET_GET_AVREG, 0x14, 0x47 },
 360         { REQ_07_SET_GET_AVREG, 0x15, 0x6f },
 361         { REQ_07_SET_GET_AVREG, 0x17, 0xcd },
 362         { REQ_07_SET_GET_AVREG, 0x18, 0x1e },
 363         { REQ_07_SET_GET_AVREG, 0x19, 0x8b },
 364         { REQ_07_SET_GET_AVREG, 0x1a, 0xa2 },
 365         { REQ_07_SET_GET_AVREG, 0x1b, 0xe9 },
 366         { REQ_07_SET_GET_AVREG, 0x1c, 0x1c },
 367         { REQ_07_SET_GET_AVREG, 0x1d, 0xcc },
 368         { REQ_07_SET_GET_AVREG, 0x1e, 0xcc },
 369         { REQ_07_SET_GET_AVREG, 0x1f, 0xcd },
 370         { REQ_07_SET_GET_AVREG, 0x20, 0x3c },
 371         { REQ_07_SET_GET_AVREG, 0x21, 0x3c },
 372         { REQ_07_SET_GET_AVREG, 0x2d, 0x48 },
 373         { REQ_07_SET_GET_AVREG, 0x2e, 0x88 },
 374         { REQ_07_SET_GET_AVREG, 0x30, 0x22 },
 375         { REQ_07_SET_GET_AVREG, 0x31, 0x61 },
 376         { REQ_07_SET_GET_AVREG, 0x32, 0x74 },
 377         { REQ_07_SET_GET_AVREG, 0x33, 0x1c },
 378         { REQ_07_SET_GET_AVREG, 0x34, 0x74 },
 379         { REQ_07_SET_GET_AVREG, 0x35, 0x1c },
 380         { REQ_07_SET_GET_AVREG, 0x36, 0x7a },
 381         { REQ_07_SET_GET_AVREG, 0x37, 0x26 },
 382         { REQ_07_SET_GET_AVREG, 0x38, 0x40 },
 383         { REQ_07_SET_GET_AVREG, 0x39, 0x0a },
 384         { REQ_07_SET_GET_AVREG, 0x42, 0x55 },
 385         { REQ_07_SET_GET_AVREG, 0x51, 0x11 },
 386         { REQ_07_SET_GET_AVREG, 0x55, 0x01 },
 387         { REQ_07_SET_GET_AVREG, 0x57, 0x02 },
 388         { REQ_07_SET_GET_AVREG, 0x58, 0x35 },
 389         { REQ_07_SET_GET_AVREG, 0x59, 0xa0 },
 390         { REQ_07_SET_GET_AVREG, 0x80, 0x15 },
 391         { REQ_07_SET_GET_AVREG, 0x82, 0x42 },
 392         { REQ_07_SET_GET_AVREG, 0xc1, 0xd0 },
 393         { REQ_07_SET_GET_AVREG, 0xc3, 0x88 },
 394         { REQ_07_SET_GET_AVREG, 0x3f, 0x00 },
 395
 396         { REQ_05_SET_GET_USBREG, 0x18, 0x00 },
 397
 398         /* set remote wakeup key:any key wakeup */
 399         { REQ_07_SET_GET_AVREG,  0xe5,  0xfe },
 400         { REQ_07_SET_GET_AVREG,  0xda,  0xff },
 401 };
 402
 403 int tm6000_init (struct tm6000_core *dev)
 404 {
 405         int board, rc=0, i, size;
 406         struct reg_init *tab;
 407
 408         if (dev->dev_type == TM6010) {
 409                 tab = tm6010_init_tab;
 410                 size = ARRAY_SIZE(tm6010_init_tab);
 411         } else {
 412                 tab = tm6000_init_tab;
 413                 size = ARRAY_SIZE(tm6000_init_tab);
 414         }
 415
 416         /* Load board's initialization table */
 417         for (i=0; i< size; i++) {
 418                 rc= tm6000_set_reg (dev, tab[i].req, tab[i].reg, tab[i].val);
 419                 if (rc<0) {
 420                         printk (KERN_ERR "Error %i while setting req %d, "
 421                                          "reg %d to value %d\n", rc,
 422                                          tab[i].req,tab[i].reg, tab[i].val);
 423                         return rc;
 424                 }
 425         }
 426
 427         msleep(5); /* Just to be conservative */
 428
 429         /* Check board version - maybe 10Moons specific */
 430         board=tm6000_get_reg16 (dev, 0x40, 0, 0);
 431         if (board >=0) {
 432                 printk (KERN_INFO "Board version = 0x%04x\n",board);
 433         } else {
 434                 printk (KERN_ERR "Error %i while retrieving board version\n",board);
 435         }
 436
 437         if (dev->dev_type == TM6010) {
 438                 /* Turn xceive 3028 on */
 439                 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6010_GPIO_3, 0x01);
 440                 msleep(11);
 441         }
 442
 443         /* Reset GPIO1 and GPIO4. */
 444         for (i=0; i< 2; i++) {
 445                 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
 446                                         dev->tuner_reset_gpio, 0x00);
 447                 if (rc<0) {
 448                         printk (KERN_ERR "Error %i doing GPIO1 reset\n",rc);
 449                         return rc;
 450                 }
 451
 452                 msleep(10); /* Just to be conservative */
 453                 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
 454                                         dev->tuner_reset_gpio, 0x01);
 455                 if (rc<0) {
 456                         printk (KERN_ERR "Error %i doing GPIO1 reset\n",rc);
 457                         return rc;
 458                 }
 459
 460                 msleep(10);
 461                 rc=tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_4, 0);
 462                 if (rc<0) {
 463                         printk (KERN_ERR "Error %i doing GPIO4 reset\n",rc);
 464                         return rc;
 465                 }
 466
 467                 msleep(10);
 468                 rc=tm6000_set_reg (dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_4, 1);
 469                 if (rc<0) {
 470                         printk (KERN_ERR "Error %i doing GPIO4 reset\n",rc);
 471                         return rc;
 472                 }
 473
 474                 if (!i) {
 475                         rc=tm6000_get_reg16(dev, 0x40,0,0);
 476                         if (rc>=0) {
 477                                 printk ("board=%d\n", rc);
 478                         }
 479                 }
 480         }
 481
 482         msleep(50);
 483
 484         return 0;
 485 }
 486
 487 int tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate)
 488 {
 489         int val;
 490
 491         val=tm6000_get_reg (dev, REQ_07_SET_GET_AVREG, 0xeb, 0x0);
 492 printk("Original value=%d\n",val);
 493         if (val<0)
 494                 return val;
 495
 496         val &= 0x0f;            /* Preserve the audio input control bits */
 497         switch (bitrate) {
 498         case 44100:
 499                 val|=0xd0;
 500                 dev->audio_bitrate=bitrate;
 501                 break;
 502         case 48000:
 503                 val|=0x60;
 504                 dev->audio_bitrate=bitrate;
 505                 break;
 506         }
 507         val=tm6000_set_reg (dev, REQ_07_SET_GET_AVREG, 0xeb, val);
 508
 509         return val;
 510 }
 511 EXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate);