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