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 fine 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-device.h>
  57 #include <media/v4l2-chip-ident.h>
  58 #include <media/saa7127.h>
  59
  60 static int debug;
  61 static int test_image;
  62
  63 MODULE_DESCRIPTION("Philips SAA7127/9 video encoder driver");
  64 MODULE_AUTHOR("Kevin Thayer, Chris Kennedy, Hans Verkuil");
  65 MODULE_LICENSE("GPL");
  66 module_param(debug, int, 0644);
  67 module_param(test_image, int, 0644);
  68 MODULE_PARM_DESC(debug, "debug level (0-2)");
  69 MODULE_PARM_DESC(test_image, "test_image (0-1)");
  70
  71
  72 /*
  73  * SAA7127 registers
  74  */
  75
  76 #define SAA7127_REG_STATUS                           0x00
  77 #define SAA7127_REG_WIDESCREEN_CONFIG                0x26
  78 #define SAA7127_REG_WIDESCREEN_ENABLE                0x27
  79 #define SAA7127_REG_BURST_START                      0x28
  80 #define SAA7127_REG_BURST_END                        0x29
  81 #define SAA7127_REG_COPYGEN_0                        0x2a
  82 #define SAA7127_REG_COPYGEN_1                        0x2b
  83 #define SAA7127_REG_COPYGEN_2                        0x2c
  84 #define SAA7127_REG_OUTPUT_PORT_CONTROL              0x2d
  85 #define SAA7127_REG_GAIN_LUMINANCE_RGB               0x38
  86 #define SAA7127_REG_GAIN_COLORDIFF_RGB               0x39
  87 #define SAA7127_REG_INPUT_PORT_CONTROL_1             0x3a
  88 #define SAA7129_REG_FADE_KEY_COL2                    0x4f
  89 #define SAA7127_REG_CHROMA_PHASE                     0x5a
  90 #define SAA7127_REG_GAINU                            0x5b
  91 #define SAA7127_REG_GAINV                            0x5c
  92 #define SAA7127_REG_BLACK_LEVEL                      0x5d
  93 #define SAA7127_REG_BLANKING_LEVEL                   0x5e
  94 #define SAA7127_REG_VBI_BLANKING                     0x5f
  95 #define SAA7127_REG_DAC_CONTROL                      0x61
  96 #define SAA7127_REG_BURST_AMP                        0x62
  97 #define SAA7127_REG_SUBC3                            0x63
  98 #define SAA7127_REG_SUBC2                            0x64
  99 #define SAA7127_REG_SUBC1                            0x65
 100 #define SAA7127_REG_SUBC0                            0x66
 101 #define SAA7127_REG_LINE_21_ODD_0                    0x67
 102 #define SAA7127_REG_LINE_21_ODD_1                    0x68
 103 #define SAA7127_REG_LINE_21_EVEN_0                   0x69
 104 #define SAA7127_REG_LINE_21_EVEN_1                   0x6a
 105 #define SAA7127_REG_RCV_PORT_CONTROL                 0x6b
 106 #define SAA7127_REG_VTRIG                            0x6c
 107 #define SAA7127_REG_HTRIG_HI                         0x6d
 108 #define SAA7127_REG_MULTI                            0x6e
 109 #define SAA7127_REG_CLOSED_CAPTION                   0x6f
 110 #define SAA7127_REG_RCV2_OUTPUT_START                0x70
 111 #define SAA7127_REG_RCV2_OUTPUT_END                  0x71
 112 #define SAA7127_REG_RCV2_OUTPUT_MSBS                 0x72
 113 #define SAA7127_REG_TTX_REQUEST_H_START              0x73
 114 #define SAA7127_REG_TTX_REQUEST_H_DELAY_LENGTH       0x74
 115 #define SAA7127_REG_CSYNC_ADVANCE_VSYNC_SHIFT        0x75
 116 #define SAA7127_REG_TTX_ODD_REQ_VERT_START           0x76
 117 #define SAA7127_REG_TTX_ODD_REQ_VERT_END             0x77
 118 #define SAA7127_REG_TTX_EVEN_REQ_VERT_START          0x78
 119 #define SAA7127_REG_TTX_EVEN_REQ_VERT_END            0x79
 120 #define SAA7127_REG_FIRST_ACTIVE                     0x7a
 121 #define SAA7127_REG_LAST_ACTIVE                      0x7b
 122 #define SAA7127_REG_MSB_VERTICAL                     0x7c
 123 #define SAA7127_REG_DISABLE_TTX_LINE_LO_0            0x7e
 124 #define SAA7127_REG_DISABLE_TTX_LINE_LO_1            0x7f
 125
 126 /*
 127  **********************************************************************
 128  *
 129  *  Arrays with configuration parameters for the SAA7127
 130  *
 131  **********************************************************************
 132  */
 133
 134 struct i2c_reg_value {
 135         unsigned char reg;
 136         unsigned char value;
 137 };
 138
 139 static const struct i2c_reg_value saa7129_init_config_extra[] = {
 140         { SAA7127_REG_OUTPUT_PORT_CONTROL,              0x38 },
 141         { SAA7127_REG_VTRIG,                            0xfa },
 142         { 0, 0 }
 143 };
 144
 145 static const struct i2c_reg_value saa7127_init_config_common[] = {
 146         { SAA7127_REG_WIDESCREEN_CONFIG,                0x0d },
 147         { SAA7127_REG_WIDESCREEN_ENABLE,                0x00 },
 148         { SAA7127_REG_COPYGEN_0,                        0x77 },
 149         { SAA7127_REG_COPYGEN_1,                        0x41 },
 150         { SAA7127_REG_COPYGEN_2,                        0x00 }, /* Macrovision enable/disable */
 151         { SAA7127_REG_OUTPUT_PORT_CONTROL,              0xbf },
 152         { SAA7127_REG_GAIN_LUMINANCE_RGB,               0x00 },
 153         { SAA7127_REG_GAIN_COLORDIFF_RGB,               0x00 },
 154         { SAA7127_REG_INPUT_PORT_CONTROL_1,             0x80 }, /* for color bars */
 155         { SAA7127_REG_LINE_21_ODD_0,                    0x77 },
 156         { SAA7127_REG_LINE_21_ODD_1,                    0x41 },
 157         { SAA7127_REG_LINE_21_EVEN_0,                   0x88 },
 158         { SAA7127_REG_LINE_21_EVEN_1,                   0x41 },
 159         { SAA7127_REG_RCV_PORT_CONTROL,                 0x12 },
 160         { SAA7127_REG_VTRIG,                            0xf9 },
 161         { SAA7127_REG_HTRIG_HI,                         0x00 },
 162         { SAA7127_REG_RCV2_OUTPUT_START,                0x41 },
 163         { SAA7127_REG_RCV2_OUTPUT_END,                  0xc3 },
 164         { SAA7127_REG_RCV2_OUTPUT_MSBS,                 0x00 },
 165         { SAA7127_REG_TTX_REQUEST_H_START,              0x3e },
 166         { SAA7127_REG_TTX_REQUEST_H_DELAY_LENGTH,       0xb8 },
 167         { SAA7127_REG_CSYNC_ADVANCE_VSYNC_SHIFT,        0x03 },
 168         { SAA7127_REG_TTX_ODD_REQ_VERT_START,           0x15 },
 169         { SAA7127_REG_TTX_ODD_REQ_VERT_END,             0x16 },
 170         { SAA7127_REG_TTX_EVEN_REQ_VERT_START,          0x15 },
 171         { SAA7127_REG_TTX_EVEN_REQ_VERT_END,            0x16 },
 172         { SAA7127_REG_FIRST_ACTIVE,                     0x1a },
 173         { SAA7127_REG_LAST_ACTIVE,                      0x01 },
 174         { SAA7127_REG_MSB_VERTICAL,                     0xc0 },
 175         { SAA7127_REG_DISABLE_TTX_LINE_LO_0,            0x00 },
 176         { SAA7127_REG_DISABLE_TTX_LINE_LO_1,            0x00 },
 177         { 0, 0 }
 178 };
 179
 180 #define SAA7127_60HZ_DAC_CONTROL 0x15
 181 static const struct i2c_reg_value saa7127_init_config_60hz[] = {
 182         { SAA7127_REG_BURST_START,                      0x19 },
 183         /* BURST_END is also used as a chip ID in saa7127_probe */
 184         { SAA7127_REG_BURST_END,                        0x1d },
 185         { SAA7127_REG_CHROMA_PHASE,                     0xa3 },
 186         { SAA7127_REG_GAINU,                            0x98 },
 187         { SAA7127_REG_GAINV,                            0xd3 },
 188         { SAA7127_REG_BLACK_LEVEL,                      0x39 },
 189         { SAA7127_REG_BLANKING_LEVEL,                   0x2e },
 190         { SAA7127_REG_VBI_BLANKING,                     0x2e },
 191         { SAA7127_REG_DAC_CONTROL,                      0x15 },
 192         { SAA7127_REG_BURST_AMP,                        0x4d },
 193         { SAA7127_REG_SUBC3,                            0x1f },
 194         { SAA7127_REG_SUBC2,                            0x7c },
 195         { SAA7127_REG_SUBC1,                            0xf0 },
 196         { SAA7127_REG_SUBC0,                            0x21 },
 197         { SAA7127_REG_MULTI,                            0x90 },
 198         { SAA7127_REG_CLOSED_CAPTION,                   0x11 },
 199         { 0, 0 }
 200 };
 201
 202 #define SAA7127_50HZ_PAL_DAC_CONTROL 0x02
 203 static struct i2c_reg_value saa7127_init_config_50hz_pal[] = {
 204         { SAA7127_REG_BURST_START,                      0x21 },
 205         /* BURST_END is also used as a chip ID in saa7127_probe */
 206         { SAA7127_REG_BURST_END,                        0x1d },
 207         { SAA7127_REG_CHROMA_PHASE,                     0x3f },
 208         { SAA7127_REG_GAINU,                            0x7d },
 209         { SAA7127_REG_GAINV,                            0xaf },
 210         { SAA7127_REG_BLACK_LEVEL,                      0x33 },
 211         { SAA7127_REG_BLANKING_LEVEL,                   0x35 },
 212         { SAA7127_REG_VBI_BLANKING,                     0x35 },
 213         { SAA7127_REG_DAC_CONTROL,                      0x02 },
 214         { SAA7127_REG_BURST_AMP,                        0x2f },
 215         { SAA7127_REG_SUBC3,                            0xcb },
 216         { SAA7127_REG_SUBC2,                            0x8a },
 217         { SAA7127_REG_SUBC1,                            0x09 },
 218         { SAA7127_REG_SUBC0,                            0x2a },
 219         { SAA7127_REG_MULTI,                            0xa0 },
 220         { SAA7127_REG_CLOSED_CAPTION,                   0x00 },
 221         { 0, 0 }
 222 };
 223
 224 #define SAA7127_50HZ_SECAM_DAC_CONTROL 0x08
 225 static struct i2c_reg_value saa7127_init_config_50hz_secam[] = {
 226         { SAA7127_REG_BURST_START,                      0x21 },
 227         /* BURST_END is also used as a chip ID in saa7127_probe */
 228         { SAA7127_REG_BURST_END,                        0x1d },
 229         { SAA7127_REG_CHROMA_PHASE,                     0x3f },
 230         { SAA7127_REG_GAINU,                            0x6a },
 231         { SAA7127_REG_GAINV,                            0x81 },
 232         { SAA7127_REG_BLACK_LEVEL,                      0x33 },
 233         { SAA7127_REG_BLANKING_LEVEL,                   0x35 },
 234         { SAA7127_REG_VBI_BLANKING,                     0x35 },
 235         { SAA7127_REG_DAC_CONTROL,                      0x08 },
 236         { SAA7127_REG_BURST_AMP,                        0x2f },
 237         { SAA7127_REG_SUBC3,                            0xb2 },
 238         { SAA7127_REG_SUBC2,                            0x3b },
 239         { SAA7127_REG_SUBC1,                            0xa3 },
 240         { SAA7127_REG_SUBC0,                            0x28 },
 241         { SAA7127_REG_MULTI,                            0x90 },
 242         { SAA7127_REG_CLOSED_CAPTION,                   0x00 },
 243         { 0, 0 }
 244 };
 245
 246 /*
 247  **********************************************************************
 248  *
 249  *  Encoder Struct, holds the configuration state of the encoder
 250  *
 251  **********************************************************************
 252  */
 253
 254 struct saa7127_state {
 255         struct v4l2_subdev sd;
 256         v4l2_std_id std;
 257         u32 ident;
 258         enum saa7127_input_type input_type;
 259         enum saa7127_output_type output_type;
 260         int video_enable;
 261         int wss_enable;
 262         u16 wss_mode;
 263         int cc_enable;
 264         u16 cc_data;
 265         int xds_enable;
 266         u16 xds_data;
 267         int vps_enable;
 268         u8 vps_data[5];
 269         u8 reg_2d;
 270         u8 reg_3a;
 271         u8 reg_3a_cb;   /* colorbar bit */
 272         u8 reg_61;
 273 };
 274
 275 static inline struct saa7127_state *to_state(struct v4l2_subdev *sd)
 276 {
 277         return container_of(sd, struct saa7127_state, sd);
 278 }
 279
 280 static const char * const output_strs[] =
 281 {
 282         "S-Video + Composite",
 283         "Composite",
 284         "S-Video",
 285         "RGB",
 286         "YUV C",
 287         "YUV V"
 288 };
 289
 290 static const char * const wss_strs[] = {
 291         "invalid",
 292         "letterbox 14:9 center",
 293         "letterbox 14:9 top",
 294         "invalid",
 295         "letterbox 16:9 top",
 296         "invalid",
 297         "invalid",
 298         "16:9 full format anamorphic",
 299         "4:3 full format",
 300         "invalid",
 301         "invalid",
 302         "letterbox 16:9 center",
 303         "invalid",
 304         "letterbox >16:9 center",
 305         "14:9 full format center",
 306         "invalid",
 307 };
 308
 309 /* ----------------------------------------------------------------------- */
 310
 311 static int saa7127_read(struct v4l2_subdev *sd, u8 reg)
 312 {
 313         struct i2c_client *client = v4l2_get_subdevdata(sd);
 314
 315         return i2c_smbus_read_byte_data(client, reg);
 316 }
 317
 318 /* ----------------------------------------------------------------------- */
 319
 320 static int saa7127_write(struct v4l2_subdev *sd, u8 reg, u8 val)
 321 {
 322         struct i2c_client *client = v4l2_get_subdevdata(sd);
 323         int i;
 324
 325         for (i = 0; i < 3; i++) {
 326                 if (i2c_smbus_write_byte_data(client, reg, val) == 0)
 327                         return 0;
 328         }
 329         v4l2_err(sd, "I2C Write Problem\n");
 330         return -1;
 331 }
 332
 333 /* ----------------------------------------------------------------------- */
 334
 335 static int saa7127_write_inittab(struct v4l2_subdev *sd,
 336                                  const struct i2c_reg_value *regs)
 337 {
 338         while (regs->reg != 0) {
 339                 saa7127_write(sd, regs->reg, regs->value);
 340                 regs++;
 341         }
 342         return 0;
 343 }
 344
 345 /* ----------------------------------------------------------------------- */
 346
 347 static int saa7127_set_vps(struct v4l2_subdev *sd, const struct v4l2_sliced_vbi_data *data)
 348 {
 349         struct saa7127_state *state = to_state(sd);
 350         int enable = (data->line != 0);
 351
 352         if (enable && (data->field != 0 || data->line != 16))
 353                 return -EINVAL;
 354         if (state->vps_enable != enable) {
 355                 v4l2_dbg(1, debug, sd, "Turn VPS Signal %s\n", enable ? "on" : "off");
 356                 saa7127_write(sd, 0x54, enable << 7);
 357                 state->vps_enable = enable;
 358         }
 359         if (!enable)
 360                 return 0;
 361
 362         state->vps_data[0] = data->data[2];
 363         state->vps_data[1] = data->data[8];
 364         state->vps_data[2] = data->data[9];
 365         state->vps_data[3] = data->data[10];
 366         state->vps_data[4] = data->data[11];
 367         v4l2_dbg(1, debug, sd, "Set VPS data %02x %02x %02x %02x %02x\n",
 368                 state->vps_data[0], state->vps_data[1],
 369                 state->vps_data[2], state->vps_data[3],
 370                 state->vps_data[4]);
 371         saa7127_write(sd, 0x55, state->vps_data[0]);
 372         saa7127_write(sd, 0x56, state->vps_data[1]);
 373         saa7127_write(sd, 0x57, state->vps_data[2]);
 374         saa7127_write(sd, 0x58, state->vps_data[3]);
 375         saa7127_write(sd, 0x59, state->vps_data[4]);
 376         return 0;
 377 }
 378
 379 /* ----------------------------------------------------------------------- */
 380
 381 static int saa7127_set_cc(struct v4l2_subdev *sd, const struct v4l2_sliced_vbi_data *data)
 382 {
 383         struct saa7127_state *state = to_state(sd);
 384         u16 cc = data->data[1] << 8 | data->data[0];
 385         int enable = (data->line != 0);
 386
 387         if (enable && (data->field != 0 || data->line != 21))
 388                 return -EINVAL;
 389         if (state->cc_enable != enable) {
 390                 v4l2_dbg(1, debug, sd,
 391                         "Turn CC %s\n", enable ? "on" : "off");
 392                 saa7127_write(sd, SAA7127_REG_CLOSED_CAPTION,
 393                         (state->xds_enable << 7) | (enable << 6) | 0x11);
 394                 state->cc_enable = enable;
 395         }
 396         if (!enable)
 397                 return 0;
 398
 399         v4l2_dbg(2, debug, sd, "CC data: %04x\n", cc);
 400         saa7127_write(sd, SAA7127_REG_LINE_21_ODD_0, cc & 0xff);
 401         saa7127_write(sd, SAA7127_REG_LINE_21_ODD_1, cc >> 8);
 402         state->cc_data = cc;
 403         return 0;
 404 }
 405
 406 /* ----------------------------------------------------------------------- */
 407
 408 static int saa7127_set_xds(struct v4l2_subdev *sd, const struct v4l2_sliced_vbi_data *data)
 409 {
 410         struct saa7127_state *state = to_state(sd);
 411         u16 xds = data->data[1] << 8 | data->data[0];
 412         int enable = (data->line != 0);
 413
 414         if (enable && (data->field != 1 || data->line != 21))
 415                 return -EINVAL;
 416         if (state->xds_enable != enable) {
 417                 v4l2_dbg(1, debug, sd, "Turn XDS %s\n", enable ? "on" : "off");
 418                 saa7127_write(sd, SAA7127_REG_CLOSED_CAPTION,
 419                                 (enable << 7) | (state->cc_enable << 6) | 0x11);
 420                 state->xds_enable = enable;
 421         }
 422         if (!enable)
 423                 return 0;
 424
 425         v4l2_dbg(2, debug, sd, "XDS data: %04x\n", xds);
 426         saa7127_write(sd, SAA7127_REG_LINE_21_EVEN_0, xds & 0xff);
 427         saa7127_write(sd, SAA7127_REG_LINE_21_EVEN_1, xds >> 8);
 428         state->xds_data = xds;
 429         return 0;
 430 }
 431
 432 /* ----------------------------------------------------------------------- */
 433
 434 static int saa7127_set_wss(struct v4l2_subdev *sd, const struct v4l2_sliced_vbi_data *data)
 435 {
 436         struct saa7127_state *state = to_state(sd);
 437         int enable = (data->line != 0);
 438
 439         if (enable && (data->field != 0 || data->line != 23))
 440                 return -EINVAL;
 441         if (state->wss_enable != enable) {
 442                 v4l2_dbg(1, debug, sd, "Turn WSS %s\n", enable ? "on" : "off");
 443                 saa7127_write(sd, 0x27, enable << 7);
 444                 state->wss_enable = enable;
 445         }
 446         if (!enable)
 447                 return 0;
 448
 449         saa7127_write(sd, 0x26, data->data[0]);
 450         saa7127_write(sd, 0x27, 0x80 | (data->data[1] & 0x3f));
 451         v4l2_dbg(1, debug, sd,
 452                 "WSS mode: %s\n", wss_strs[data->data[0] & 0xf]);
 453         state->wss_mode = (data->data[1] & 0x3f) << 8 | data->data[0];
 454         return 0;
 455 }
 456
 457 /* ----------------------------------------------------------------------- */
 458
 459 static int saa7127_set_video_enable(struct v4l2_subdev *sd, int enable)
 460 {
 461         struct saa7127_state *state = to_state(sd);
 462
 463         if (enable) {
 464                 v4l2_dbg(1, debug, sd, "Enable Video Output\n");
 465                 saa7127_write(sd, 0x2d, state->reg_2d);
 466                 saa7127_write(sd, 0x61, state->reg_61);
 467         } else {
 468                 v4l2_dbg(1, debug, sd, "Disable Video Output\n");
 469                 saa7127_write(sd, 0x2d, (state->reg_2d & 0xf0));
 470                 saa7127_write(sd, 0x61, (state->reg_61 | 0xc0));
 471         }
 472         state->video_enable = enable;
 473         return 0;
 474 }
 475
 476 /* ----------------------------------------------------------------------- */
 477
 478 static int saa7127_set_std(struct v4l2_subdev *sd, v4l2_std_id std)
 479 {
 480         struct saa7127_state *state = to_state(sd);
 481         const struct i2c_reg_value *inittab;
 482
 483         if (std & V4L2_STD_525_60) {
 484                 v4l2_dbg(1, debug, sd, "Selecting 60 Hz video Standard\n");
 485                 inittab = saa7127_init_config_60hz;
 486                 state->reg_61 = SAA7127_60HZ_DAC_CONTROL;
 487
 488         } else if (state->ident == V4L2_IDENT_SAA7129 &&
 489                    (std & V4L2_STD_SECAM) &&
 490                    !(std & (V4L2_STD_625_50 & ~V4L2_STD_SECAM))) {
 491
 492                 /* If and only if SECAM, with a SAA712[89] */
 493                 v4l2_dbg(1, debug, sd,
 494                          "Selecting 50 Hz SECAM video Standard\n");
 495                 inittab = saa7127_init_config_50hz_secam;
 496                 state->reg_61 = SAA7127_50HZ_SECAM_DAC_CONTROL;
 497
 498         } else {
 499                 v4l2_dbg(1, debug, sd, "Selecting 50 Hz PAL video Standard\n");
 500                 inittab = saa7127_init_config_50hz_pal;
 501                 state->reg_61 = SAA7127_50HZ_PAL_DAC_CONTROL;
 502         }
 503
 504         /* Write Table */
 505         saa7127_write_inittab(sd, inittab);
 506         state->std = std;
 507         return 0;
 508 }
 509
 510 /* ----------------------------------------------------------------------- */
 511
 512 static int saa7127_set_output_type(struct v4l2_subdev *sd, int output)
 513 {
 514         struct saa7127_state *state = to_state(sd);
 515
 516         switch (output) {
 517         case SAA7127_OUTPUT_TYPE_RGB:
 518                 state->reg_2d = 0x0f;   /* RGB + CVBS (for sync) */
 519                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 520                 break;
 521
 522         case SAA7127_OUTPUT_TYPE_COMPOSITE:
 523                 if (state->ident == V4L2_IDENT_SAA7129)
 524                         state->reg_2d = 0x20;   /* CVBS only */
 525                 else
 526                         state->reg_2d = 0x08;   /* 00001000 CVBS only, RGB DAC's off (high impedance mode) */
 527                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 528                 break;
 529
 530         case SAA7127_OUTPUT_TYPE_SVIDEO:
 531                 if (state->ident == V4L2_IDENT_SAA7129)
 532                         state->reg_2d = 0x18;   /* Y + C */
 533                 else
 534                         state->reg_2d = 0xff;   /*11111111  croma -> R, luma -> CVBS + G + B */
 535                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 536                 break;
 537
 538         case SAA7127_OUTPUT_TYPE_YUV_V:
 539                 state->reg_2d = 0x4f;   /* reg 2D = 01001111, all DAC's on, RGB + VBS */
 540                 state->reg_3a = 0x0b;   /* reg 3A = 00001011, bypass RGB-matrix */
 541                 break;
 542
 543         case SAA7127_OUTPUT_TYPE_YUV_C:
 544                 state->reg_2d = 0x0f;   /* reg 2D = 00001111, all DAC's on, RGB + CVBS */
 545                 state->reg_3a = 0x0b;   /* reg 3A = 00001011, bypass RGB-matrix */
 546                 break;
 547
 548         case SAA7127_OUTPUT_TYPE_BOTH:
 549                 if (state->ident == V4L2_IDENT_SAA7129)
 550                         state->reg_2d = 0x38;
 551                 else
 552                         state->reg_2d = 0xbf;
 553                 state->reg_3a = 0x13;   /* by default switch YUV to RGB-matrix on */
 554                 break;
 555
 556         default:
 557                 return -EINVAL;
 558         }
 559         v4l2_dbg(1, debug, sd,
 560                 "Selecting %s output type\n", output_strs[output]);
 561
 562         /* Configure Encoder */
 563         saa7127_write(sd, 0x2d, state->reg_2d);
 564         saa7127_write(sd, 0x3a, state->reg_3a | state->reg_3a_cb);
 565         state->output_type = output;
 566         return 0;
 567 }
 568
 569 /* ----------------------------------------------------------------------- */
 570
 571 static int saa7127_set_input_type(struct v4l2_subdev *sd, int input)
 572 {
 573         struct saa7127_state *state = to_state(sd);
 574
 575         switch (input) {
 576         case SAA7127_INPUT_TYPE_NORMAL: /* avia */
 577                 v4l2_dbg(1, debug, sd, "Selecting Normal Encoder Input\n");
 578                 state->reg_3a_cb = 0;
 579                 break;
 580
 581         case SAA7127_INPUT_TYPE_TEST_IMAGE:     /* color bar */
 582                 v4l2_dbg(1, debug, sd, "Selecting Color Bar generator\n");
 583                 state->reg_3a_cb = 0x80;
 584                 break;
 585
 586         default:
 587                 return -EINVAL;
 588         }
 589         saa7127_write(sd, 0x3a, state->reg_3a | state->reg_3a_cb);
 590         state->input_type = input;
 591         return 0;
 592 }
 593
 594 /* ----------------------------------------------------------------------- */
 595
 596 static int saa7127_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)
 597 {
 598         struct saa7127_state *state = to_state(sd);
 599
 600         if (state->std == std)
 601                 return 0;
 602         return saa7127_set_std(sd, std);
 603 }
 604
 605 static int saa7127_s_routing(struct v4l2_subdev *sd,
 606                              u32 input, u32 output, u32 config)
 607 {
 608         struct saa7127_state *state = to_state(sd);
 609         int rc = 0;
 610
 611         if (state->input_type != input)
 612                 rc = saa7127_set_input_type(sd, input);
 613         if (rc == 0 && state->output_type != output)
 614                 rc = saa7127_set_output_type(sd, output);
 615         return rc;
 616 }
 617
 618 static int saa7127_s_stream(struct v4l2_subdev *sd, int enable)
 619 {
 620         struct saa7127_state *state = to_state(sd);
 621
 622         if (state->video_enable == enable)
 623                 return 0;
 624         return saa7127_set_video_enable(sd, enable);
 625 }
 626
 627 static int saa7127_g_sliced_fmt(struct v4l2_subdev *sd, struct v4l2_sliced_vbi_format *fmt)
 628 {
 629         struct saa7127_state *state = to_state(sd);
 630
 631         memset(fmt, 0, sizeof(*fmt));
 632         if (state->vps_enable)
 633                 fmt->service_lines[0][16] = V4L2_SLICED_VPS;
 634         if (state->wss_enable)
 635                 fmt->service_lines[0][23] = V4L2_SLICED_WSS_625;
 636         if (state->cc_enable) {
 637                 fmt->service_lines[0][21] = V4L2_SLICED_CAPTION_525;
 638                 fmt->service_lines[1][21] = V4L2_SLICED_CAPTION_525;
 639         }
 640         fmt->service_set =
 641                 (state->vps_enable ? V4L2_SLICED_VPS : 0) |
 642                 (state->wss_enable ? V4L2_SLICED_WSS_625 : 0) |
 643                 (state->cc_enable ? V4L2_SLICED_CAPTION_525 : 0);
 644         return 0;
 645 }
 646
 647 static int saa7127_s_vbi_data(struct v4l2_subdev *sd, const struct v4l2_sliced_vbi_data *data)
 648 {
 649         switch (data->id) {
 650         case V4L2_SLICED_WSS_625:
 651                 return saa7127_set_wss(sd, data);
 652         case V4L2_SLICED_VPS:
 653                 return saa7127_set_vps(sd, data);
 654         case V4L2_SLICED_CAPTION_525:
 655                 if (data->field == 0)
 656                         return saa7127_set_cc(sd, data);
 657                 return saa7127_set_xds(sd, data);
 658         default:
 659                 return -EINVAL;
 660         }
 661         return 0;
 662 }
 663
 664 #ifdef CONFIG_VIDEO_ADV_DEBUG
 665 static int saa7127_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
 666 {
 667         struct i2c_client *client = v4l2_get_subdevdata(sd);
 668
 669         if (!v4l2_chip_match_i2c_client(client, &reg->match))
 670                 return -EINVAL;
 671         if (!capable(CAP_SYS_ADMIN))
 672                 return -EPERM;
 673         reg->val = saa7127_read(sd, reg->reg & 0xff);
 674         reg->size = 1;
 675         return 0;
 676 }
 677
 678 static int saa7127_s_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
 679 {
 680         struct i2c_client *client = v4l2_get_subdevdata(sd);
 681
 682         if (!v4l2_chip_match_i2c_client(client, &reg->match))
 683                 return -EINVAL;
 684         if (!capable(CAP_SYS_ADMIN))
 685                 return -EPERM;
 686         saa7127_write(sd, reg->reg & 0xff, reg->val & 0xff);
 687         return 0;
 688 }
 689 #endif
 690
 691 static int saa7127_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
 692 {
 693         struct saa7127_state *state = to_state(sd);
 694         struct i2c_client *client = v4l2_get_subdevdata(sd);
 695
 696         return v4l2_chip_ident_i2c_client(client, chip, state->ident, 0);
 697 }
 698
 699 static int saa7127_log_status(struct v4l2_subdev *sd)
 700 {
 701         struct saa7127_state *state = to_state(sd);
 702
 703         v4l2_info(sd, "Standard: %s\n", (state->std & V4L2_STD_525_60) ? "60 Hz" : "50 Hz");
 704         v4l2_info(sd, "Input:    %s\n", state->input_type ?  "color bars" : "normal");
 705         v4l2_info(sd, "Output:   %s\n", state->video_enable ?
 706                         output_strs[state->output_type] : "disabled");
 707         v4l2_info(sd, "WSS:      %s\n", state->wss_enable ?
 708                         wss_strs[state->wss_mode] : "disabled");
 709         v4l2_info(sd, "VPS:      %s\n", state->vps_enable ? "enabled" : "disabled");
 710         v4l2_info(sd, "CC:       %s\n", state->cc_enable ? "enabled" : "disabled");
 711         return 0;
 712 }
 713
 714 /* ----------------------------------------------------------------------- */
 715
 716 static const struct v4l2_subdev_core_ops saa7127_core_ops = {
 717         .log_status = saa7127_log_status,
 718         .g_chip_ident = saa7127_g_chip_ident,
 719 #ifdef CONFIG_VIDEO_ADV_DEBUG
 720         .g_register = saa7127_g_register,
 721         .s_register = saa7127_s_register,
 722 #endif
 723 };
 724
 725 static const struct v4l2_subdev_video_ops saa7127_video_ops = {
 726         .s_std_output = saa7127_s_std_output,
 727         .s_routing = saa7127_s_routing,
 728         .s_stream = saa7127_s_stream,
 729 };
 730
 731 static const struct v4l2_subdev_vbi_ops saa7127_vbi_ops = {
 732         .s_vbi_data = saa7127_s_vbi_data,
 733         .g_sliced_fmt = saa7127_g_sliced_fmt,
 734 };
 735
 736 static const struct v4l2_subdev_ops saa7127_ops = {
 737         .core = &saa7127_core_ops,
 738         .video = &saa7127_video_ops,
 739         .vbi = &saa7127_vbi_ops,
 740 };
 741
 742 /* ----------------------------------------------------------------------- */
 743
 744 static int saa7127_probe(struct i2c_client *client,
 745                          const struct i2c_device_id *id)
 746 {
 747         struct saa7127_state *state;
 748         struct v4l2_subdev *sd;
 749         struct v4l2_sliced_vbi_data vbi = { 0, 0, 0, 0 };  /* set to disabled */
 750
 751         /* Check if the adapter supports the needed features */
 752         if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 753                 return -EIO;
 754
 755         v4l_dbg(1, debug, client, "detecting saa7127 client on address 0x%x\n",
 756                         client->addr << 1);
 757
 758         state = kzalloc(sizeof(struct saa7127_state), GFP_KERNEL);
 759         if (state == NULL)
 760                 return -ENOMEM;
 761
 762         sd = &state->sd;
 763         v4l2_i2c_subdev_init(sd, client, &saa7127_ops);
 764
 765         /* First test register 0: Bits 5-7 are a version ID (should be 0),
 766            and bit 2 should also be 0.
 767            This is rather general, so the second test is more specific and
 768            looks at the 'ending point of burst in clock cycles' which is
 769            0x1d after a reset and not expected to ever change. */
 770         if ((saa7127_read(sd, 0) & 0xe4) != 0 ||
 771                         (saa7127_read(sd, 0x29) & 0x3f) != 0x1d) {
 772                 v4l2_dbg(1, debug, sd, "saa7127 not found\n");
 773                 kfree(state);
 774                 return -ENODEV;
 775         }
 776
 777         if (id->driver_data) {  /* Chip type is already known */
 778                 state->ident = id->driver_data;
 779         } else {                /* Needs detection */
 780                 int read_result;
 781
 782                 /* Detect if it's an saa7129 */
 783                 read_result = saa7127_read(sd, SAA7129_REG_FADE_KEY_COL2);
 784                 saa7127_write(sd, SAA7129_REG_FADE_KEY_COL2, 0xaa);
 785                 if (saa7127_read(sd, SAA7129_REG_FADE_KEY_COL2) == 0xaa) {
 786                         saa7127_write(sd, SAA7129_REG_FADE_KEY_COL2,
 787                                         read_result);
 788                         state->ident = V4L2_IDENT_SAA7129;
 789                         strlcpy(client->name, "saa7129", I2C_NAME_SIZE);
 790                 } else {
 791                         state->ident = V4L2_IDENT_SAA7127;
 792                         strlcpy(client->name, "saa7127", I2C_NAME_SIZE);
 793                 }
 794         }
 795
 796         v4l2_info(sd, "%s found @ 0x%x (%s)\n", client->name,
 797                         client->addr << 1, client->adapter->name);
 798
 799         v4l2_dbg(1, debug, sd, "Configuring encoder\n");
 800         saa7127_write_inittab(sd, saa7127_init_config_common);
 801         saa7127_set_std(sd, V4L2_STD_NTSC);
 802         saa7127_set_output_type(sd, SAA7127_OUTPUT_TYPE_BOTH);
 803         saa7127_set_vps(sd, &vbi);
 804         saa7127_set_wss(sd, &vbi);
 805         saa7127_set_cc(sd, &vbi);
 806         saa7127_set_xds(sd, &vbi);
 807         if (test_image == 1)
 808                 /* The Encoder has an internal Colorbar generator */
 809                 /* This can be used for debugging */
 810                 saa7127_set_input_type(sd, SAA7127_INPUT_TYPE_TEST_IMAGE);
 811         else
 812                 saa7127_set_input_type(sd, SAA7127_INPUT_TYPE_NORMAL);
 813         saa7127_set_video_enable(sd, 1);
 814
 815         if (state->ident == V4L2_IDENT_SAA7129)
 816                 saa7127_write_inittab(sd, saa7129_init_config_extra);
 817         return 0;
 818 }
 819
 820 /* ----------------------------------------------------------------------- */
 821
 822 static int saa7127_remove(struct i2c_client *client)
 823 {
 824         struct v4l2_subdev *sd = i2c_get_clientdata(client);
 825
 826         v4l2_device_unregister_subdev(sd);
 827         /* Turn off TV output */
 828         saa7127_set_video_enable(sd, 0);
 829         kfree(to_state(sd));
 830         return 0;
 831 }
 832
 833 /* ----------------------------------------------------------------------- */
 834
 835 static struct i2c_device_id saa7127_id[] = {
 836         { "saa7127_auto", 0 },  /* auto-detection */
 837         { "saa7126", V4L2_IDENT_SAA7127 },
 838         { "saa7127", V4L2_IDENT_SAA7127 },
 839         { "saa7128", V4L2_IDENT_SAA7129 },
 840         { "saa7129", V4L2_IDENT_SAA7129 },
 841         { }
 842 };
 843 MODULE_DEVICE_TABLE(i2c, saa7127_id);
 844
 845 static struct i2c_driver saa7127_driver = {
 846         .driver = {
 847                 .owner  = THIS_MODULE,
 848                 .name   = "saa7127",
 849         },
 850         .probe          = saa7127_probe,
 851         .remove         = saa7127_remove,
 852         .id_table       = saa7127_id,
 853 };
 854
 855 static __init int init_saa7127(void)
 856 {
 857         return i2c_add_driver(&saa7127_driver);
 858 }
 859
 860 static __exit void exit_saa7127(void)
 861 {
 862         i2c_del_driver(&saa7127_driver);
 863 }
 864
 865 module_init(init_saa7127);
 866 module_exit(exit_saa7127);