kernel/2.6.29.6-aldebaran-rt/drivers/media/video/bt819.c

   1 /*
   2  *  bt819 - BT819A VideoStream Decoder (Rockwell Part)
   3  *
   4  * Copyright (C) 1999 Mike Bernson <mike@mlb.org>
   5  * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
   6  *
   7  * Modifications for LML33/DC10plus unified driver
   8  * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
   9  *
  10  * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
  11  *    - moved over to linux>=2.4.x i2c protocol (9/9/2002)
  12  *
  13  * This code was modify/ported from the saa7111 driver written
  14  * by Dave Perks.
  15  *
  16  * This program is free software; you can redistribute it and/or modify
  17  * it under the terms of the GNU General Public License as published by
  18  * the Free Software Foundation; either version 2 of the License, or
  19  * (at your option) any later version.
  20  *
  21  * This program is distributed in the hope that it will be useful,
  22  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  23  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  24  * GNU General Public License for more details.
  25  *
  26  * You should have received a copy of the GNU General Public License
  27  * along with this program; if not, write to the Free Software
  28  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  29  */
  30
  31 #include <linux/module.h>
  32 #include <linux/delay.h>
  33 #include <linux/types.h>
  34 #include <linux/ioctl.h>
  35 #include <asm/uaccess.h>
  36 #include <linux/i2c.h>
  37 #include <linux/i2c-id.h>
  38 #include <linux/videodev.h>
  39 #include <linux/video_decoder.h>
  40 #include <media/v4l2-common.h>
  41 #include <media/v4l2-i2c-drv-legacy.h>
  42
  43 MODULE_DESCRIPTION("Brooktree-819 video decoder driver");
  44 MODULE_AUTHOR("Mike Bernson & Dave Perks");
  45 MODULE_LICENSE("GPL");
  46
  47 static int debug;
  48 module_param(debug, int, 0);
  49 MODULE_PARM_DESC(debug, "Debug level (0-1)");
  50
  51 /* ----------------------------------------------------------------------- */
  52
  53 struct bt819 {
  54         unsigned char reg[32];
  55
  56         int initialized;
  57         int norm;
  58         int input;
  59         int enable;
  60         int bright;
  61         int contrast;
  62         int hue;
  63         int sat;
  64 };
  65
  66 struct timing {
  67         int hactive;
  68         int hdelay;
  69         int vactive;
  70         int vdelay;
  71         int hscale;
  72         int vscale;
  73 };
  74
  75 /* for values, see the bt819 datasheet */
  76 static struct timing timing_data[] = {
  77         {864 - 24, 20, 625 - 2, 1, 0x0504, 0x0000},
  78         {858 - 24, 20, 525 - 2, 1, 0x00f8, 0x0000},
  79 };
  80
  81 /* ----------------------------------------------------------------------- */
  82
  83 static inline int bt819_write(struct i2c_client *client, u8 reg, u8 value)
  84 {
  85         struct bt819 *decoder = i2c_get_clientdata(client);
  86
  87         decoder->reg[reg] = value;
  88         return i2c_smbus_write_byte_data(client, reg, value);
  89 }
  90
  91 static inline int bt819_setbit(struct i2c_client *client, u8 reg, u8 bit, u8 value)
  92 {
  93         struct bt819 *decoder = i2c_get_clientdata(client);
  94
  95         return bt819_write(client, reg,
  96                 (decoder->reg[reg] & ~(1 << bit)) | (value ? (1 << bit) : 0));
  97 }
  98
  99 static int bt819_write_block(struct i2c_client *client, const u8 *data, unsigned int len)
 100 {
 101         int ret = -1;
 102         u8 reg;
 103
 104         /* the bt819 has an autoincrement function, use it if
 105          * the adapter understands raw I2C */
 106         if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
 107                 /* do raw I2C, not smbus compatible */
 108                 struct bt819 *decoder = i2c_get_clientdata(client);
 109                 u8 block_data[32];
 110                 int block_len;
 111
 112                 while (len >= 2) {
 113                         block_len = 0;
 114                         block_data[block_len++] = reg = data[0];
 115                         do {
 116                                 block_data[block_len++] =
 117                                     decoder->reg[reg++] = data[1];
 118                                 len -= 2;
 119                                 data += 2;
 120                         } while (len >= 2 && data[0] == reg && block_len < 32);
 121                         ret = i2c_master_send(client, block_data, block_len);
 122                         if (ret < 0)
 123                                 break;
 124                 }
 125         } else {
 126                 /* do some slow I2C emulation kind of thing */
 127                 while (len >= 2) {
 128                         reg = *data++;
 129                         if ((ret = bt819_write(client, reg, *data++)) < 0)
 130                                 break;
 131                         len -= 2;
 132                 }
 133         }
 134
 135         return ret;
 136 }
 137
 138 static inline int bt819_read(struct i2c_client *client, u8 reg)
 139 {
 140         return i2c_smbus_read_byte_data(client, reg);
 141 }
 142
 143 static int bt819_init(struct i2c_client *client)
 144 {
 145         struct bt819 *decoder = i2c_get_clientdata(client);
 146
 147         static unsigned char init[] = {
 148                 /*0x1f, 0x00,*/     /* Reset */
 149                 0x01, 0x59,     /* 0x01 input format */
 150                 0x02, 0x00,     /* 0x02 temporal decimation */
 151                 0x03, 0x12,     /* 0x03 Cropping msb */
 152                 0x04, 0x16,     /* 0x04 Vertical Delay, lsb */
 153                 0x05, 0xe0,     /* 0x05 Vertical Active lsb */
 154                 0x06, 0x80,     /* 0x06 Horizontal Delay lsb */
 155                 0x07, 0xd0,     /* 0x07 Horizontal Active lsb */
 156                 0x08, 0x00,     /* 0x08 Horizontal Scaling msb */
 157                 0x09, 0xf8,     /* 0x09 Horizontal Scaling lsb */
 158                 0x0a, 0x00,     /* 0x0a Brightness control */
 159                 0x0b, 0x30,     /* 0x0b Miscellaneous control */
 160                 0x0c, 0xd8,     /* 0x0c Luma Gain lsb */
 161                 0x0d, 0xfe,     /* 0x0d Chroma Gain (U) lsb */
 162                 0x0e, 0xb4,     /* 0x0e Chroma Gain (V) msb */
 163                 0x0f, 0x00,     /* 0x0f Hue control */
 164                 0x12, 0x04,     /* 0x12 Output Format */
 165                 0x13, 0x20,     /* 0x13 Vertial Scaling msb 0x00
 166                                            chroma comb OFF, line drop scaling, interlace scaling
 167                                            BUG? Why does turning the chroma comb on fuck up color?
 168                                            Bug in the bt819 stepping on my board?
 169                                         */
 170                 0x14, 0x00,     /* 0x14 Vertial Scaling lsb */
 171                 0x16, 0x07,     /* 0x16 Video Timing Polarity
 172                                            ACTIVE=active low
 173                                            FIELD: high=odd,
 174                                            vreset=active high,
 175                                            hreset=active high */
 176                 0x18, 0x68,     /* 0x18 AGC Delay */
 177                 0x19, 0x5d,     /* 0x19 Burst Gate Delay */
 178                 0x1a, 0x80,     /* 0x1a ADC Interface */
 179         };
 180
 181         struct timing *timing = &timing_data[decoder->norm];
 182
 183         init[0x03 * 2 - 1] =
 184             (((timing->vdelay >> 8) & 0x03) << 6) |
 185             (((timing->vactive >> 8) & 0x03) << 4) |
 186             (((timing->hdelay >> 8) & 0x03) << 2) |
 187             ((timing->hactive >> 8) & 0x03);
 188         init[0x04 * 2 - 1] = timing->vdelay & 0xff;
 189         init[0x05 * 2 - 1] = timing->vactive & 0xff;
 190         init[0x06 * 2 - 1] = timing->hdelay & 0xff;
 191         init[0x07 * 2 - 1] = timing->hactive & 0xff;
 192         init[0x08 * 2 - 1] = timing->hscale >> 8;
 193         init[0x09 * 2 - 1] = timing->hscale & 0xff;
 194         /* 0x15 in array is address 0x19 */
 195         init[0x15 * 2 - 1] = (decoder->norm == 0) ? 115 : 93;   /* Chroma burst delay */
 196         /* reset */
 197         bt819_write(client, 0x1f, 0x00);
 198         mdelay(1);
 199
 200         /* init */
 201         return bt819_write_block(client, init, sizeof(init));
 202 }
 203
 204 /* ----------------------------------------------------------------------- */
 205
 206 static int bt819_command(struct i2c_client *client, unsigned cmd, void *arg)
 207 {
 208         int temp;
 209
 210         struct bt819 *decoder = i2c_get_clientdata(client);
 211
 212         if (!decoder->initialized) {    /* First call to bt819_init could be */
 213                 bt819_init(client);     /* without #FRST = 0 */
 214                 decoder->initialized = 1;
 215         }
 216
 217         switch (cmd) {
 218         case 0:
 219                 /* This is just for testing!!! */
 220                 bt819_init(client);
 221                 break;
 222
 223         case DECODER_GET_CAPABILITIES:
 224         {
 225                 struct video_decoder_capability *cap = arg;
 226
 227                 cap->flags = VIDEO_DECODER_PAL |
 228                              VIDEO_DECODER_NTSC |
 229                              VIDEO_DECODER_AUTO |
 230                              VIDEO_DECODER_CCIR;
 231                 cap->inputs = 8;
 232                 cap->outputs = 1;
 233                 break;
 234         }
 235
 236         case DECODER_GET_STATUS:
 237         {
 238                 int *iarg = arg;
 239                 int status;
 240                 int res;
 241
 242                 status = bt819_read(client, 0x00);
 243                 res = 0;
 244                 if ((status & 0x80))
 245                         res |= DECODER_STATUS_GOOD;
 246
 247                 switch (decoder->norm) {
 248                 case VIDEO_MODE_NTSC:
 249                         res |= DECODER_STATUS_NTSC;
 250                         break;
 251                 case VIDEO_MODE_PAL:
 252                         res |= DECODER_STATUS_PAL;
 253                         break;
 254                 default:
 255                 case VIDEO_MODE_AUTO:
 256                         if ((status & 0x10))
 257                                 res |= DECODER_STATUS_PAL;
 258                         else
 259                                 res |= DECODER_STATUS_NTSC;
 260                         break;
 261                 }
 262                 res |= DECODER_STATUS_COLOR;
 263                 *iarg = res;
 264
 265                 v4l_dbg(1, debug, client, "get status %x\n", *iarg);
 266                 break;
 267         }
 268
 269         case DECODER_SET_NORM:
 270         {
 271                 int *iarg = arg;
 272                 struct timing *timing = NULL;
 273
 274                 v4l_dbg(1, debug, client, "set norm %x\n", *iarg);
 275
 276                 switch (*iarg) {
 277                 case VIDEO_MODE_NTSC:
 278                         bt819_setbit(client, 0x01, 0, 1);
 279                         bt819_setbit(client, 0x01, 1, 0);
 280                         bt819_setbit(client, 0x01, 5, 0);
 281                         bt819_write(client, 0x18, 0x68);
 282                         bt819_write(client, 0x19, 0x5d);
 283                         /* bt819_setbit(client, 0x1a,  5, 1); */
 284                         timing = &timing_data[VIDEO_MODE_NTSC];
 285                         break;
 286                 case VIDEO_MODE_PAL:
 287                         bt819_setbit(client, 0x01, 0, 1);
 288                         bt819_setbit(client, 0x01, 1, 1);
 289                         bt819_setbit(client, 0x01, 5, 1);
 290                         bt819_write(client, 0x18, 0x7f);
 291                         bt819_write(client, 0x19, 0x72);
 292                         /* bt819_setbit(client, 0x1a,  5, 0); */
 293                         timing = &timing_data[VIDEO_MODE_PAL];
 294                         break;
 295                 case VIDEO_MODE_AUTO:
 296                         bt819_setbit(client, 0x01, 0, 0);
 297                         bt819_setbit(client, 0x01, 1, 0);
 298                         break;
 299                 default:
 300                         v4l_dbg(1, debug, client, "unsupported norm %x\n", *iarg);
 301                         return -EINVAL;
 302                 }
 303
 304                 if (timing) {
 305                         bt819_write(client, 0x03,
 306                                     (((timing->vdelay >> 8) & 0x03) << 6) |
 307                                     (((timing->vactive >> 8) & 0x03) << 4) |
 308                                     (((timing->hdelay >> 8) & 0x03) << 2) |
 309                                      ((timing->hactive >> 8) & 0x03) );
 310                         bt819_write(client, 0x04, timing->vdelay & 0xff);
 311                         bt819_write(client, 0x05, timing->vactive & 0xff);
 312                         bt819_write(client, 0x06, timing->hdelay & 0xff);
 313                         bt819_write(client, 0x07, timing->hactive & 0xff);
 314                         bt819_write(client, 0x08, (timing->hscale >> 8) & 0xff);
 315                         bt819_write(client, 0x09, timing->hscale & 0xff);
 316                 }
 317
 318                 decoder->norm = *iarg;
 319                 break;
 320         }
 321
 322         case DECODER_SET_INPUT:
 323         {
 324                 int *iarg = arg;
 325
 326                 v4l_dbg(1, debug, client, "set input %x\n", *iarg);
 327
 328                 if (*iarg < 0 || *iarg > 7)
 329                         return -EINVAL;
 330
 331                 if (decoder->input != *iarg) {
 332                         decoder->input = *iarg;
 333                         /* select mode */
 334                         if (decoder->input == 0) {
 335                                 bt819_setbit(client, 0x0b, 6, 0);
 336                                 bt819_setbit(client, 0x1a, 1, 1);
 337                         } else {
 338                                 bt819_setbit(client, 0x0b, 6, 1);
 339                                 bt819_setbit(client, 0x1a, 1, 0);
 340                         }
 341                 }
 342                 break;
 343         }
 344
 345         case DECODER_SET_OUTPUT:
 346         {
 347                 int *iarg = arg;
 348
 349                 v4l_dbg(1, debug, client, "set output %x\n", *iarg);
 350
 351                 /* not much choice of outputs */
 352                 if (*iarg != 0)
 353                         return -EINVAL;
 354                 break;
 355         }
 356
 357         case DECODER_ENABLE_OUTPUT:
 358         {
 359                 int *iarg = arg;
 360                 int enable = (*iarg != 0);
 361
 362                 v4l_dbg(1, debug, client, "enable output %x\n", *iarg);
 363
 364                 if (decoder->enable != enable) {
 365                         decoder->enable = enable;
 366                         bt819_setbit(client, 0x16, 7, !enable);
 367                 }
 368                 break;
 369         }
 370
 371         case DECODER_SET_PICTURE:
 372         {
 373                 struct video_picture *pic = arg;
 374
 375                 v4l_dbg(1, debug, client,
 376                         "set picture brightness %d contrast %d colour %d\n",
 377                         pic->brightness, pic->contrast, pic->colour);
 378
 379
 380                 if (decoder->bright != pic->brightness) {
 381                         /* We want -128 to 127 we get 0-65535 */
 382                         decoder->bright = pic->brightness;
 383                         bt819_write(client, 0x0a,
 384                                     (decoder->bright >> 8) - 128);
 385                 }
 386
 387                 if (decoder->contrast != pic->contrast) {
 388                         /* We want 0 to 511 we get 0-65535 */
 389                         decoder->contrast = pic->contrast;
 390                         bt819_write(client, 0x0c,
 391                                     (decoder->contrast >> 7) & 0xff);
 392                         bt819_setbit(client, 0x0b, 2,
 393                                      ((decoder->contrast >> 15) & 0x01));
 394                 }
 395
 396                 if (decoder->sat != pic->colour) {
 397                         /* We want 0 to 511 we get 0-65535 */
 398                         decoder->sat = pic->colour;
 399                         bt819_write(client, 0x0d,
 400                                     (decoder->sat >> 7) & 0xff);
 401                         bt819_setbit(client, 0x0b, 1,
 402                                      ((decoder->sat >> 15) & 0x01));
 403
 404                         temp = (decoder->sat * 201) / 237;
 405                         bt819_write(client, 0x0e, (temp >> 7) & 0xff);
 406                         bt819_setbit(client, 0x0b, 0, (temp >> 15) & 0x01);
 407                 }
 408
 409                 if (decoder->hue != pic->hue) {
 410                         /* We want -128 to 127 we get 0-65535 */
 411                         decoder->hue = pic->hue;
 412                         bt819_write(client, 0x0f,
 413                                     128 - (decoder->hue >> 8));
 414                 }
 415                 break;
 416         }
 417
 418         default:
 419                 return -EINVAL;
 420         }
 421
 422         return 0;
 423 }
 424
 425 /* ----------------------------------------------------------------------- */
 426
 427 static unsigned short normal_i2c[] = { 0x8a >> 1, I2C_CLIENT_END };
 428
 429 I2C_CLIENT_INSMOD;
 430
 431 static int bt819_probe(struct i2c_client *client,
 432                         const struct i2c_device_id *id)
 433 {
 434         int i, ver;
 435         struct bt819 *decoder;
 436         const char *name;
 437
 438         /* Check if the adapter supports the needed features */
 439         if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 440                 return -ENODEV;
 441
 442         ver = bt819_read(client, 0x17);
 443         switch (ver & 0xf0) {
 444         case 0x70:
 445                 name = "bt819a";
 446                 break;
 447         case 0x60:
 448                 name = "bt817a";
 449                 break;
 450         case 0x20:
 451                 name = "bt815a";
 452                 break;
 453         default:
 454                 v4l_dbg(1, debug, client,
 455                         "unknown chip version 0x%02x\n", ver);
 456                 return -ENODEV;
 457         }
 458
 459         v4l_info(client, "%s found @ 0x%x (%s)\n", name,
 460                         client->addr << 1, client->adapter->name);
 461
 462         decoder = kzalloc(sizeof(struct bt819), GFP_KERNEL);
 463         if (decoder == NULL)
 464                 return -ENOMEM;
 465         decoder->norm = VIDEO_MODE_NTSC;
 466         decoder->input = 0;
 467         decoder->enable = 1;
 468         decoder->bright = 32768;
 469         decoder->contrast = 32768;
 470         decoder->hue = 32768;
 471         decoder->sat = 32768;
 472         decoder->initialized = 0;
 473         i2c_set_clientdata(client, decoder);
 474
 475         i = bt819_init(client);
 476         if (i < 0)
 477                 v4l_dbg(1, debug, client, "init status %d\n", i);
 478         return 0;
 479 }
 480
 481 static int bt819_remove(struct i2c_client *client)
 482 {
 483         kfree(i2c_get_clientdata(client));
 484         return 0;
 485 }
 486
 487 /* ----------------------------------------------------------------------- */
 488
 489 static const struct i2c_device_id bt819_id[] = {
 490         { "bt819a", 0 },
 491         { "bt817a", 0 },
 492         { "bt815a", 0 },
 493         { }
 494 };
 495 MODULE_DEVICE_TABLE(i2c, bt819_id);
 496
 497 static struct v4l2_i2c_driver_data v4l2_i2c_data = {
 498         .name = "bt819",
 499         .driverid = I2C_DRIVERID_BT819,
 500         .command = bt819_command,
 501         .probe = bt819_probe,
 502         .remove = bt819_remove,
 503         .id_table = bt819_id,
 504 };