drivers/media/video/saa7115.c

   1 /* saa711x - Philips SAA711x video decoder driver
   2  * This driver can work with saa7111, saa7111a, saa7113, saa7114,
   3  *                           saa7115 and saa7118.
   4  *
   5  * Based on saa7114 driver by Maxim Yevtyushkin, which is based on
   6  * the saa7111 driver by Dave Perks.
   7  *
   8  * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
   9  * Copyright (C) 2002 Maxim Yevtyushkin <max@linuxmedialabs.com>
  10  *
  11  * Slight changes for video timing and attachment output by
  12  * Wolfgang Scherr <scherr@net4you.net>
  13  *
  14  * Moved over to the linux >= 2.4.x i2c protocol (1/1/2003)
  15  * by Ronald Bultje <rbultje@ronald.bitfreak.net>
  16  *
  17  * Added saa7115 support by Kevin Thayer <nufan_wfk at yahoo.com>
  18  * (2/17/2003)
  19  *
  20  * VBI support (2004) and cleanups (2005) by Hans Verkuil <hverkuil@xs4all.nl>
  21  *
  22  * Copyright (c) 2005-2006 Mauro Carvalho Chehab <mchehab@infradead.org>
  23  *      SAA7111, SAA7113 and SAA7118 support
  24  *
  25  * This program is free software; you can redistribute it and/or
  26  * modify it under the terms of the GNU General Public License
  27  * as published by the Free Software Foundation; either version 2
  28  * of the License, or (at your option) any later version.
  29  *
  30  * This program is distributed in the hope that it will be useful,
  31  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  32  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  33  * GNU General Public License for more details.
  34  *
  35  * You should have received a copy of the GNU General Public License
  36  * along with this program; if not, write to the Free Software
  37  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
  38  */
  39
  40 #include "saa711x_regs.h"
  41
  42 #include <linux/kernel.h>
  43 #include <linux/module.h>
  44 #include <linux/slab.h>
  45 #include <linux/i2c.h>
  46 #include <linux/videodev2.h>
  47 #include <media/v4l2-common.h>
  48 #include <media/saa7115.h>
  49 #include <asm/div64.h>
  50
  51 #define VRES_60HZ       (480+16)
  52
  53 MODULE_DESCRIPTION("Philips SAA7111/SAA7113/SAA7114/SAA7115/SAA7118 video decoder driver");
  54 MODULE_AUTHOR(  "Maxim Yevtyushkin, Kevin Thayer, Chris Kennedy, "
  55                 "Hans Verkuil, Mauro Carvalho Chehab");
  56 MODULE_LICENSE("GPL");
  57
  58 static int debug = 0;
  59 module_param(debug, bool, 0644);
  60
  61 MODULE_PARM_DESC(debug, "Debug level (0-1)");
  62
  63 static unsigned short normal_i2c[] = {
  64                 0x4a >> 1, 0x48 >> 1,   /* SAA7111, SAA7111A and SAA7113 */
  65                 0x42 >> 1, 0x40 >> 1,   /* SAA7114, SAA7115 and SAA7118 */
  66                 I2C_CLIENT_END };
  67
  68
  69 I2C_CLIENT_INSMOD;
  70
  71 struct saa711x_state {
  72         v4l2_std_id std;
  73         int input;
  74         int enable;
  75         int radio;
  76         int bright;
  77         int contrast;
  78         int hue;
  79         int sat;
  80         int width;
  81         int height;
  82         enum v4l2_chip_ident ident;
  83         u32 audclk_freq;
  84         u32 crystal_freq;
  85         u8 ucgc;
  86         u8 cgcdiv;
  87         u8 apll;
  88 };
  89
  90 /* ----------------------------------------------------------------------- */
  91
  92 static inline int saa711x_write(struct i2c_client *client, u8 reg, u8 value)
  93 {
  94         return i2c_smbus_write_byte_data(client, reg, value);
  95 }
  96
  97 /* Sanity routine to check if a register is present */
  98 static int saa711x_has_reg(const int id, const u8 reg)
  99 {
 100         if (id == V4L2_IDENT_SAA7111)
 101                 return reg < 0x20 && reg != 0x01 && reg != 0x0f &&
 102                        (reg < 0x13 || reg > 0x19) && reg != 0x1d && reg != 0x1e;
 103
 104         /* common for saa7113/4/5/8 */
 105         if (unlikely((reg >= 0x3b && reg <= 0x3f) || reg == 0x5c || reg == 0x5f ||
 106             reg == 0xa3 || reg == 0xa7 || reg == 0xab || reg == 0xaf || (reg >= 0xb5 && reg <= 0xb7) ||
 107             reg == 0xd3 || reg == 0xd7 || reg == 0xdb || reg == 0xdf || (reg >= 0xe5 && reg <= 0xe7) ||
 108             reg == 0x82 || (reg >= 0x89 && reg <= 0x8e)))
 109                 return 0;
 110
 111         switch (id) {
 112         case V4L2_IDENT_SAA7113:
 113                 return reg != 0x14 && (reg < 0x18 || reg > 0x1e) && (reg < 0x20 || reg > 0x3f) &&
 114                        reg != 0x5d && reg < 0x63;
 115         case V4L2_IDENT_SAA7114:
 116                 return (reg < 0x1a || reg > 0x1e) && (reg < 0x20 || reg > 0x2f) &&
 117                        (reg < 0x63 || reg > 0x7f) && reg != 0x33 && reg != 0x37 &&
 118                        reg != 0x81 && reg < 0xf0;
 119         case V4L2_IDENT_SAA7115:
 120                 return (reg < 0x20 || reg > 0x2f) && reg != 0x65 && (reg < 0xfc || reg > 0xfe);
 121         case V4L2_IDENT_SAA7118:
 122                 return (reg < 0x1a || reg > 0x1d) && (reg < 0x20 || reg > 0x22) &&
 123                        (reg < 0x26 || reg > 0x28) && reg != 0x33 && reg != 0x37 &&
 124                        (reg < 0x63 || reg > 0x7f) && reg != 0x81 && reg < 0xf0;
 125         }
 126         return 1;
 127 }
 128
 129 static int saa711x_writeregs(struct i2c_client *client, const unsigned char *regs)
 130 {
 131         struct saa711x_state *state = i2c_get_clientdata(client);
 132         unsigned char reg, data;
 133
 134         while (*regs != 0x00) {
 135                 reg = *(regs++);
 136                 data = *(regs++);
 137
 138                 /* According with datasheets, reserved regs should be
 139                    filled with 0 - seems better not to touch on they */
 140                 if (saa711x_has_reg(state->ident,reg)) {
 141                         if (saa711x_write(client, reg, data) < 0)
 142                                 return -1;
 143                 } else {
 144                         v4l_dbg(1, debug, client, "tried to access reserved reg 0x%02x\n", reg);
 145                 }
 146         }
 147         return 0;
 148 }
 149
 150 static inline int saa711x_read(struct i2c_client *client, u8 reg)
 151 {
 152         return i2c_smbus_read_byte_data(client, reg);
 153 }
 154
 155 /* ----------------------------------------------------------------------- */
 156
 157 /* SAA7111 initialization table */
 158 static const unsigned char saa7111_init[] = {
 159         R_01_INC_DELAY, 0x00,           /* reserved */
 160
 161         /*front end */
 162         R_02_INPUT_CNTL_1, 0xd0,        /* FUSE=3, GUDL=2, MODE=0 */
 163         R_03_INPUT_CNTL_2, 0x23,        /* HLNRS=0, VBSL=1, WPOFF=0, HOLDG=0,
 164                                          * GAFIX=0, GAI1=256, GAI2=256 */
 165         R_04_INPUT_CNTL_3, 0x00,        /* GAI1=256 */
 166         R_05_INPUT_CNTL_4, 0x00,        /* GAI2=256 */
 167
 168         /* decoder */
 169         R_06_H_SYNC_START, 0xf3,        /* HSB at  13(50Hz) /  17(60Hz)
 170                                          * pixels after end of last line */
 171         R_07_H_SYNC_STOP, 0xe8,         /* HSS seems to be needed to
 172                                          * work with NTSC, too */
 173         R_08_SYNC_CNTL, 0xc8,           /* AUFD=1, FSEL=1, EXFIL=0,
 174                                          * VTRC=1, HPLL=0, VNOI=0 */
 175         R_09_LUMA_CNTL, 0x01,           /* BYPS=0, PREF=0, BPSS=0,
 176                                          * VBLB=0, UPTCV=0, APER=1 */
 177         R_0A_LUMA_BRIGHT_CNTL, 0x80,
 178         R_0B_LUMA_CONTRAST_CNTL, 0x47,  /* 0b - CONT=1.109 */
 179         R_0C_CHROMA_SAT_CNTL, 0x40,
 180         R_0D_CHROMA_HUE_CNTL, 0x00,
 181         R_0E_CHROMA_CNTL_1, 0x01,       /* 0e - CDTO=0, CSTD=0, DCCF=0,
 182                                          * FCTC=0, CHBW=1 */
 183         R_0F_CHROMA_GAIN_CNTL, 0x00,    /* reserved */
 184         R_10_CHROMA_CNTL_2, 0x48,       /* 10 - OFTS=1, HDEL=0, VRLN=1, YDEL=0 */
 185         R_11_MODE_DELAY_CNTL, 0x1c,     /* 11 - GPSW=0, CM99=0, FECO=0, COMPO=1,
 186                                          * OEYC=1, OEHV=1, VIPB=0, COLO=0 */
 187         R_12_RT_SIGNAL_CNTL, 0x00,      /* 12 - output control 2 */
 188         R_13_RT_X_PORT_OUT_CNTL, 0x00,  /* 13 - output control 3 */
 189         R_14_ANAL_ADC_COMPAT_CNTL, 0x00,
 190         R_15_VGATE_START_FID_CHG, 0x00,
 191         R_16_VGATE_STOP, 0x00,
 192         R_17_MISC_VGATE_CONF_AND_MSB, 0x00,
 193
 194         0x00, 0x00
 195 };
 196
 197 /* SAA7113 init codes */
 198 static const unsigned char saa7113_init[] = {
 199         R_01_INC_DELAY, 0x08,
 200         R_02_INPUT_CNTL_1, 0xc2,
 201         R_03_INPUT_CNTL_2, 0x30,
 202         R_04_INPUT_CNTL_3, 0x00,
 203         R_05_INPUT_CNTL_4, 0x00,
 204         R_06_H_SYNC_START, 0x89,
 205         R_07_H_SYNC_STOP, 0x0d,
 206         R_08_SYNC_CNTL, 0x88,
 207         R_09_LUMA_CNTL, 0x01,
 208         R_0A_LUMA_BRIGHT_CNTL, 0x80,
 209         R_0B_LUMA_CONTRAST_CNTL, 0x47,
 210         R_0C_CHROMA_SAT_CNTL, 0x40,
 211         R_0D_CHROMA_HUE_CNTL, 0x00,
 212         R_0E_CHROMA_CNTL_1, 0x01,
 213         R_0F_CHROMA_GAIN_CNTL, 0x2a,
 214         R_10_CHROMA_CNTL_2, 0x08,
 215         R_11_MODE_DELAY_CNTL, 0x0c,
 216         R_12_RT_SIGNAL_CNTL, 0x07,
 217         R_13_RT_X_PORT_OUT_CNTL, 0x00,
 218         R_14_ANAL_ADC_COMPAT_CNTL, 0x00,
 219         R_15_VGATE_START_FID_CHG, 0x00,
 220         R_16_VGATE_STOP, 0x00,
 221         R_17_MISC_VGATE_CONF_AND_MSB, 0x00,
 222
 223         0x00, 0x00
 224 };
 225
 226 /* If a value differs from the Hauppauge driver values, then the comment starts with
 227    'was 0xXX' to denote the Hauppauge value. Otherwise the value is identical to what the
 228    Hauppauge driver sets. */
 229
 230 /* SAA7114 and SAA7115 initialization table */
 231 static const unsigned char saa7115_init_auto_input[] = {
 232                 /* Front-End Part */
 233         R_01_INC_DELAY, 0x48,                   /* white peak control disabled */
 234         R_03_INPUT_CNTL_2, 0x20,                /* was 0x30. 0x20: long vertical blanking */
 235         R_04_INPUT_CNTL_3, 0x90,                /* analog gain set to 0 */
 236         R_05_INPUT_CNTL_4, 0x90,                /* analog gain set to 0 */
 237                 /* Decoder Part */
 238         R_06_H_SYNC_START, 0xeb,                /* horiz sync begin = -21 */
 239         R_07_H_SYNC_STOP, 0xe0,                 /* horiz sync stop = -17 */
 240         R_09_LUMA_CNTL, 0x53,                   /* 0x53, was 0x56 for 60hz. luminance control */
 241         R_0A_LUMA_BRIGHT_CNTL, 0x80,            /* was 0x88. decoder brightness, 0x80 is itu standard */
 242         R_0B_LUMA_CONTRAST_CNTL, 0x44,          /* was 0x48. decoder contrast, 0x44 is itu standard */
 243         R_0C_CHROMA_SAT_CNTL, 0x40,             /* was 0x47. decoder saturation, 0x40 is itu standard */
 244         R_0D_CHROMA_HUE_CNTL, 0x00,
 245         R_0F_CHROMA_GAIN_CNTL, 0x00,            /* use automatic gain  */
 246         R_10_CHROMA_CNTL_2, 0x06,               /* chroma: active adaptive combfilter */
 247         R_11_MODE_DELAY_CNTL, 0x00,
 248         R_12_RT_SIGNAL_CNTL, 0x9d,              /* RTS0 output control: VGATE */
 249         R_13_RT_X_PORT_OUT_CNTL, 0x80,          /* ITU656 standard mode, RTCO output enable RTCE */
 250         R_14_ANAL_ADC_COMPAT_CNTL, 0x00,
 251         R_18_RAW_DATA_GAIN_CNTL, 0x40,          /* gain 0x00 = nominal */
 252         R_19_RAW_DATA_OFF_CNTL, 0x80,
 253         R_1A_COLOR_KILL_LVL_CNTL, 0x77,         /* recommended value */
 254         R_1B_MISC_TVVCRDET, 0x42,               /* recommended value */
 255         R_1C_ENHAN_COMB_CTRL1, 0xa9,            /* recommended value */
 256         R_1D_ENHAN_COMB_CTRL2, 0x01,            /* recommended value */
 257
 258
 259         R_80_GLOBAL_CNTL_1, 0x0,                /* No tasks enabled at init */
 260
 261                 /* Power Device Control */
 262         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,    /* reset device */
 263         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xf0,    /* set device programmed, all in operational mode */
 264         0x00, 0x00
 265 };
 266
 267 /* Used to reset saa7113, saa7114 and saa7115 */
 268 static const unsigned char saa7115_cfg_reset_scaler[] = {
 269         R_87_I_PORT_I_O_ENA_OUT_CLK_AND_GATED, 0x00,    /* disable I-port output */
 270         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,            /* reset scaler */
 271         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xf0,            /* activate scaler */
 272         R_87_I_PORT_I_O_ENA_OUT_CLK_AND_GATED, 0x01,    /* enable I-port output */
 273         0x00, 0x00
 274 };
 275
 276 /* ============== SAA7715 VIDEO templates =============  */
 277
 278 static const unsigned char saa7115_cfg_60hz_video[] = {
 279         R_80_GLOBAL_CNTL_1, 0x00,                       /* reset tasks */
 280         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,            /* reset scaler */
 281
 282         R_15_VGATE_START_FID_CHG, 0x03,
 283         R_16_VGATE_STOP, 0x11,
 284         R_17_MISC_VGATE_CONF_AND_MSB, 0x9c,
 285
 286         R_08_SYNC_CNTL, 0x68,                   /* 0xBO: auto detection, 0x68 = NTSC */
 287         R_0E_CHROMA_CNTL_1, 0x07,               /* video autodetection is on */
 288
 289         R_5A_V_OFF_FOR_SLICER, 0x06,            /* standard 60hz value for ITU656 line counting */
 290
 291         /* Task A */
 292         R_90_A_TASK_HANDLING_CNTL, 0x80,
 293         R_91_A_X_PORT_FORMATS_AND_CONF, 0x48,
 294         R_92_A_X_PORT_INPUT_REFERENCE_SIGNAL, 0x40,
 295         R_93_A_I_PORT_OUTPUT_FORMATS_AND_CONF, 0x84,
 296
 297         /* hoffset low (input), 0x0002 is minimum */
 298         R_94_A_HORIZ_INPUT_WINDOW_START, 0x01,
 299         R_95_A_HORIZ_INPUT_WINDOW_START_MSB, 0x00,
 300
 301         /* hsize low (input), 0x02d0 = 720 */
 302         R_96_A_HORIZ_INPUT_WINDOW_LENGTH, 0xd0,
 303         R_97_A_HORIZ_INPUT_WINDOW_LENGTH_MSB, 0x02,
 304
 305         R_98_A_VERT_INPUT_WINDOW_START, 0x05,
 306         R_99_A_VERT_INPUT_WINDOW_START_MSB, 0x00,
 307
 308         R_9A_A_VERT_INPUT_WINDOW_LENGTH, 0x0c,
 309         R_9B_A_VERT_INPUT_WINDOW_LENGTH_MSB, 0x00,
 310
 311         R_9C_A_HORIZ_OUTPUT_WINDOW_LENGTH, 0xa0,
 312         R_9D_A_HORIZ_OUTPUT_WINDOW_LENGTH_MSB, 0x05,
 313
 314         R_9E_A_VERT_OUTPUT_WINDOW_LENGTH, 0x0c,
 315         R_9F_A_VERT_OUTPUT_WINDOW_LENGTH_MSB, 0x00,
 316
 317         /* Task B */
 318         R_C0_B_TASK_HANDLING_CNTL, 0x00,
 319         R_C1_B_X_PORT_FORMATS_AND_CONF, 0x08,
 320         R_C2_B_INPUT_REFERENCE_SIGNAL_DEFINITION, 0x00,
 321         R_C3_B_I_PORT_FORMATS_AND_CONF, 0x80,
 322
 323         /* 0x0002 is minimum */
 324         R_C4_B_HORIZ_INPUT_WINDOW_START, 0x02,
 325         R_C5_B_HORIZ_INPUT_WINDOW_START_MSB, 0x00,
 326
 327         /* 0x02d0 = 720 */
 328         R_C6_B_HORIZ_INPUT_WINDOW_LENGTH, 0xd0,
 329         R_C7_B_HORIZ_INPUT_WINDOW_LENGTH_MSB, 0x02,
 330
 331         /* vwindow start 0x12 = 18 */
 332         R_C8_B_VERT_INPUT_WINDOW_START, 0x12,
 333         R_C9_B_VERT_INPUT_WINDOW_START_MSB, 0x00,
 334
 335         /* vwindow length 0xf8 = 248 */
 336         R_CA_B_VERT_INPUT_WINDOW_LENGTH, VRES_60HZ>>1,
 337         R_CB_B_VERT_INPUT_WINDOW_LENGTH_MSB, VRES_60HZ>>9,
 338
 339         /* hwindow 0x02d0 = 720 */
 340         R_CC_B_HORIZ_OUTPUT_WINDOW_LENGTH, 0xd0,
 341         R_CD_B_HORIZ_OUTPUT_WINDOW_LENGTH_MSB, 0x02,
 342
 343         R_F0_LFCO_PER_LINE, 0xad,               /* Set PLL Register. 60hz 525 lines per frame, 27 MHz */
 344         R_F1_P_I_PARAM_SELECT, 0x05,            /* low bit with 0xF0 */
 345         R_F5_PULSGEN_LINE_LENGTH, 0xad,
 346         R_F6_PULSE_A_POS_LSB_AND_PULSEGEN_CONFIG, 0x01,
 347
 348         0x00, 0x00
 349 };
 350
 351 static const unsigned char saa7115_cfg_50hz_video[] = {
 352         R_80_GLOBAL_CNTL_1, 0x00,
 353         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,    /* reset scaler */
 354
 355         R_15_VGATE_START_FID_CHG, 0x37,         /* VGATE start */
 356         R_16_VGATE_STOP, 0x16,
 357         R_17_MISC_VGATE_CONF_AND_MSB, 0x99,
 358
 359         R_08_SYNC_CNTL, 0x28,                   /* 0x28 = PAL */
 360         R_0E_CHROMA_CNTL_1, 0x07,
 361
 362         R_5A_V_OFF_FOR_SLICER, 0x03,            /* standard 50hz value */
 363
 364         /* Task A */
 365         R_90_A_TASK_HANDLING_CNTL, 0x81,
 366         R_91_A_X_PORT_FORMATS_AND_CONF, 0x48,
 367         R_92_A_X_PORT_INPUT_REFERENCE_SIGNAL, 0x40,
 368         R_93_A_I_PORT_OUTPUT_FORMATS_AND_CONF, 0x84,
 369
 370         /* This is weird: the datasheet says that you should use 2 as the minimum value, */
 371         /* but Hauppauge uses 0, and changing that to 2 causes indeed problems (for 50hz) */
 372         /* hoffset low (input), 0x0002 is minimum */
 373         R_94_A_HORIZ_INPUT_WINDOW_START, 0x00,
 374         R_95_A_HORIZ_INPUT_WINDOW_START_MSB, 0x00,
 375
 376         /* hsize low (input), 0x02d0 = 720 */
 377         R_96_A_HORIZ_INPUT_WINDOW_LENGTH, 0xd0,
 378         R_97_A_HORIZ_INPUT_WINDOW_LENGTH_MSB, 0x02,
 379
 380         R_98_A_VERT_INPUT_WINDOW_START, 0x03,
 381         R_99_A_VERT_INPUT_WINDOW_START_MSB, 0x00,
 382
 383         /* vsize 0x12 = 18 */
 384         R_9A_A_VERT_INPUT_WINDOW_LENGTH, 0x12,
 385         R_9B_A_VERT_INPUT_WINDOW_LENGTH_MSB, 0x00,
 386
 387         /* hsize 0x05a0 = 1440 */
 388         R_9C_A_HORIZ_OUTPUT_WINDOW_LENGTH, 0xa0,
 389         R_9D_A_HORIZ_OUTPUT_WINDOW_LENGTH_MSB, 0x05,    /* hsize hi (output) */
 390         R_9E_A_VERT_OUTPUT_WINDOW_LENGTH, 0x12,         /* vsize low (output), 0x12 = 18 */
 391         R_9F_A_VERT_OUTPUT_WINDOW_LENGTH_MSB, 0x00,     /* vsize hi (output) */
 392
 393         /* Task B */
 394         R_C0_B_TASK_HANDLING_CNTL, 0x00,
 395         R_C1_B_X_PORT_FORMATS_AND_CONF, 0x08,
 396         R_C2_B_INPUT_REFERENCE_SIGNAL_DEFINITION, 0x00,
 397         R_C3_B_I_PORT_FORMATS_AND_CONF, 0x80,
 398
 399         /* This is weird: the datasheet says that you should use 2 as the minimum value, */
 400         /* but Hauppauge uses 0, and changing that to 2 causes indeed problems (for 50hz) */
 401         /* hoffset low (input), 0x0002 is minimum. See comment above. */
 402         R_C4_B_HORIZ_INPUT_WINDOW_START, 0x00,
 403         R_C5_B_HORIZ_INPUT_WINDOW_START_MSB, 0x00,
 404
 405         /* hsize 0x02d0 = 720 */
 406         R_C6_B_HORIZ_INPUT_WINDOW_LENGTH, 0xd0,
 407         R_C7_B_HORIZ_INPUT_WINDOW_LENGTH_MSB, 0x02,
 408
 409         /* voffset 0x16 = 22 */
 410         R_C8_B_VERT_INPUT_WINDOW_START, 0x16,
 411         R_C9_B_VERT_INPUT_WINDOW_START_MSB, 0x00,
 412
 413         /* vsize 0x0120 = 288 */
 414         R_CA_B_VERT_INPUT_WINDOW_LENGTH, 0x20,
 415         R_CB_B_VERT_INPUT_WINDOW_LENGTH_MSB, 0x01,
 416
 417         /* hsize 0x02d0 = 720 */
 418         R_CC_B_HORIZ_OUTPUT_WINDOW_LENGTH, 0xd0,
 419         R_CD_B_HORIZ_OUTPUT_WINDOW_LENGTH_MSB, 0x02,
 420
 421         R_F0_LFCO_PER_LINE, 0xb0,               /* Set PLL Register. 50hz 625 lines per frame, 27 MHz */
 422         R_F1_P_I_PARAM_SELECT, 0x05,            /* low bit with 0xF0, (was 0x05) */
 423         R_F5_PULSGEN_LINE_LENGTH, 0xb0,
 424         R_F6_PULSE_A_POS_LSB_AND_PULSEGEN_CONFIG, 0x01,
 425
 426         0x00, 0x00
 427 };
 428
 429 /* ============== SAA7715 VIDEO templates (end) =======  */
 430
 431 static const unsigned char saa7115_cfg_vbi_on[] = {
 432         R_80_GLOBAL_CNTL_1, 0x00,                       /* reset tasks */
 433         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,            /* reset scaler */
 434         R_80_GLOBAL_CNTL_1, 0x30,                       /* Activate both tasks */
 435         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xf0,            /* activate scaler */
 436         R_87_I_PORT_I_O_ENA_OUT_CLK_AND_GATED, 0x01,    /* Enable I-port output */
 437
 438         0x00, 0x00
 439 };
 440
 441 static const unsigned char saa7115_cfg_vbi_off[] = {
 442         R_80_GLOBAL_CNTL_1, 0x00,                       /* reset tasks */
 443         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,            /* reset scaler */
 444         R_80_GLOBAL_CNTL_1, 0x20,                       /* Activate only task "B" */
 445         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xf0,            /* activate scaler */
 446         R_87_I_PORT_I_O_ENA_OUT_CLK_AND_GATED, 0x01,    /* Enable I-port output */
 447
 448         0x00, 0x00
 449 };
 450
 451
 452 static const unsigned char saa7115_init_misc[] = {
 453         R_81_V_SYNC_FLD_ID_SRC_SEL_AND_RETIMED_V_F, 0x01,
 454         R_83_X_PORT_I_O_ENA_AND_OUT_CLK, 0x01,
 455         R_84_I_PORT_SIGNAL_DEF, 0x20,
 456         R_85_I_PORT_SIGNAL_POLAR, 0x21,
 457         R_86_I_PORT_FIFO_FLAG_CNTL_AND_ARBIT, 0xc5,
 458         R_87_I_PORT_I_O_ENA_OUT_CLK_AND_GATED, 0x01,
 459
 460         /* Task A */
 461         R_A0_A_HORIZ_PRESCALING, 0x01,
 462         R_A1_A_ACCUMULATION_LENGTH, 0x00,
 463         R_A2_A_PRESCALER_DC_GAIN_AND_FIR_PREFILTER, 0x00,
 464
 465         /* Configure controls at nominal value*/
 466         R_A4_A_LUMA_BRIGHTNESS_CNTL, 0x80,
 467         R_A5_A_LUMA_CONTRAST_CNTL, 0x40,
 468         R_A6_A_CHROMA_SATURATION_CNTL, 0x40,
 469
 470         /* note: 2 x zoom ensures that VBI lines have same length as video lines. */
 471         R_A8_A_HORIZ_LUMA_SCALING_INC, 0x00,
 472         R_A9_A_HORIZ_LUMA_SCALING_INC_MSB, 0x02,
 473
 474         R_AA_A_HORIZ_LUMA_PHASE_OFF, 0x00,
 475
 476         /* must be horiz lum scaling / 2 */
 477         R_AC_A_HORIZ_CHROMA_SCALING_INC, 0x00,
 478         R_AD_A_HORIZ_CHROMA_SCALING_INC_MSB, 0x01,
 479
 480         /* must be offset luma / 2 */
 481         R_AE_A_HORIZ_CHROMA_PHASE_OFF, 0x00,
 482
 483         R_B0_A_VERT_LUMA_SCALING_INC, 0x00,
 484         R_B1_A_VERT_LUMA_SCALING_INC_MSB, 0x04,
 485
 486         R_B2_A_VERT_CHROMA_SCALING_INC, 0x00,
 487         R_B3_A_VERT_CHROMA_SCALING_INC_MSB, 0x04,
 488
 489         R_B4_A_VERT_SCALING_MODE_CNTL, 0x01,
 490
 491         R_B8_A_VERT_CHROMA_PHASE_OFF_00, 0x00,
 492         R_B9_A_VERT_CHROMA_PHASE_OFF_01, 0x00,
 493         R_BA_A_VERT_CHROMA_PHASE_OFF_10, 0x00,
 494         R_BB_A_VERT_CHROMA_PHASE_OFF_11, 0x00,
 495
 496         R_BC_A_VERT_LUMA_PHASE_OFF_00, 0x00,
 497         R_BD_A_VERT_LUMA_PHASE_OFF_01, 0x00,
 498         R_BE_A_VERT_LUMA_PHASE_OFF_10, 0x00,
 499         R_BF_A_VERT_LUMA_PHASE_OFF_11, 0x00,
 500
 501         /* Task B */
 502         R_D0_B_HORIZ_PRESCALING, 0x01,
 503         R_D1_B_ACCUMULATION_LENGTH, 0x00,
 504         R_D2_B_PRESCALER_DC_GAIN_AND_FIR_PREFILTER, 0x00,
 505
 506         /* Configure controls at nominal value*/
 507         R_D4_B_LUMA_BRIGHTNESS_CNTL, 0x80,
 508         R_D5_B_LUMA_CONTRAST_CNTL, 0x40,
 509         R_D6_B_CHROMA_SATURATION_CNTL, 0x40,
 510
 511         /* hor lum scaling 0x0400 = 1 */
 512         R_D8_B_HORIZ_LUMA_SCALING_INC, 0x00,
 513         R_D9_B_HORIZ_LUMA_SCALING_INC_MSB, 0x04,
 514
 515         R_DA_B_HORIZ_LUMA_PHASE_OFF, 0x00,
 516
 517         /* must be hor lum scaling / 2 */
 518         R_DC_B_HORIZ_CHROMA_SCALING, 0x00,
 519         R_DD_B_HORIZ_CHROMA_SCALING_MSB, 0x02,
 520
 521         /* must be offset luma / 2 */
 522         R_DE_B_HORIZ_PHASE_OFFSET_CRHOMA, 0x00,
 523
 524         R_E0_B_VERT_LUMA_SCALING_INC, 0x00,
 525         R_E1_B_VERT_LUMA_SCALING_INC_MSB, 0x04,
 526
 527         R_E2_B_VERT_CHROMA_SCALING_INC, 0x00,
 528         R_E3_B_VERT_CHROMA_SCALING_INC_MSB, 0x04,
 529
 530         R_E4_B_VERT_SCALING_MODE_CNTL, 0x01,
 531
 532         R_E8_B_VERT_CHROMA_PHASE_OFF_00, 0x00,
 533         R_E9_B_VERT_CHROMA_PHASE_OFF_01, 0x00,
 534         R_EA_B_VERT_CHROMA_PHASE_OFF_10, 0x00,
 535         R_EB_B_VERT_CHROMA_PHASE_OFF_11, 0x00,
 536
 537         R_EC_B_VERT_LUMA_PHASE_OFF_00, 0x00,
 538         R_ED_B_VERT_LUMA_PHASE_OFF_01, 0x00,
 539         R_EE_B_VERT_LUMA_PHASE_OFF_10, 0x00,
 540         R_EF_B_VERT_LUMA_PHASE_OFF_11, 0x00,
 541
 542         R_F2_NOMINAL_PLL2_DTO, 0x50,            /* crystal clock = 24.576 MHz, target = 27MHz */
 543         R_F3_PLL_INCREMENT, 0x46,
 544         R_F4_PLL2_STATUS, 0x00,
 545         R_F7_PULSE_A_POS_MSB, 0x4b,             /* not the recommended settings! */
 546         R_F8_PULSE_B_POS, 0x00,
 547         R_F9_PULSE_B_POS_MSB, 0x4b,
 548         R_FA_PULSE_C_POS, 0x00,
 549         R_FB_PULSE_C_POS_MSB, 0x4b,
 550
 551         /* PLL2 lock detection settings: 71 lines 50% phase error */
 552         R_FF_S_PLL_MAX_PHASE_ERR_THRESH_NUM_LINES, 0x88,
 553
 554         /* Turn off VBI */
 555         R_40_SLICER_CNTL_1, 0x20,             /* No framing code errors allowed. */
 556         R_41_LCR_BASE, 0xff,
 557         R_41_LCR_BASE+1, 0xff,
 558         R_41_LCR_BASE+2, 0xff,
 559         R_41_LCR_BASE+3, 0xff,
 560         R_41_LCR_BASE+4, 0xff,
 561         R_41_LCR_BASE+5, 0xff,
 562         R_41_LCR_BASE+6, 0xff,
 563         R_41_LCR_BASE+7, 0xff,
 564         R_41_LCR_BASE+8, 0xff,
 565         R_41_LCR_BASE+9, 0xff,
 566         R_41_LCR_BASE+10, 0xff,
 567         R_41_LCR_BASE+11, 0xff,
 568         R_41_LCR_BASE+12, 0xff,
 569         R_41_LCR_BASE+13, 0xff,
 570         R_41_LCR_BASE+14, 0xff,
 571         R_41_LCR_BASE+15, 0xff,
 572         R_41_LCR_BASE+16, 0xff,
 573         R_41_LCR_BASE+17, 0xff,
 574         R_41_LCR_BASE+18, 0xff,
 575         R_41_LCR_BASE+19, 0xff,
 576         R_41_LCR_BASE+20, 0xff,
 577         R_41_LCR_BASE+21, 0xff,
 578         R_41_LCR_BASE+22, 0xff,
 579         R_58_PROGRAM_FRAMING_CODE, 0x40,
 580         R_59_H_OFF_FOR_SLICER, 0x47,
 581         R_5B_FLD_OFF_AND_MSB_FOR_H_AND_V_OFF, 0x83,
 582         R_5D_DID, 0xbd,
 583         R_5E_SDID, 0x35,
 584
 585         R_02_INPUT_CNTL_1, 0x84,                /* input tuner -> input 4, amplifier active */
 586
 587         R_80_GLOBAL_CNTL_1, 0x20,               /* enable task B */
 588         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xd0,
 589         R_88_POWER_SAVE_ADC_PORT_CNTL, 0xf0,
 590         0x00, 0x00
 591 };
 592
 593 static int saa711x_odd_parity(u8 c)
 594 {
 595         c ^= (c >> 4);
 596         c ^= (c >> 2);
 597         c ^= (c >> 1);
 598
 599         return c & 1;
 600 }
 601
 602 static int saa711x_decode_vps(u8 * dst, u8 * p)
 603 {
 604         static const u8 biphase_tbl[] = {
 605                 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
 606                 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
 607                 0xd2, 0x5a, 0x52, 0xd2, 0x96, 0x1e, 0x16, 0x96,
 608                 0x92, 0x1a, 0x12, 0x92, 0xd2, 0x5a, 0x52, 0xd2,
 609                 0xd0, 0x58, 0x50, 0xd0, 0x94, 0x1c, 0x14, 0x94,
 610                 0x90, 0x18, 0x10, 0x90, 0xd0, 0x58, 0x50, 0xd0,
 611                 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
 612                 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
 613                 0xe1, 0x69, 0x61, 0xe1, 0xa5, 0x2d, 0x25, 0xa5,
 614                 0xa1, 0x29, 0x21, 0xa1, 0xe1, 0x69, 0x61, 0xe1,
 615                 0xc3, 0x4b, 0x43, 0xc3, 0x87, 0x0f, 0x07, 0x87,
 616                 0x83, 0x0b, 0x03, 0x83, 0xc3, 0x4b, 0x43, 0xc3,
 617                 0xc1, 0x49, 0x41, 0xc1, 0x85, 0x0d, 0x05, 0x85,
 618                 0x81, 0x09, 0x01, 0x81, 0xc1, 0x49, 0x41, 0xc1,
 619                 0xe1, 0x69, 0x61, 0xe1, 0xa5, 0x2d, 0x25, 0xa5,
 620                 0xa1, 0x29, 0x21, 0xa1, 0xe1, 0x69, 0x61, 0xe1,
 621                 0xe0, 0x68, 0x60, 0xe0, 0xa4, 0x2c, 0x24, 0xa4,
 622                 0xa0, 0x28, 0x20, 0xa0, 0xe0, 0x68, 0x60, 0xe0,
 623                 0xc2, 0x4a, 0x42, 0xc2, 0x86, 0x0e, 0x06, 0x86,
 624                 0x82, 0x0a, 0x02, 0x82, 0xc2, 0x4a, 0x42, 0xc2,
 625                 0xc0, 0x48, 0x40, 0xc0, 0x84, 0x0c, 0x04, 0x84,
 626                 0x80, 0x08, 0x00, 0x80, 0xc0, 0x48, 0x40, 0xc0,
 627                 0xe0, 0x68, 0x60, 0xe0, 0xa4, 0x2c, 0x24, 0xa4,
 628                 0xa0, 0x28, 0x20, 0xa0, 0xe0, 0x68, 0x60, 0xe0,
 629                 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
 630                 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
 631                 0xd2, 0x5a, 0x52, 0xd2, 0x96, 0x1e, 0x16, 0x96,
 632                 0x92, 0x1a, 0x12, 0x92, 0xd2, 0x5a, 0x52, 0xd2,
 633                 0xd0, 0x58, 0x50, 0xd0, 0x94, 0x1c, 0x14, 0x94,
 634                 0x90, 0x18, 0x10, 0x90, 0xd0, 0x58, 0x50, 0xd0,
 635                 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
 636                 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
 637         };
 638         int i;
 639         u8 c, err = 0;
 640
 641         for (i = 0; i < 2 * 13; i += 2) {
 642                 err |= biphase_tbl[p[i]] | biphase_tbl[p[i + 1]];
 643                 c = (biphase_tbl[p[i + 1]] & 0xf) | ((biphase_tbl[p[i]] & 0xf) << 4);
 644                 dst[i / 2] = c;
 645         }
 646         return err & 0xf0;
 647 }
 648
 649 static int saa711x_decode_wss(u8 * p)
 650 {
 651         static const int wss_bits[8] = {
 652                 0, 0, 0, 1, 0, 1, 1, 1
 653         };
 654         unsigned char parity;
 655         int wss = 0;
 656         int i;
 657
 658         for (i = 0; i < 16; i++) {
 659                 int b1 = wss_bits[p[i] & 7];
 660                 int b2 = wss_bits[(p[i] >> 3) & 7];
 661
 662                 if (b1 == b2)
 663                         return -1;
 664                 wss |= b2 << i;
 665         }
 666         parity = wss & 15;
 667         parity ^= parity >> 2;
 668         parity ^= parity >> 1;
 669
 670         if (!(parity & 1))
 671                 return -1;
 672
 673         return wss;
 674 }
 675
 676 static int saa711x_set_audio_clock_freq(struct i2c_client *client, u32 freq)
 677 {
 678         struct saa711x_state *state = i2c_get_clientdata(client);
 679         u32 acpf;
 680         u32 acni;
 681         u32 hz;
 682         u64 f;
 683         u8 acc = 0;     /* reg 0x3a, audio clock control */
 684
 685         /* Checks for chips that don't have audio clock (saa7111, saa7113) */
 686         if (!saa711x_has_reg(state->ident,R_30_AUD_MAST_CLK_CYCLES_PER_FIELD))
 687                 return 0;
 688
 689         v4l_dbg(1, debug, client, "set audio clock freq: %d\n", freq);
 690
 691         /* sanity check */
 692         if (freq < 32000 || freq > 48000)
 693                 return -EINVAL;
 694
 695         /* hz is the refresh rate times 100 */
 696         hz = (state->std & V4L2_STD_525_60) ? 5994 : 5000;
 697         /* acpf = (256 * freq) / field_frequency == (256 * 100 * freq) / hz */
 698         acpf = (25600 * freq) / hz;
 699         /* acni = (256 * freq * 2^23) / crystal_frequency =
 700                   (freq * 2^(8+23)) / crystal_frequency =
 701                   (freq << 31) / crystal_frequency */
 702         f = freq;
 703         f = f << 31;
 704         do_div(f, state->crystal_freq);
 705         acni = f;
 706         if (state->ucgc) {
 707                 acpf = acpf * state->cgcdiv / 16;
 708                 acni = acni * state->cgcdiv / 16;
 709                 acc = 0x80;
 710                 if (state->cgcdiv == 3)
 711                         acc |= 0x40;
 712         }
 713         if (state->apll)
 714                 acc |= 0x08;
 715
 716         saa711x_write(client, R_38_CLK_RATIO_AMXCLK_TO_ASCLK, 0x03);
 717         saa711x_write(client, R_39_CLK_RATIO_ASCLK_TO_ALRCLK, 0x10);
 718         saa711x_write(client, R_3A_AUD_CLK_GEN_BASIC_SETUP, acc);
 719
 720         saa711x_write(client, R_30_AUD_MAST_CLK_CYCLES_PER_FIELD, acpf & 0xff);
 721         saa711x_write(client, R_30_AUD_MAST_CLK_CYCLES_PER_FIELD+1,
 722                                                         (acpf >> 8) & 0xff);
 723         saa711x_write(client, R_30_AUD_MAST_CLK_CYCLES_PER_FIELD+2,
 724                                                         (acpf >> 16) & 0x03);
 725
 726         saa711x_write(client, R_34_AUD_MAST_CLK_NOMINAL_INC, acni & 0xff);
 727         saa711x_write(client, R_34_AUD_MAST_CLK_NOMINAL_INC+1, (acni >> 8) & 0xff);
 728         saa711x_write(client, R_34_AUD_MAST_CLK_NOMINAL_INC+2, (acni >> 16) & 0x3f);
 729         state->audclk_freq = freq;
 730         return 0;
 731 }
 732
 733 static int saa711x_set_v4lctrl(struct i2c_client *client, struct v4l2_control *ctrl)
 734 {
 735         struct saa711x_state *state = i2c_get_clientdata(client);
 736
 737         switch (ctrl->id) {
 738         case V4L2_CID_BRIGHTNESS:
 739                 if (ctrl->value < 0 || ctrl->value > 255) {
 740                         v4l_err(client, "invalid brightness setting %d\n", ctrl->value);
 741                         return -ERANGE;
 742                 }
 743
 744                 state->bright = ctrl->value;
 745                 saa711x_write(client, R_0A_LUMA_BRIGHT_CNTL, state->bright);
 746                 break;
 747
 748         case V4L2_CID_CONTRAST:
 749                 if (ctrl->value < 0 || ctrl->value > 127) {
 750                         v4l_err(client, "invalid contrast setting %d\n", ctrl->value);
 751                         return -ERANGE;
 752                 }
 753
 754                 state->contrast = ctrl->value;
 755                 saa711x_write(client, R_0B_LUMA_CONTRAST_CNTL, state->contrast);
 756                 break;
 757
 758         case V4L2_CID_SATURATION:
 759                 if (ctrl->value < 0 || ctrl->value > 127) {
 760                         v4l_err(client, "invalid saturation setting %d\n", ctrl->value);
 761                         return -ERANGE;
 762                 }
 763
 764                 state->sat = ctrl->value;
 765                 saa711x_write(client, R_0C_CHROMA_SAT_CNTL, state->sat);
 766                 break;
 767
 768         case V4L2_CID_HUE:
 769                 if (ctrl->value < -127 || ctrl->value > 127) {
 770                         v4l_err(client, "invalid hue setting %d\n", ctrl->value);
 771                         return -ERANGE;
 772                 }
 773
 774                 state->hue = ctrl->value;
 775                 saa711x_write(client, R_0D_CHROMA_HUE_CNTL, state->hue);
 776                 break;
 777
 778         default:
 779                 return -EINVAL;
 780         }
 781
 782         return 0;
 783 }
 784
 785 static int saa711x_get_v4lctrl(struct i2c_client *client, struct v4l2_control *ctrl)
 786 {
 787         struct saa711x_state *state = i2c_get_clientdata(client);
 788
 789         switch (ctrl->id) {
 790         case V4L2_CID_BRIGHTNESS:
 791                 ctrl->value = state->bright;
 792                 break;
 793         case V4L2_CID_CONTRAST:
 794                 ctrl->value = state->contrast;
 795                 break;
 796         case V4L2_CID_SATURATION:
 797                 ctrl->value = state->sat;
 798                 break;
 799         case V4L2_CID_HUE:
 800                 ctrl->value = state->hue;
 801                 break;
 802         default:
 803                 return -EINVAL;
 804         }
 805
 806         return 0;
 807 }
 808
 809 static int saa711x_set_size(struct i2c_client *client, int width, int height)
 810 {
 811         struct saa711x_state *state = i2c_get_clientdata(client);
 812         int HPSC, HFSC;
 813         int VSCY;
 814         int res;
 815         int is_50hz = state->std & V4L2_STD_625_50;
 816         int Vsrc = is_50hz ? 576 : 480;
 817
 818         v4l_dbg(1, debug, client, "decoder set size to %ix%i\n",width,height);
 819
 820         /* FIXME need better bounds checking here */
 821         if ((width < 1) || (width > 1440))
 822                 return -EINVAL;
 823         if ((height < 1) || (height > Vsrc))
 824                 return -EINVAL;
 825
 826         if (!saa711x_has_reg(state->ident,R_D0_B_HORIZ_PRESCALING)) {
 827                 /* Decoder only supports 720 columns and 480 or 576 lines */
 828                 if (width != 720)
 829                         return -EINVAL;
 830                 if (height != Vsrc)
 831                         return -EINVAL;
 832         }
 833
 834         state->width = width;
 835         state->height = height;
 836
 837         if (!saa711x_has_reg(state->ident, R_CC_B_HORIZ_OUTPUT_WINDOW_LENGTH))
 838                 return 0;
 839
 840         /* probably have a valid size, let's set it */
 841         /* Set output width/height */
 842         /* width */
 843
 844         saa711x_write(client, R_CC_B_HORIZ_OUTPUT_WINDOW_LENGTH,
 845                                         (u8) (width & 0xff));
 846         saa711x_write(client, R_CD_B_HORIZ_OUTPUT_WINDOW_LENGTH_MSB,
 847                                         (u8) ((width >> 8) & 0xff));
 848
 849         /* Vertical Scaling uses height/2 */
 850         res=height/2;
 851
 852         /* On 60Hz, it is using a higher Vertical Output Size */
 853         if (!is_50hz)
 854                 res += (VRES_60HZ - 480) >> 1;
 855
 856                 /* height */
 857         saa711x_write(client, R_CE_B_VERT_OUTPUT_WINDOW_LENGTH,
 858                                         (u8) (res & 0xff));
 859         saa711x_write(client, R_CF_B_VERT_OUTPUT_WINDOW_LENGTH_MSB,
 860                                         (u8) ((res >> 8) & 0xff));
 861
 862         /* Scaling settings */
 863         /* Hprescaler is floor(inres/outres) */
 864         HPSC = (int)(720 / width);
 865         /* 0 is not allowed (div. by zero) */
 866         HPSC = HPSC ? HPSC : 1;
 867         HFSC = (int)((1024 * 720) / (HPSC * width));
 868         /* FIXME hardcodes to "Task B"
 869          * write H prescaler integer */
 870         saa711x_write(client, R_D0_B_HORIZ_PRESCALING,
 871                                 (u8) (HPSC & 0x3f));
 872
 873         v4l_dbg(1, debug, client, "Hpsc: 0x%05x, Hfsc: 0x%05x\n", HPSC, HFSC);
 874         /* write H fine-scaling (luminance) */
 875         saa711x_write(client, R_D8_B_HORIZ_LUMA_SCALING_INC,
 876                                 (u8) (HFSC & 0xff));
 877         saa711x_write(client, R_D9_B_HORIZ_LUMA_SCALING_INC_MSB,
 878                                 (u8) ((HFSC >> 8) & 0xff));
 879         /* write H fine-scaling (chrominance)
 880          * must be lum/2, so i'll just bitshift :) */
 881         saa711x_write(client, R_DC_B_HORIZ_CHROMA_SCALING,
 882                                 (u8) ((HFSC >> 1) & 0xff));
 883         saa711x_write(client, R_DD_B_HORIZ_CHROMA_SCALING_MSB,
 884                                 (u8) ((HFSC >> 9) & 0xff));
 885
 886         VSCY = (int)((1024 * Vsrc) / height);
 887         v4l_dbg(1, debug, client, "Vsrc: %d, Vscy: 0x%05x\n", Vsrc, VSCY);
 888
 889         /* Correct Contrast and Luminance */
 890         saa711x_write(client, R_D5_B_LUMA_CONTRAST_CNTL,
 891                                         (u8) (64 * 1024 / VSCY));
 892         saa711x_write(client, R_D6_B_CHROMA_SATURATION_CNTL,
 893                                         (u8) (64 * 1024 / VSCY));
 894
 895                 /* write V fine-scaling (luminance) */
 896         saa711x_write(client, R_E0_B_VERT_LUMA_SCALING_INC,
 897                                         (u8) (VSCY & 0xff));
 898         saa711x_write(client, R_E1_B_VERT_LUMA_SCALING_INC_MSB,
 899                                         (u8) ((VSCY >> 8) & 0xff));
 900                 /* write V fine-scaling (chrominance) */
 901         saa711x_write(client, R_E2_B_VERT_CHROMA_SCALING_INC,
 902                                         (u8) (VSCY & 0xff));
 903         saa711x_write(client, R_E3_B_VERT_CHROMA_SCALING_INC_MSB,
 904                                         (u8) ((VSCY >> 8) & 0xff));
 905
 906         saa711x_writeregs(client, saa7115_cfg_reset_scaler);
 907
 908         /* Activates task "B" */
 909         saa711x_write(client, R_80_GLOBAL_CNTL_1,
 910                                 saa711x_read(client,R_80_GLOBAL_CNTL_1) | 0x20);
 911
 912         return 0;
 913 }
 914
 915 static void saa711x_set_v4lstd(struct i2c_client *client, v4l2_std_id std)
 916 {
 917         struct saa711x_state *state = i2c_get_clientdata(client);
 918
 919         /* Prevent unnecessary standard changes. During a standard
 920            change the I-Port is temporarily disabled. Any devices
 921            reading from that port can get confused.
 922            Note that VIDIOC_S_STD is also used to switch from
 923            radio to TV mode, so if a VIDIOC_S_STD is broadcast to
 924            all I2C devices then you do not want to have an unwanted
 925            side-effect here. */
 926         if (std == state->std)
 927                 return;
 928
 929         state->std = std;
 930
 931         // This works for NTSC-M, SECAM-L and the 50Hz PAL variants.
 932         if (std & V4L2_STD_525_60) {
 933                 v4l_dbg(1, debug, client, "decoder set standard 60 Hz\n");
 934                 saa711x_writeregs(client, saa7115_cfg_60hz_video);
 935                 saa711x_set_size(client, 720, 480);
 936         } else {
 937                 v4l_dbg(1, debug, client, "decoder set standard 50 Hz\n");
 938                 saa711x_writeregs(client, saa7115_cfg_50hz_video);
 939                 saa711x_set_size(client, 720, 576);
 940         }
 941
 942         /* Register 0E - Bits D6-D4 on NO-AUTO mode
 943                 (SAA7111 and SAA7113 doesn't have auto mode)
 944             50 Hz / 625 lines           60 Hz / 525 lines
 945         000 PAL BGDHI (4.43Mhz)         NTSC M (3.58MHz)
 946         001 NTSC 4.43 (50 Hz)           PAL 4.43 (60 Hz)
 947         010 Combination-PAL N (3.58MHz) NTSC 4.43 (60 Hz)
 948         011 NTSC N (3.58MHz)            PAL M (3.58MHz)
 949         100 reserved                    NTSC-Japan (3.58MHz)
 950         */
 951         if (state->ident == V4L2_IDENT_SAA7111 ||
 952             state->ident == V4L2_IDENT_SAA7113) {
 953                 u8 reg = saa711x_read(client, R_0E_CHROMA_CNTL_1) & 0x8f;
 954
 955                 if (std == V4L2_STD_PAL_M) {
 956                         reg |= 0x30;
 957                 } else if (std == V4L2_STD_PAL_N) {
 958                         reg |= 0x20;
 959                 } else if (std == V4L2_STD_PAL_60) {
 960                         reg |= 0x10;
 961                 } else if (std == V4L2_STD_NTSC_M_JP) {
 962                         reg |= 0x40;
 963                 } else if (std & V4L2_STD_SECAM) {
 964                         reg |= 0x50;
 965                 }
 966                 saa711x_write(client, R_0E_CHROMA_CNTL_1, reg);
 967         } else {
 968                 /* restart task B if needed */
 969                 int taskb = saa711x_read(client, R_80_GLOBAL_CNTL_1) & 0x10;
 970
 971                 if (taskb && state->ident == V4L2_IDENT_SAA7114) {
 972                         saa711x_writeregs(client, saa7115_cfg_vbi_on);
 973                 }
 974
 975                 /* switch audio mode too! */
 976                 saa711x_set_audio_clock_freq(client, state->audclk_freq);
 977         }
 978 }
 979
 980 static v4l2_std_id saa711x_get_v4lstd(struct i2c_client *client)
 981 {
 982         struct saa711x_state *state = i2c_get_clientdata(client);
 983
 984         return state->std;
 985 }
 986
 987 static void saa711x_log_status(struct i2c_client *client)
 988 {
 989         struct saa711x_state *state = i2c_get_clientdata(client);
 990         int reg1e, reg1f;
 991         int signalOk;
 992         int vcr;
 993
 994         v4l_info(client, "Audio frequency: %d Hz\n", state->audclk_freq);
 995         if (state->ident != V4L2_IDENT_SAA7115) {
 996                 /* status for the saa7114 */
 997                 reg1f = saa711x_read(client, R_1F_STATUS_BYTE_2_VD_DEC);
 998                 signalOk = (reg1f & 0xc1) == 0x81;
 999                 v4l_info(client, "Video signal:    %s\n", signalOk ? "ok" : "bad");
1000                 v4l_info(client, "Frequency:       %s\n", (reg1f & 0x20) ? "60 Hz" : "50 Hz");
1001                 return;
1002         }
1003
1004         /* status for the saa7115 */
1005         reg1e = saa711x_read(client, R_1E_STATUS_BYTE_1_VD_DEC);
1006         reg1f = saa711x_read(client, R_1F_STATUS_BYTE_2_VD_DEC);
1007
1008         signalOk = (reg1f & 0xc1) == 0x81 && (reg1e & 0xc0) == 0x80;
1009         vcr = !(reg1f & 0x10);
1010
1011         if (state->input >= 6) {
1012                 v4l_info(client, "Input:           S-Video %d\n", state->input - 6);
1013         } else {
1014                 v4l_info(client, "Input:           Composite %d\n", state->input);
1015         }
1016         v4l_info(client, "Video signal:    %s\n", signalOk ? (vcr ? "VCR" : "broadcast/DVD") : "bad");
1017         v4l_info(client, "Frequency:       %s\n", (reg1f & 0x20) ? "60 Hz" : "50 Hz");
1018
1019         switch (reg1e & 0x03) {
1020                 case 1:
1021                         v4l_info(client, "Detected format: NTSC\n");
1022                         break;
1023                 case 2:
1024                         v4l_info(client, "Detected format: PAL\n");
1025                         break;
1026                 case 3:
1027                         v4l_info(client, "Detected format: SECAM\n");
1028                         break;
1029                 default:
1030                         v4l_info(client, "Detected format: BW/No color\n");
1031                         break;
1032         }
1033         v4l_info(client, "Width, Height:   %d, %d\n", state->width, state->height);
1034 }
1035
1036 /* setup the sliced VBI lcr registers according to the sliced VBI format */
1037 static void saa711x_set_lcr(struct i2c_client *client, struct v4l2_sliced_vbi_format *fmt)
1038 {
1039         struct saa711x_state *state = i2c_get_clientdata(client);
1040         int is_50hz = (state->std & V4L2_STD_625_50);
1041         u8 lcr[24];
1042         int i, x;
1043
1044 #if 1
1045         /* saa7113/7114/7118 VBI support are experimental */
1046         if (!saa711x_has_reg(state->ident,R_41_LCR_BASE))
1047                 return;
1048
1049 #else
1050         /* SAA7113 and SAA7118 also should support VBI - Need testing */
1051         if (state->ident != V4L2_IDENT_SAA7115)
1052                 return;
1053 #endif
1054
1055         for (i = 0; i <= 23; i++)
1056                 lcr[i] = 0xff;
1057
1058         if (fmt->service_set == 0) {
1059                 /* raw VBI */
1060                 if (is_50hz)
1061                         for (i = 6; i <= 23; i++)
1062                                 lcr[i] = 0xdd;
1063                 else
1064                         for (i = 10; i <= 21; i++)
1065                                 lcr[i] = 0xdd;
1066         } else {
1067                 /* sliced VBI */
1068                 /* first clear lines that cannot be captured */
1069                 if (is_50hz) {
1070                         for (i = 0; i <= 5; i++)
1071                                 fmt->service_lines[0][i] =
1072                                         fmt->service_lines[1][i] = 0;
1073                 }
1074                 else {
1075                         for (i = 0; i <= 9; i++)
1076                                 fmt->service_lines[0][i] =
1077                                         fmt->service_lines[1][i] = 0;
1078                         for (i = 22; i <= 23; i++)
1079                                 fmt->service_lines[0][i] =
1080                                         fmt->service_lines[1][i] = 0;
1081                 }
1082
1083                 /* Now set the lcr values according to the specified service */
1084                 for (i = 6; i <= 23; i++) {
1085                         lcr[i] = 0;
1086                         for (x = 0; x <= 1; x++) {
1087                                 switch (fmt->service_lines[1-x][i]) {
1088                                         case 0:
1089                                                 lcr[i] |= 0xf << (4 * x);
1090                                                 break;
1091                                         case V4L2_SLICED_TELETEXT_B:
1092                                                 lcr[i] |= 1 << (4 * x);
1093                                                 break;
1094                                         case V4L2_SLICED_CAPTION_525:
1095                                                 lcr[i] |= 4 << (4 * x);
1096                                                 break;
1097                                         case V4L2_SLICED_WSS_625:
1098                                                 lcr[i] |= 5 << (4 * x);
1099                                                 break;
1100                                         case V4L2_SLICED_VPS:
1101                                                 lcr[i] |= 7 << (4 * x);
1102                                                 break;
1103                                 }
1104                         }
1105                 }
1106         }
1107
1108         /* write the lcr registers */
1109         for (i = 2; i <= 23; i++) {
1110                 saa711x_write(client, i - 2 + R_41_LCR_BASE, lcr[i]);
1111         }
1112
1113         /* enable/disable raw VBI capturing */
1114         saa711x_writeregs(client, fmt->service_set == 0 ?
1115                                 saa7115_cfg_vbi_on :
1116                                 saa7115_cfg_vbi_off);
1117 }
1118
1119 static int saa711x_get_v4lfmt(struct i2c_client *client, struct v4l2_format *fmt)
1120 {
1121         static u16 lcr2vbi[] = {
1122                 0, V4L2_SLICED_TELETEXT_B, 0,   /* 1 */
1123                 0, V4L2_SLICED_CAPTION_525,     /* 4 */
1124                 V4L2_SLICED_WSS_625, 0,         /* 5 */
1125                 V4L2_SLICED_VPS, 0, 0, 0, 0,    /* 7 */
1126                 0, 0, 0, 0
1127         };
1128         struct v4l2_sliced_vbi_format *sliced = &fmt->fmt.sliced;
1129         int i;
1130
1131         if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE)
1132                 return -EINVAL;
1133         memset(sliced, 0, sizeof(*sliced));
1134         /* done if using raw VBI */
1135         if (saa711x_read(client, R_80_GLOBAL_CNTL_1) & 0x10)
1136                 return 0;
1137         for (i = 2; i <= 23; i++) {
1138                 u8 v = saa711x_read(client, i - 2 + R_41_LCR_BASE);
1139
1140                 sliced->service_lines[0][i] = lcr2vbi[v >> 4];
1141                 sliced->service_lines[1][i] = lcr2vbi[v & 0xf];
1142                 sliced->service_set |=
1143                         sliced->service_lines[0][i] | sliced->service_lines[1][i];
1144         }
1145         return 0;
1146 }
1147
1148 static int saa711x_set_v4lfmt(struct i2c_client *client, struct v4l2_format *fmt)
1149 {
1150         if (fmt->type == V4L2_BUF_TYPE_SLICED_VBI_CAPTURE) {
1151                 saa711x_set_lcr(client, &fmt->fmt.sliced);
1152                 return 0;
1153         }
1154         if (fmt->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
1155                 return -EINVAL;
1156
1157         return saa711x_set_size(client,fmt->fmt.pix.width,fmt->fmt.pix.height);
1158 }
1159
1160 /* Decode the sliced VBI data stream as created by the saa7115.
1161    The format is described in the saa7115 datasheet in Tables 25 and 26
1162    and in Figure 33.
1163    The current implementation uses SAV/EAV codes and not the ancillary data
1164    headers. The vbi->p pointer points to the R_5E_SDID byte right after the SAV
1165    code. */
1166 static void saa711x_decode_vbi_line(struct i2c_client *client,
1167                                     struct v4l2_decode_vbi_line *vbi)
1168 {
1169         static const char vbi_no_data_pattern[] = {
1170                 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0
1171         };
1172         struct saa711x_state *state = i2c_get_clientdata(client);
1173         u8 *p = vbi->p;
1174         u32 wss;
1175         int id1, id2;   /* the ID1 and ID2 bytes from the internal header */
1176
1177         vbi->type = 0;  /* mark result as a failure */
1178         id1 = p[2];
1179         id2 = p[3];
1180         /* Note: the field bit is inverted for 60 Hz video */
1181         if (state->std & V4L2_STD_525_60)
1182                 id1 ^= 0x40;
1183
1184         /* Skip internal header, p now points to the start of the payload */
1185         p += 4;
1186         vbi->p = p;
1187
1188         /* calculate field and line number of the VBI packet (1-23) */
1189         vbi->is_second_field = ((id1 & 0x40) != 0);
1190         vbi->line = (id1 & 0x3f) << 3;
1191         vbi->line |= (id2 & 0x70) >> 4;
1192
1193         /* Obtain data type */
1194         id2 &= 0xf;
1195
1196         /* If the VBI slicer does not detect any signal it will fill up
1197            the payload buffer with 0xa0 bytes. */
1198         if (!memcmp(p, vbi_no_data_pattern, sizeof(vbi_no_data_pattern)))
1199                 return;
1200
1201         /* decode payloads */
1202         switch (id2) {
1203         case 1:
1204                 vbi->type = V4L2_SLICED_TELETEXT_B;
1205                 break;
1206         case 4:
1207                 if (!saa711x_odd_parity(p[0]) || !saa711x_odd_parity(p[1]))
1208                         return;
1209                 vbi->type = V4L2_SLICED_CAPTION_525;
1210                 break;
1211         case 5:
1212                 wss = saa711x_decode_wss(p);
1213                 if (wss == -1)
1214                         return;
1215                 p[0] = wss & 0xff;
1216                 p[1] = wss >> 8;
1217                 vbi->type = V4L2_SLICED_WSS_625;
1218                 break;
1219         case 7:
1220                 if (saa711x_decode_vps(p, p) != 0)
1221                         return;
1222                 vbi->type = V4L2_SLICED_VPS;
1223                 break;
1224         default:
1225                 return;
1226         }
1227 }
1228
1229 /* ============ SAA7115 AUDIO settings (end) ============= */
1230
1231 static int saa711x_command(struct i2c_client *client, unsigned int cmd, void *arg)
1232 {
1233         struct saa711x_state *state = i2c_get_clientdata(client);
1234         int *iarg = arg;
1235
1236         /* ioctls to allow direct access to the saa7115 registers for testing */
1237         switch (cmd) {
1238         case VIDIOC_S_FMT:
1239                 return saa711x_set_v4lfmt(client, (struct v4l2_format *)arg);
1240
1241         case VIDIOC_G_FMT:
1242                 return saa711x_get_v4lfmt(client, (struct v4l2_format *)arg);
1243
1244         case VIDIOC_INT_AUDIO_CLOCK_FREQ:
1245                 return saa711x_set_audio_clock_freq(client, *(u32 *)arg);
1246
1247         case VIDIOC_G_TUNER:
1248         {
1249                 struct v4l2_tuner *vt = arg;
1250                 int status;
1251
1252                 if (state->radio)
1253                         break;
1254                 status = saa711x_read(client, R_1F_STATUS_BYTE_2_VD_DEC);
1255
1256                 v4l_dbg(1, debug, client, "status: 0x%02x\n", status);
1257                 vt->signal = ((status & (1 << 6)) == 0) ? 0xffff : 0x0;
1258                 break;
1259         }
1260
1261         case VIDIOC_LOG_STATUS:
1262                 saa711x_log_status(client);
1263                 break;
1264
1265         case VIDIOC_G_CTRL:
1266                 return saa711x_get_v4lctrl(client, (struct v4l2_control *)arg);
1267
1268         case VIDIOC_S_CTRL:
1269                 return saa711x_set_v4lctrl(client, (struct v4l2_control *)arg);
1270
1271         case VIDIOC_QUERYCTRL:
1272         {
1273                 struct v4l2_queryctrl *qc = arg;
1274
1275                 switch (qc->id) {
1276                         case V4L2_CID_BRIGHTNESS:
1277                         case V4L2_CID_CONTRAST:
1278                         case V4L2_CID_SATURATION:
1279                         case V4L2_CID_HUE:
1280                                 return v4l2_ctrl_query_fill_std(qc);
1281                         default:
1282                                 return -EINVAL;
1283                 }
1284         }
1285
1286         case VIDIOC_G_STD:
1287                 *(v4l2_std_id *)arg = saa711x_get_v4lstd(client);
1288                 break;
1289
1290         case VIDIOC_S_STD:
1291                 state->radio = 0;
1292                 saa711x_set_v4lstd(client, *(v4l2_std_id *)arg);
1293                 break;
1294
1295         case AUDC_SET_RADIO:
1296                 state->radio = 1;
1297                 break;
1298
1299         case VIDIOC_INT_G_VIDEO_ROUTING:
1300         {
1301                 struct v4l2_routing *route = arg;
1302
1303                 route->input = state->input;
1304                 route->output = 0;
1305                 break;
1306         }
1307
1308         case VIDIOC_INT_S_VIDEO_ROUTING:
1309         {
1310                 struct v4l2_routing *route = arg;
1311
1312                 v4l_dbg(1, debug, client, "decoder set input %d\n", route->input);
1313                 /* saa7113 does not have these inputs */
1314                 if (state->ident == V4L2_IDENT_SAA7113 &&
1315                     (route->input == SAA7115_COMPOSITE4 ||
1316                      route->input == SAA7115_COMPOSITE5)) {
1317                         return -EINVAL;
1318                 }
1319                 if (route->input > SAA7115_SVIDEO3)
1320                         return -EINVAL;
1321                 if (state->input == route->input)
1322                         break;
1323                 v4l_dbg(1, debug, client, "now setting %s input\n",
1324                         (route->input >= SAA7115_SVIDEO0) ? "S-Video" : "Composite");
1325                 state->input = route->input;
1326
1327                 /* select mode */
1328                 saa711x_write(client, R_02_INPUT_CNTL_1,
1329                               (saa711x_read(client, R_02_INPUT_CNTL_1) & 0xf0) |
1330                                state->input);
1331
1332                 /* bypass chrominance trap for S-Video modes */
1333                 saa711x_write(client, R_09_LUMA_CNTL,
1334                               (saa711x_read(client, R_09_LUMA_CNTL) & 0x7f) |
1335                                (state->input >= SAA7115_SVIDEO0 ? 0x80 : 0x0));
1336                 break;
1337         }
1338
1339         case VIDIOC_STREAMON:
1340         case VIDIOC_STREAMOFF:
1341                 v4l_dbg(1, debug, client, "%s output\n",
1342                         (cmd == VIDIOC_STREAMON) ? "enable" : "disable");
1343
1344                 if (state->enable != (cmd == VIDIOC_STREAMON)) {
1345                         state->enable = (cmd == VIDIOC_STREAMON);
1346                         saa711x_write(client,
1347                                 R_87_I_PORT_I_O_ENA_OUT_CLK_AND_GATED,
1348                                 state->enable);
1349                 }
1350                 break;
1351
1352         case VIDIOC_INT_S_CRYSTAL_FREQ:
1353         {
1354                 struct v4l2_crystal_freq *freq = arg;
1355
1356                 if (freq->freq != SAA7115_FREQ_32_11_MHZ &&
1357                     freq->freq != SAA7115_FREQ_24_576_MHZ)
1358                         return -EINVAL;
1359                 state->crystal_freq = freq->freq;
1360                 state->cgcdiv = (freq->flags & SAA7115_FREQ_FL_CGCDIV) ? 3 : 4;
1361                 state->ucgc = (freq->flags & SAA7115_FREQ_FL_UCGC) ? 1 : 0;
1362                 state->apll = (freq->flags & SAA7115_FREQ_FL_APLL) ? 1 : 0;
1363                 saa711x_set_audio_clock_freq(client, state->audclk_freq);
1364                 break;
1365         }
1366
1367         case VIDIOC_INT_DECODE_VBI_LINE:
1368                 saa711x_decode_vbi_line(client, arg);
1369                 break;
1370
1371         case VIDIOC_INT_RESET:
1372                 v4l_dbg(1, debug, client, "decoder RESET\n");
1373                 saa711x_writeregs(client, saa7115_cfg_reset_scaler);
1374                 break;
1375
1376         case VIDIOC_INT_G_VBI_DATA:
1377         {
1378                 struct v4l2_sliced_vbi_data *data = arg;
1379
1380                 switch (data->id) {
1381                 case V4L2_SLICED_WSS_625:
1382                         if (saa711x_read(client, 0x6b) & 0xc0)
1383                                 return -EIO;
1384                         data->data[0] = saa711x_read(client, 0x6c);
1385                         data->data[1] = saa711x_read(client, 0x6d);
1386                         return 0;
1387                 case V4L2_SLICED_CAPTION_525:
1388                         if (data->field == 0) {
1389                                 /* CC */
1390                                 if (saa711x_read(client, 0x66) & 0xc0)
1391                                         return -EIO;
1392                                 data->data[0] = saa711x_read(client, 0x67);
1393                                 data->data[1] = saa711x_read(client, 0x68);
1394                                 return 0;
1395                         }
1396                         /* XDS */
1397                         if (saa711x_read(client, 0x66) & 0x30)
1398                                 return -EIO;
1399                         data->data[0] = saa711x_read(client, 0x69);
1400                         data->data[1] = saa711x_read(client, 0x6a);
1401                         return 0;
1402                 default:
1403                         return -EINVAL;
1404                 }
1405                 break;
1406         }
1407
1408 #ifdef CONFIG_VIDEO_ADV_DEBUG
1409         case VIDIOC_INT_G_REGISTER:
1410         {
1411                 struct v4l2_register *reg = arg;
1412
1413                 if (reg->i2c_id != I2C_DRIVERID_SAA711X)
1414                         return -EINVAL;
1415                 reg->val = saa711x_read(client, reg->reg & 0xff);
1416                 break;
1417         }
1418
1419         case VIDIOC_INT_S_REGISTER:
1420         {
1421                 struct v4l2_register *reg = arg;
1422
1423                 if (reg->i2c_id != I2C_DRIVERID_SAA711X)
1424                         return -EINVAL;
1425                 if (!capable(CAP_SYS_ADMIN))
1426                         return -EPERM;
1427                 saa711x_write(client, reg->reg & 0xff, reg->val & 0xff);
1428                 break;
1429         }
1430 #endif
1431
1432         case VIDIOC_INT_G_CHIP_IDENT:
1433                 *iarg = state->ident;
1434                 break;
1435
1436         default:
1437                 return -EINVAL;
1438         }
1439
1440         return 0;
1441 }
1442
1443 /* ----------------------------------------------------------------------- */
1444
1445 static struct i2c_driver i2c_driver_saa711x;
1446
1447 static int saa711x_attach(struct i2c_adapter *adapter, int address, int kind)
1448 {
1449         struct i2c_client *client;
1450         struct saa711x_state *state;
1451         int     i;
1452         char    name[17];
1453         u8 chip_id;
1454
1455         /* Check if the adapter supports the needed features */
1456         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1457                 return 0;
1458
1459         client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
1460         if (client == 0)
1461                 return -ENOMEM;
1462         client->addr = address;
1463         client->adapter = adapter;
1464         client->driver = &i2c_driver_saa711x;
1465         snprintf(client->name, sizeof(client->name) - 1, "saa7115");
1466
1467         for (i = 0; i < 0x0f; i++) {
1468                 saa711x_write(client, 0, i);
1469                 name[i] = (saa711x_read(client, 0) & 0x0f) + '0';
1470                 if (name[i] > '9')
1471                         name[i] += 'a' - '9' - 1;
1472         }
1473         name[i] = '\0';
1474
1475         saa711x_write(client, 0, 5);
1476         chip_id = saa711x_read(client, 0) & 0x0f;
1477
1478         /* Check whether this chip is part of the saa711x series */
1479         if (memcmp(name, "1f711", 5)) {
1480                 v4l_dbg(1, debug, client, "chip found @ 0x%x (ID %s) does not match a known saa711x chip.\n",
1481                         address << 1, name);
1482                 return 0;
1483         }
1484
1485         snprintf(client->name, sizeof(client->name) - 1, "saa711%d",chip_id);
1486         v4l_info(client, "saa711%d found (%s) @ 0x%x (%s)\n", chip_id, name, address << 1, adapter->name);
1487
1488         state = kzalloc(sizeof(struct saa711x_state), GFP_KERNEL);
1489         i2c_set_clientdata(client, state);
1490         if (state == NULL) {
1491                 kfree(client);
1492                 return -ENOMEM;
1493         }
1494         state->input = -1;
1495         state->enable = 1;
1496         state->radio = 0;
1497         state->bright = 128;
1498         state->contrast = 64;
1499         state->hue = 0;
1500         state->sat = 64;
1501         switch (chip_id) {
1502         case 1:
1503                 state->ident = V4L2_IDENT_SAA7111;
1504                 break;
1505         case 3:
1506                 state->ident = V4L2_IDENT_SAA7113;
1507                 break;
1508         case 4:
1509                 state->ident = V4L2_IDENT_SAA7114;
1510                 break;
1511         case 5:
1512                 state->ident = V4L2_IDENT_SAA7115;
1513                 break;
1514         case 8:
1515                 state->ident = V4L2_IDENT_SAA7118;
1516                 break;
1517         default:
1518                 state->ident = V4L2_IDENT_SAA7111;
1519                 v4l_info(client, "WARNING: Chip is not known - Falling back to saa7111\n");
1520
1521         }
1522
1523         state->audclk_freq = 48000;
1524
1525         v4l_dbg(1, debug, client, "writing init values\n");
1526
1527         /* init to 60hz/48khz */
1528         state->crystal_freq = SAA7115_FREQ_24_576_MHZ;
1529         switch (state->ident) {
1530         case V4L2_IDENT_SAA7111:
1531                 saa711x_writeregs(client, saa7111_init);
1532                 break;
1533         case V4L2_IDENT_SAA7113:
1534                 saa711x_writeregs(client, saa7113_init);
1535                 break;
1536         default:
1537                 state->crystal_freq = SAA7115_FREQ_32_11_MHZ;
1538                 saa711x_writeregs(client, saa7115_init_auto_input);
1539         }
1540         saa711x_writeregs(client, saa7115_init_misc);
1541         saa711x_set_v4lstd(client, V4L2_STD_NTSC);
1542
1543         i2c_attach_client(client);
1544
1545         v4l_dbg(1, debug, client, "status: (1E) 0x%02x, (1F) 0x%02x\n",
1546                 saa711x_read(client, R_1E_STATUS_BYTE_1_VD_DEC), saa711x_read(client, R_1F_STATUS_BYTE_2_VD_DEC));
1547
1548         return 0;
1549 }
1550
1551 static int saa711x_probe(struct i2c_adapter *adapter)
1552 {
1553         if (adapter->class & I2C_CLASS_TV_ANALOG)
1554                 return i2c_probe(adapter, &addr_data, &saa711x_attach);
1555         return 0;
1556 }
1557
1558 static int saa711x_detach(struct i2c_client *client)
1559 {
1560         struct saa711x_state *state = i2c_get_clientdata(client);
1561         int err;
1562
1563         err = i2c_detach_client(client);
1564         if (err) {
1565                 return err;
1566         }
1567
1568         kfree(state);
1569         kfree(client);
1570         return 0;
1571 }
1572
1573 /* ----------------------------------------------------------------------- */
1574
1575 /* i2c implementation */
1576 static struct i2c_driver i2c_driver_saa711x = {
1577         .driver = {
1578                 .name = "saa7115",
1579         },
1580         .id = I2C_DRIVERID_SAA711X,
1581         .attach_adapter = saa711x_probe,
1582         .detach_client = saa711x_detach,
1583         .command = saa711x_command,
1584 };
1585
1586
1587 static int __init saa711x_init_module(void)
1588 {
1589         return i2c_add_driver(&i2c_driver_saa711x);
1590 }
1591
1592 static void __exit saa711x_cleanup_module(void)
1593 {
1594         i2c_del_driver(&i2c_driver_saa711x);
1595 }
1596
1597 module_init(saa711x_init_module);
1598 module_exit(saa711x_cleanup_module);