err.no Git - linux-2.6/blob - drivers/media/video/saa7127.c

   1 /*
   2  * saa7127 - Philips SAA7127/SAA7129 video encoder driver
   3  *
   4  * Copyright (C) 2003 Roy Bulter <rbulter@hetnet.nl>
   5  *
   6  * Based on SAA7126 video encoder driver by Gillem & Andreas Oberritter
   7  *
   8  * Copyright (C) 2000-2001 Gillem <htoa@gmx.net>
   9  * Copyright (C) 2002 Andreas Oberritter <obi@saftware.de>
  10  *
  11  * Based on Stadis 4:2:2 MPEG-2 Decoder Driver by Nathan Laredo
  12  *
  13  * Copyright (C) 1999 Nathan Laredo <laredo@gnu.org>
  14  *
  15  * This driver is designed for the Hauppauge 250/350 Linux driver
  16  * from the ivtv Project
  17  *
  18  * Copyright (C) 2003 Kevin Thayer <nufan_wfk@yahoo.com>
  19  *
  20  * Dual output support:
  21  * Copyright (C) 2004 Eric Varsanyi
  22  *
  23  * NTSC Tuning and 7.5 IRE Setup
  24  * Copyright (C) 2004  Chris Kennedy <c@groovy.org>
  25  *
  26  * VBI additions & cleanup:
  27  * Copyright (C) 2004, 2005 Hans Verkuil <hverkuil@xs4all.nl>
  28  *
  29  * Note: the saa7126 is identical to the saa7127, and the saa7128 is
  30  * identical to the saa7129, except that the saa7126 and saa7128 have
  31  * macrovision anti-taping support. This driver will almost certainly
  32  * work find for those chips, except of course for the missing anti-taping
  33  * support.
  34  *
  35  * This program is free software; you can redistribute it and/or modify
  36  * it under the terms of the GNU General Public License as published by
  37  * the Free Software Foundation; either version 2 of the License, or
  38  * (at your option) any later version.
  39  *
  40  * This program is distributed in the hope that it will be useful,
  41  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  42  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  43  * GNU General Public License for more details.
  44  *
  45  * You should have received a copy of the GNU General Public License
  46  * along with this program; if not, write to the Free Software
  47  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  48  */
  49
  50
  51 #include <linux/kernel.h>
  52 #include <linux/module.h>
  53 #include <linux/slab.h>
  54 #include <linux/i2c.h>
  55 #include <linux/videodev2.h>
  56 #include <media/v4l2-common.h>
  57 #include <media/v4l2-chip-ident.h>
  58 #include <media/v4l2-i2c-drv-legacy.h>
  59 #include <media/saa7127.h>
  60
  61 static int debug = 0;
  62 static int test_image = 0;
  63
  64 MODULE_DESCRIPTION("Philips SAA7127/9 video encoder driver");
  65 MODULE_AUTHOR("Kevin Thayer, Chris Kennedy, Hans Verkuil");
  66 MODULE_LICENSE("GPL");
  67 module_param(debug, int, 0644);
  68 module_param(test_image, int, 0644);
  69 MODULE_PARM_DESC(debug, "debug level (0-2)");
  70 MODULE_PARM_DESC(test_image, "test_image (0-1)");
  71
  72 static unsigned short normal_i2c[] = { 0x88 >> 1, I2C_CLIENT_END };
  73
  74
  75 I2C_CLIENT_INSMOD;
  76
  77 /*
  78  * SAA7127 registers
  79  */
  80
  81 #define SAA7127_REG_STATUS                           0x00
  82 #define SAA7127_REG_WIDESCREEN_CONFIG                0x26
  83 #define SAA7127_REG_WIDESCREEN_ENABLE                0x27
  84 #define SAA7127_REG_BURST_START                      0x28
  85 #define SAA7127_REG_BURST_END                        0x29
  86 #define SAA7127_REG_COPYGEN_0                        0x2a
  87 #define SAA7127_REG_COPYGEN_1                        0x2b
  88 #define SAA7127_REG_COPYGEN_2                        0x2c
  89 #define SAA7127_REG_OUTPUT_PORT_CONTROL              0x2d
  90 #define SAA7127_REG_GAIN_LUMINANCE_RGB               0x38
  91 #define SAA7127_REG_GAIN_COLORDIFF_RGB               0x39
  92 #define SAA7127_REG_INPUT_PORT_CONTROL_1             0x3a
  93 #define SAA7129_REG_FADE_KEY_COL2                    0x4f
  94 #define SAA7127_REG_CHROMA_PHASE                     0x5a
  95 #define SAA7127_REG_GAINU                            0x5b
  96 #define SAA7127_REG_GAINV                            0x5c
  97 #define SAA7127_REG_BLACK_LEVEL                      0x5d
  98 #define SAA7127_REG_BLANKING_LEVEL                   0x5e
  99 #define SAA7127_REG_VBI_BLANKING                     0x5f
 100 #define SAA7127_REG_DAC_CONTROL                      0x61
 101 #define SAA7127_REG_BURST_AMP                        0x62
 102 #define SAA7127_REG_SUBC3                            0x63
 103 #define SAA7127_REG_SUBC2                            0x64
 104 #define SAA7127_REG_SUBC1                            0x65
 105 #define SAA7127_REG_SUBC0                            0x66
 106 #define SAA7127_REG_LINE_21_ODD_0                    0x67
 107 #define SAA7127_REG_LINE_21_ODD_1                    0x68
 108 #define SAA7127_REG_LINE_21_EVEN_0                   0x69
 109 #define SAA7127_REG_LINE_21_EVEN_1                   0x6a
 110 #define SAA7127_REG_RCV_PORT_CONTROL                 0x6b
 111 #define SAA7127_REG_VTRIG                            0x6c
 112 #define SAA7127_REG_HTRIG_HI                         0x6d
 113 #define SAA7127_REG_MULTI                            0x6e
 114 #define SAA7127_REG_CLOSED_CAPTION                   0x6f
 115 #define SAA7127_REG_RCV2_OUTPUT_START                0x70
 116 #define SAA7127_REG_RCV2_OUTPUT_END                  0x71
 117 #define SAA7127_REG_RCV2_OUTPUT_MSBS                 0x72
 118 #define SAA7127_REG_TTX_REQUEST_H_START              0x73
 119 #define SAA7127_REG_TTX_REQUEST_H_DELAY_LENGTH       0x74
 120 #define SAA7127_REG_CSYNC_ADVANCE_VSYNC_SHIFT        0x75
 121 #define SAA7127_REG_TTX_ODD_REQ_VERT_START           0x76
 122 #define SAA7127_REG_TTX_ODD_REQ_VERT_END             0x77
 123 #define SAA7127_REG_TTX_EVEN_REQ_VERT_START          0x78
 124 #define SAA7127_REG_TTX_EVEN_REQ_VERT_END            0x79
 125 #define SAA7127_REG_FIRST_ACTIVE                     0x7a
 126 #define SAA7127_REG_LAST_ACTIVE                      0x7b
 127 #define SAA7127_REG_MSB_VERTICAL                     0x7c
 128 #define SAA7127_REG_DISABLE_TTX_LINE_LO_0            0x7e
 129 #define SAA7127_REG_DISABLE_TTX_LINE_LO_1            0x7f
 130
 131 /*
 132  **********************************************************************
 133  *
 134  *  Arrays with configuration parameters for the SAA7127
 135  *
 136  **********************************************************************
 137  */
 138
 139 struct i2c_reg_value {
 140         unsigned char reg;
 141         unsigned char value;
 142 };
 143
 144 static const struct i2c_reg_value saa7129_init_config_extra[] = {
 145         { SAA7127_REG_OUTPUT_PORT_CONTROL,              0x38 },
 146         { SAA7127_REG_VTRIG,                            0xfa },
 147         { 0, 0 }
 148 };
 149
 150 static const struct i2c_reg_value saa7127_init_config_common[] = {
 151         { SAA7127_REG_WIDESCREEN_CONFIG,                0x0d },
 152         { SAA7127_REG_WIDESCREEN_ENABLE,                0x00 },
 153         { SAA7127_REG_COPYGEN_0,                        0x77 },
 154         { SAA7127_REG_COPYGEN_1,                        0x41 },
 155         { SAA7127_REG_COPYGEN_2,                        0x00 }, /* Macrovision enable/disable */
 156         { SAA7127_REG_OUTPUT_PORT_CONTROL,              0x9e },
 157         { SAA7127_REG_GAIN_LUMINANCE_RGB,               0x00 },
 158         { SAA7127_REG_GAIN_COLORDIFF_RGB,               0x00 },
 159         { SAA7127_REG_INPUT_PORT_CONTROL_1,             0x80 }, /* for color bars */
 160         { SAA7127_REG_LINE_21_ODD_0,                    0x77 },
 161         { SAA7127_REG_LINE_21_ODD_1,                    0x41 },
 162         { SAA7127_REG_LINE_21_EVEN_0,                   0x88 },
 163         { SAA7127_REG_LINE_21_EVEN_1,                   0x41 },
 164         { SAA7127_REG_RCV_PORT_CONTROL,                 0x12 },
 165         { SAA7127_REG_VTRIG,                            0xf9 },
 166         { SAA7127_REG_HTRIG_HI,                         0x00 },
 167         { SAA7127_REG_RCV2_OUTPUT_START,                0x41 },
 168         { SAA7127_REG_RCV2_OUTPUT_END,                  0xc3 },
 169         { SAA7127_REG_RCV2_OUTPUT_MSBS,                 0x00 },
 170         { SAA7127_REG_TTX_REQUEST_H_START,              0x3e },
 171         { SAA7127_REG_TTX_REQUEST_H_DELAY_LENGTH,       0xb8 },
 172         { SAA7127_REG_CSYNC_ADVANCE_VSYNC_SHIFT,        0x03 },
 173         { SAA7127_REG_TTX_ODD_REQ_VERT_START,           0x15 },
 174         { SAA7127_REG_TTX_ODD_REQ_VERT_END,             0x16 },
 175         { SAA7127_REG_TTX_EVEN_REQ_VERT_START,          0x15 },
 176         { SAA7127_REG_TTX_EVEN_REQ_VERT_END,            0x16 },
 177         { SAA7127_REG_FIRST_ACTIVE,                     0x1a },
 178         { SAA7127_REG_LAST_ACTIVE,                      0x01 },
 179         { SAA7127_REG_MSB_VERTICAL,                     0xc0 },
 180         { SAA7127_REG_DISABLE_TTX_LINE_LO_0,            0x00 },
 181         { SAA7127_REG_DISABLE_TTX_LINE_LO_1,            0x00 },
 182         { 0, 0 }
 183 };
 184
 185 #define SAA7127_60HZ_DAC_CONTROL 0x15
 186 static const struct i2c_reg_value saa7127_init_config_60hz[] = {
 187         { SAA7127_REG_BURST_START,                      0x19 },
 188         /* BURST_END is also used as a chip ID in saa7127_detect_client */
 189         { SAA7127_REG_BURST_END,                        0x1d },
 190         { SAA7127_REG_CHROMA_PHASE,                     0xa3 },
 191         { SAA7127_REG_GAINU,                            0x98 },
 192         { SAA7127_REG_GAINV,                            0xd3 },
 193         { SAA7127_REG_BLACK_LEVEL,                      0x39 },
 194         { SAA7127_REG_BLANKING_LEVEL,                   0x2e },
 195         { SAA7127_REG_VBI_BLANKING,                     0x2e },
 196         { SAA7127_REG_DAC_CONTROL,                      0x15 },
 197         { SAA7127_REG_BURST_AMP,                        0x4d },
 198         { SAA7127_REG_SUBC3,                            0x1f },
 199         { SAA7127_REG_SUBC2,                            0x7c },
 200         { SAA7127_REG_SUBC1,                            0xf0 },
 201         { SAA7127_REG_SUBC0,                            0x21 },
 202         { SAA7127_REG_MULTI,                            0x90 },
 203         { SAA7127_REG_CLOSED_CAPTION,                   0x11 },
 204         { 0, 0 }
 205 };
 206
 207 #define SAA7127_50HZ_DAC_CONTROL 0x02
 208 static struct i2c_reg_value saa7127_init_config_50hz[] = {
 209         { SAA7127_REG_BURST_START,                      0x21 },
 210         /* BURST_END is also used as a chip ID in saa7127_detect_client */
 211         { SAA7127_REG_BURST_END,                        0x1d },
 212         { SAA7127_REG_CHROMA_PHASE,                     0x3f },
 213         { SAA7127_REG_GAINU,                            0x7d },
 214         { SAA7127_REG_GAINV,                            0xaf },
 215         { SAA7127_REG_BLACK_LEVEL,                      0x33 },
 216         { SAA7127_REG_BLANKING_LEVEL,                   0x35 },
 217         { SAA7127_REG_VBI_BLANKING,                     0x35 },
 218         { SAA7127_REG_DAC_CONTROL,                      0x02 },
 219         { SAA7127_REG_BURST_AMP,                        0x2f },
 220         { SAA7127_REG_SUBC3,                            0xcb },
 221         { SAA7127_REG_SUBC2,                            0x8a },
 222         { SAA7127_REG_SUBC1,                            0x09 },
 223         { SAA7127_REG_SUBC0,                            0x2a },
 224         { SAA7127_REG_MULTI,                            0xa0 },
 225         { SAA7127_REG_CLOSED_CAPTION,                   0x00 },
 226         { 0, 0 }
 227 };
 228
 229 /*
 230  **********************************************************************
 231  *
 232  *  Encoder Struct, holds the configuration state of the encoder
 233  *
 234  **********************************************************************
 235  */
 236
 237 struct saa7127_state {
 238         v4l2_std_id std;
 239         u32 ident;
 240         enum saa7127_input_type input_type;
 241         enum saa7127_output_type output_type;
 242         int video_enable;
 243         int wss_enable;
 244         u16 wss_mode;
 245         int cc_enable;
 246         u16 cc_data;
 247         int xds_enable;
 248         u16 xds_data;
 249         int vps_enable;
 250         u8 vps_data[5];
 251         u8 reg_2d;
 252         u8 reg_3a;
 253         u8 reg_3a_cb;   /* colorbar bit */
 254         u8 reg_61;
 255 };
 256
 257 static const char * const output_strs[] =
 258 {
 259         "S-Video + Composite",
 260         "Composite",
 261         "S-Video",
 262         "RGB",
 263         "YUV C",
 264         "YUV V"
 265 };
 266
 267 static const char * const wss_strs[] = {
 268         "invalid",
 269         "letterbox 14:9 center",
 270         "letterbox 14:9 top",
 271         "invalid",
 272         "letterbox 16:9 top",
 273         "invalid",
 274         "invalid",
 275         "16:9 full format anamorphic",
 276         "4:3 full format",
 277         "invalid",
 278         "invalid",
 279         "letterbox 16:9 center",
 280         "invalid",
 281         "letterbox >16:9 center",
 282         "14:9 full format center",
 283         "invalid",
 284 };
 285
 286 /* ----------------------------------------------------------------------- */
 287
 288 static int saa7127_read(struct i2c_client *client, u8 reg)
 289 {
 290         return i2c_smbus_read_byte_data(client, reg);
 291 }
 292
 293 /* ----------------------------------------------------------------------- */
 294
 295 static int saa7127_write(struct i2c_client *client, u8 reg, u8 val)
 296 {
 297         int i;
 298
 299         for (i = 0; i < 3; i++) {
 300                 if (i2c_smbus_write_byte_data(client, reg, val) == 0)
 301                         return 0;
 302         }
 303         v4l_err(client, "I2C Write Problem\n");
 304         return -1;
 305 }
 306
 307 /* ----------------------------------------------------------------------- */
 308
 309 static int saa7127_write_inittab(struct i2c_client *client,
 310                                  const struct i2c_reg_value *regs)
 311 {
 312         while (regs->reg != 0) {
 313                 saa7127_write(client, regs->reg, regs->value);
 314                 regs++;
 315         }
 316         return 0;
 317 }
 318
 319 /* ----------------------------------------------------------------------- */
 320
 321 static int saa7127_set_vps(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
 322 {
 323         struct saa7127_state *state = i2c_get_clientdata(client);
 324         int enable = (data->line != 0);
 325
 326         if (enable && (data->field != 0 || data->line != 16))
 327                 return -EINVAL;
 328         if (state->vps_enable != enable) {
 329                 v4l_dbg(1, debug, client, "Turn VPS Signal %s\n", enable ? "on" : "off");
 330                 saa7127_write(client, 0x54, enable << 7);
 331                 state->vps_enable = enable;
 332         }
 333         if (!enable)
 334                 return 0;
 335
 336         state->vps_data[0] = data->data[2];
 337         state->vps_data[1] = data->data[8];
 338         state->vps_data[2] = data->data[9];
 339         state->vps_data[3] = data->data[10];
 340         state->vps_data[4] = data->data[11];
 341         v4l_dbg(1, debug, client, "Set VPS data %02x %02x %02x %02x %02x\n",
 342                 state->vps_data[0], state->vps_data[1],
 343                 state->vps_data[2], state->vps_data[3],
 344                 state->vps_data[4]);
 345         saa7127_write(client, 0x55, state->vps_data[0]);
 346         saa7127_write(client, 0x56, state->vps_data[1]);
 347         saa7127_write(client, 0x57, state->vps_data[2]);
 348         saa7127_write(client, 0x58, state->vps_data[3]);
 349         saa7127_write(client, 0x59, state->vps_data[4]);
 350         return 0;
 351 }
 352
 353 /* ----------------------------------------------------------------------- */
 354
 355 static int saa7127_set_cc(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
 356 {
 357         struct saa7127_state *state = i2c_get_clientdata(client);
 358         u16 cc = data->data[1] << 8 | data->data[0];
 359         int enable = (data->line != 0);
 360
 361         if (enable && (data->field != 0 || data->line != 21))
 362                 return -EINVAL;
 363         if (state->cc_enable != enable) {
 364                 v4l_dbg(1, debug, client, "Turn CC %s\n", enable ? "on" : "off");
 365                 saa7127_write(client, SAA7127_REG_CLOSED_CAPTION,
 366                                 (state->xds_enable << 7) | (enable << 6) | 0x11);
 367                 state->cc_enable = enable;
 368         }
 369         if (!enable)
 370                 return 0;
 371
 372         v4l_dbg(2, debug, client, "CC data: %04x\n", cc);
 373         saa7127_write(client, SAA7127_REG_LINE_21_ODD_0, cc & 0xff);
 374         saa7127_write(client, SAA7127_REG_LINE_21_ODD_1, cc >> 8);
 375         state->cc_data = cc;
 376         return 0;
 377 }
 378
 379 /* ----------------------------------------------------------------------- */
 380
 381 static int saa7127_set_xds(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
 382 {
 383         struct saa7127_state *state = i2c_get_clientdata(client);
 384         u16 xds = data->data[1] << 8 | data->data[0];
 385         int enable = (data->line != 0);
 386
 387         if (enable && (data->field != 1 || data->line != 21))
 388                 return -EINVAL;
 389         if (state->xds_enable != enable) {
 390                 v4l_dbg(1, debug, client, "Turn XDS %s\n", enable ? "on" : "off");
 391                 saa7127_write(client, SAA7127_REG_CLOSED_CAPTION,
 392                                 (enable << 7) | (state->cc_enable << 6) | 0x11);
 393                 state->xds_enable = enable;
 394         }
 395         if (!enable)
 396                 return 0;
 397
 398         v4l_dbg(2, debug, client, "XDS data: %04x\n", xds);
 399         saa7127_write(client, SAA7127_REG_LINE_21_EVEN_0, xds & 0xff);
 400         saa7127_write(client, SAA7127_REG_LINE_21_EVEN_1, xds >> 8);
 401         state->xds_data = xds;
 402         return 0;
 403 }
 404
 405 /* ----------------------------------------------------------------------- */
 406
 407 static int saa7127_set_wss(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
 408 {
 409         struct saa7127_state *state = i2c_get_clientdata(client);
 410         int enable = (data->line != 0);
 411
 412         if (enable && (data->field != 0 || data->line != 23))
 413                 return -EINVAL;
 414         if (state->wss_enable != enable) {
 415                 v4l_dbg(1, debug, client, "Turn WSS %s\n", enable ? "on" : "off");
 416                 saa7127_write(client, 0x27, enable << 7);
 417                 state->wss_enable = enable;
 418         }
 419         if (!enable)
 420                 return 0;
 421
 422         saa7127_write(client, 0x26, data->data[0]);
 423         saa7127_write(client, 0x27, 0x80 | (data->data[1] & 0x3f));
 424         v4l_dbg(1, debug, client, "WSS mode: %s\n", wss_strs[data->data[0] & 0xf]);
 425         state->wss_mode = (data->data[1] & 0x3f) << 8 | data->data[0];
 426         return 0;
 427 }
 428
 429 /* ----------------------------------------------------------------------- */
 430
 431 static int saa7127_set_video_enable(struct i2c_client *client, int enable)
 432 {
 433         struct saa7127_state *state = i2c_get_clientdata(client);
 434
 435         if (enable) {
 436                 v4l_dbg(1, debug, client, "Enable Video Output\n");
 437                 saa7127_write(client, 0x2d, state->reg_2d);
 438                 saa7127_write(client, 0x61, state->reg_61);
 439         } else {
 440                 v4l_dbg(1, debug, client, "Disable Video Output\n");
 441                 saa7127_write(client, 0x2d, (state->reg_2d & 0xf0));
 442                 saa7127_write(client, 0x61, (state->reg_61 | 0xc0));
 443         }
 444         state->video_enable = enable;
 445         return 0;
 446 }
 447
 448 /* ----------------------------------------------------------------------- */
 449
 450 static int saa7127_set_std(struct i2c_client *client, v4l2_std_id std)
 451 {
 452         struct saa7127_state *state = i2c_get_clientdata(client);
 453         const struct i2c_reg_value *inittab;
 454
 455         if (std & V4L2_STD_525_60) {
 456                 v4l_dbg(1, debug, client, "Selecting 60 Hz video Standard\n");
 457                 inittab = saa7127_init_config_60hz;
 458                 state->reg_61 = SAA7127_60HZ_DAC_CONTROL;
 459         } else {
 460                 v4l_dbg(1, debug, client, "Selecting 50 Hz video Standard\n");
 461                 inittab = saa7127_init_config_50hz;
 462                 state->reg_61 = SAA7127_50HZ_DAC_CONTROL;
 463         }
 464
 465         /* Write Table */
 466         saa7127_write_inittab(client, inittab);
 467         state->std = std;
 468         return 0;
 469 }
 470
 471 /* ----------------------------------------------------------------------- */
 472
 473 static int saa7127_set_output_type(struct i2c_client *client, int output)
 474 {
 475         struct saa7127_state *state = i2c_get_clientdata(client);
 476
 477         switch (output) {
 478         case SAA7127_OUTPUT_TYPE_RGB:
 479                 state->reg_2d = 0x0f;   /* RGB + CVBS (for sync) */
 480                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 481                 break;
 482
 483         case SAA7127_OUTPUT_TYPE_COMPOSITE:
 484                 state->reg_2d = 0x08;   /* 00001000 CVBS only, RGB DAC's off (high impedance mode) */
 485                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 486                 break;
 487
 488         case SAA7127_OUTPUT_TYPE_SVIDEO:
 489                 state->reg_2d = 0xff;   /* 11111111  croma -> R, luma -> CVBS + G + B */
 490                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 491                 break;
 492
 493         case SAA7127_OUTPUT_TYPE_YUV_V:
 494                 state->reg_2d = 0x4f;   /* reg 2D = 01001111, all DAC's on, RGB + VBS */
 495                 state->reg_3a = 0x0b;   /* reg 3A = 00001011, bypass RGB-matrix */
 496                 break;
 497
 498         case SAA7127_OUTPUT_TYPE_YUV_C:
 499                 state->reg_2d = 0x0f;   /* reg 2D = 00001111, all DAC's on, RGB + CVBS */
 500                 state->reg_3a = 0x0b;   /* reg 3A = 00001011, bypass RGB-matrix */
 501                 break;
 502
 503         case SAA7127_OUTPUT_TYPE_BOTH:
 504                 state->reg_2d = 0xbf;
 505                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 506                 break;
 507
 508         default:
 509                 return -EINVAL;
 510         }
 511         v4l_dbg(1, debug, client, "Selecting %s output type\n", output_strs[output]);
 512
 513         /* Configure Encoder */
 514         saa7127_write(client, 0x2d, state->reg_2d);
 515         saa7127_write(client, 0x3a, state->reg_3a | state->reg_3a_cb);
 516         state->output_type = output;
 517         return 0;
 518 }
 519
 520 /* ----------------------------------------------------------------------- */
 521
 522 static int saa7127_set_input_type(struct i2c_client *client, int input)
 523 {
 524         struct saa7127_state *state = i2c_get_clientdata(client);
 525
 526         switch (input) {
 527         case SAA7127_INPUT_TYPE_NORMAL: /* avia */
 528                 v4l_dbg(1, debug, client, "Selecting Normal Encoder Input\n");
 529                 state->reg_3a_cb = 0;
 530                 break;
 531
 532         case SAA7127_INPUT_TYPE_TEST_IMAGE:     /* color bar */
 533                 v4l_dbg(1, debug, client, "Selecting Color Bar generator\n");
 534                 state->reg_3a_cb = 0x80;
 535                 break;
 536
 537         default:
 538                 return -EINVAL;
 539         }
 540         saa7127_write(client, 0x3a, state->reg_3a | state->reg_3a_cb);
 541         state->input_type = input;
 542         return 0;
 543 }
 544
 545 /* ----------------------------------------------------------------------- */
 546
 547 static int saa7127_command(struct i2c_client *client,
 548                            unsigned int cmd, void *arg)
 549 {
 550         struct saa7127_state *state = i2c_get_clientdata(client);
 551         struct v4l2_format *fmt = arg;
 552         struct v4l2_routing *route = arg;
 553
 554         switch (cmd) {
 555         case VIDIOC_INT_S_STD_OUTPUT:
 556                 if (state->std == *(v4l2_std_id *)arg)
 557                         break;
 558                 return saa7127_set_std(client, *(v4l2_std_id *)arg);
 559
 560         case VIDIOC_INT_G_STD_OUTPUT:
 561                 *(v4l2_std_id *)arg = state->std;
 562                 break;
 563
 564         case VIDIOC_INT_G_VIDEO_ROUTING:
 565                 route->input = state->input_type;
 566                 route->output = state->output_type;
 567                 break;
 568
 569         case VIDIOC_INT_S_VIDEO_ROUTING:
 570         {
 571                 int rc = 0;
 572
 573                 if (state->input_type != route->input) {
 574                         rc = saa7127_set_input_type(client, route->input);
 575                 }
 576                 if (rc == 0 && state->output_type != route->output) {
 577                         rc = saa7127_set_output_type(client, route->output);
 578                 }
 579                 return rc;
 580         }
 581
 582         case VIDIOC_STREAMON:
 583         case VIDIOC_STREAMOFF:
 584                 if (state->video_enable == (cmd == VIDIOC_STREAMON))
 585                         break;
 586                 return saa7127_set_video_enable(client, cmd == VIDIOC_STREAMON);
 587
 588         case VIDIOC_G_FMT:
 589                 if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE)
 590                         return -EINVAL;
 591
 592                 memset(&fmt->fmt.sliced, 0, sizeof(fmt->fmt.sliced));
 593                 if (state->vps_enable)
 594                         fmt->fmt.sliced.service_lines[0][16] = V4L2_SLICED_VPS;
 595                 if (state->wss_enable)
 596                         fmt->fmt.sliced.service_lines[0][23] = V4L2_SLICED_WSS_625;
 597                 if (state->cc_enable) {
 598                         fmt->fmt.sliced.service_lines[0][21] = V4L2_SLICED_CAPTION_525;
 599                         fmt->fmt.sliced.service_lines[1][21] = V4L2_SLICED_CAPTION_525;
 600                 }
 601                 fmt->fmt.sliced.service_set =
 602                         (state->vps_enable ? V4L2_SLICED_VPS : 0) |
 603                         (state->wss_enable ? V4L2_SLICED_WSS_625 : 0) |
 604                         (state->cc_enable ? V4L2_SLICED_CAPTION_525 : 0);
 605                 break;
 606
 607         case VIDIOC_LOG_STATUS:
 608                 v4l_info(client, "Standard: %s\n", (state->std & V4L2_STD_525_60) ? "60 Hz" : "50 Hz");
 609                 v4l_info(client, "Input:    %s\n", state->input_type ?  "color bars" : "normal");
 610                 v4l_info(client, "Output:   %s\n", state->video_enable ?
 611                         output_strs[state->output_type] : "disabled");
 612                 v4l_info(client, "WSS:      %s\n", state->wss_enable ?
 613                         wss_strs[state->wss_mode] : "disabled");
 614                 v4l_info(client, "VPS:      %s\n", state->vps_enable ? "enabled" : "disabled");
 615                 v4l_info(client, "CC:       %s\n", state->cc_enable ? "enabled" : "disabled");
 616                 break;
 617
 618 #ifdef CONFIG_VIDEO_ADV_DEBUG
 619         case VIDIOC_DBG_G_REGISTER:
 620         case VIDIOC_DBG_S_REGISTER:
 621         {
 622                 struct v4l2_register *reg = arg;
 623
 624                 if (!v4l2_chip_match_i2c_client(client, reg->match_type, reg->match_chip))
 625                         return -EINVAL;
 626                 if (!capable(CAP_SYS_ADMIN))
 627                         return -EPERM;
 628                 if (cmd == VIDIOC_DBG_G_REGISTER)
 629                         reg->val = saa7127_read(client, reg->reg & 0xff);
 630                 else
 631                         saa7127_write(client, reg->reg & 0xff, reg->val & 0xff);
 632                 break;
 633         }
 634 #endif
 635
 636         case VIDIOC_INT_S_VBI_DATA:
 637         {
 638                 struct v4l2_sliced_vbi_data *data = arg;
 639
 640                 switch (data->id) {
 641                         case V4L2_SLICED_WSS_625:
 642                                 return saa7127_set_wss(client, data);
 643                         case V4L2_SLICED_VPS:
 644                                 return saa7127_set_vps(client, data);
 645                         case V4L2_SLICED_CAPTION_525:
 646                                 if (data->field == 0)
 647                                         return saa7127_set_cc(client, data);
 648                                 return saa7127_set_xds(client, data);
 649                         default:
 650                                 return -EINVAL;
 651                 }
 652                 break;
 653         }
 654
 655         case VIDIOC_G_CHIP_IDENT:
 656                 return v4l2_chip_ident_i2c_client(client, arg, state->ident, 0);
 657
 658         default:
 659                 return -EINVAL;
 660         }
 661         return 0;
 662 }
 663
 664 /* ----------------------------------------------------------------------- */
 665
 666 static int saa7127_probe(struct i2c_client *client)
 667 {
 668         struct saa7127_state *state;
 669         struct v4l2_sliced_vbi_data vbi = { 0, 0, 0, 0 };  /* set to disabled */
 670         int read_result = 0;
 671
 672         /* Check if the adapter supports the needed features */
 673         if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 674                 return -EIO;
 675
 676         snprintf(client->name, sizeof(client->name) - 1, "saa7127");
 677
 678         v4l_dbg(1, debug, client, "detecting saa7127 client on address 0x%x\n", client->addr << 1);
 679
 680         /* First test register 0: Bits 5-7 are a version ID (should be 0),
 681            and bit 2 should also be 0.
 682            This is rather general, so the second test is more specific and
 683            looks at the 'ending point of burst in clock cycles' which is
 684            0x1d after a reset and not expected to ever change. */
 685         if ((saa7127_read(client, 0) & 0xe4) != 0 ||
 686                         (saa7127_read(client, 0x29) & 0x3f) != 0x1d) {
 687                 v4l_dbg(1, debug, client, "saa7127 not found\n");
 688                 return -ENODEV;
 689         }
 690         state = kzalloc(sizeof(struct saa7127_state), GFP_KERNEL);
 691
 692         if (state == NULL) {
 693                 return -ENOMEM;
 694         }
 695
 696         i2c_set_clientdata(client, state);
 697
 698         /* Configure Encoder */
 699
 700         v4l_dbg(1, debug, client, "Configuring encoder\n");
 701         saa7127_write_inittab(client, saa7127_init_config_common);
 702         saa7127_set_std(client, V4L2_STD_NTSC);
 703         saa7127_set_output_type(client, SAA7127_OUTPUT_TYPE_BOTH);
 704         saa7127_set_vps(client, &vbi);
 705         saa7127_set_wss(client, &vbi);
 706         saa7127_set_cc(client, &vbi);
 707         saa7127_set_xds(client, &vbi);
 708         if (test_image == 1) {
 709                 /* The Encoder has an internal Colorbar generator */
 710                 /* This can be used for debugging */
 711                 saa7127_set_input_type(client, SAA7127_INPUT_TYPE_TEST_IMAGE);
 712         } else {
 713                 saa7127_set_input_type(client, SAA7127_INPUT_TYPE_NORMAL);
 714         }
 715         saa7127_set_video_enable(client, 1);
 716
 717         /* Detect if it's an saa7129 */
 718         read_result = saa7127_read(client, SAA7129_REG_FADE_KEY_COL2);
 719         saa7127_write(client, SAA7129_REG_FADE_KEY_COL2, 0xaa);
 720         if (saa7127_read(client, SAA7129_REG_FADE_KEY_COL2) == 0xaa) {
 721                 v4l_info(client, "saa7129 found @ 0x%x (%s)\n", client->addr << 1, client->adapter->name);
 722                 saa7127_write(client, SAA7129_REG_FADE_KEY_COL2, read_result);
 723                 saa7127_write_inittab(client, saa7129_init_config_extra);
 724                 state->ident = V4L2_IDENT_SAA7129;
 725         } else {
 726                 v4l_info(client, "saa7127 found @ 0x%x (%s)\n", client->addr << 1, client->adapter->name);
 727                 state->ident = V4L2_IDENT_SAA7127;
 728         }
 729         return 0;
 730 }
 731
 732 /* ----------------------------------------------------------------------- */
 733
 734 static int saa7127_remove(struct i2c_client *client)
 735 {
 736         /* Turn off TV output */
 737         saa7127_set_video_enable(client, 0);
 738         kfree(i2c_get_clientdata(client));
 739         return 0;
 740 }
 741
 742 /* ----------------------------------------------------------------------- */
 743
 744 static struct v4l2_i2c_driver_data v4l2_i2c_data = {
 745         .name = "saa7127",
 746         .driverid = I2C_DRIVERID_SAA7127,
 747         .command = saa7127_command,
 748         .probe = saa7127_probe,
 749         .remove = saa7127_remove,
 750 };
 751