drivers/media/dvb-frontends/au8522_decoder.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Auvitek AU8522 QAM/8VSB demodulator driver and video decoder
   4  *
   5  * Copyright (C) 2009 Devin Heitmueller <[email protected]>
   6  * Copyright (C) 2005-2008 Auvitek International, Ltd.
   7  */
   8
   9 /* Developer notes:
  10  *
  11  * Enough is implemented here for CVBS and S-Video inputs, but the actual
  12  *  analog demodulator code isn't implemented (not needed for xc5000 since it
  13  *  has its own demodulator and outputs CVBS)
  14  *
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <linux/slab.h>
  19 #include <linux/videodev2.h>
  20 #include <linux/i2c.h>
  21 #include <linux/delay.h>
  22 #include <media/v4l2-common.h>
  23 #include <media/v4l2-device.h>
  24 #include "au8522.h"
  25 #include "au8522_priv.h"
  26
  27 MODULE_AUTHOR("Devin Heitmueller");
  28 MODULE_DESCRIPTION("Auvitek AU8522 QAM/8VSB demodulator driver and video decoder");
  29 MODULE_LICENSE("GPL");
  30
  31 static int au8522_analog_debug;
  32
  33
  34 module_param_named(analog_debug, au8522_analog_debug, int, 0644);
  35
  36 MODULE_PARM_DESC(analog_debug,
  37                  "Analog debugging messages [0=Off (default) 1=On]");
  38
  39 struct au8522_register_config {
  40         u16 reg_name;
  41         u8 reg_val[8];
  42 };
  43
  44
  45 /* Video Decoder Filter Coefficients
  46    The values are as follows from left to right
  47    0="ATV RF" 1="ATV RF13" 2="CVBS" 3="S-Video" 4="PAL" 5=CVBS13" 6="SVideo13"
  48 */
  49 static const struct au8522_register_config filter_coef[] = {
  50         {AU8522_FILTER_COEF_R410, {0x25, 0x00, 0x25, 0x25, 0x00, 0x00, 0x00} },
  51         {AU8522_FILTER_COEF_R411, {0x20, 0x00, 0x20, 0x20, 0x00, 0x00, 0x00} },
  52         {AU8522_FILTER_COEF_R412, {0x03, 0x00, 0x03, 0x03, 0x00, 0x00, 0x00} },
  53         {AU8522_FILTER_COEF_R413, {0xe6, 0x00, 0xe6, 0xe6, 0x00, 0x00, 0x00} },
  54         {AU8522_FILTER_COEF_R414, {0x40, 0x00, 0x40, 0x40, 0x00, 0x00, 0x00} },
  55         {AU8522_FILTER_COEF_R415, {0x1b, 0x00, 0x1b, 0x1b, 0x00, 0x00, 0x00} },
  56         {AU8522_FILTER_COEF_R416, {0xc0, 0x00, 0xc0, 0x04, 0x00, 0x00, 0x00} },
  57         {AU8522_FILTER_COEF_R417, {0x04, 0x00, 0x04, 0x04, 0x00, 0x00, 0x00} },
  58         {AU8522_FILTER_COEF_R418, {0x8c, 0x00, 0x8c, 0x8c, 0x00, 0x00, 0x00} },
  59         {AU8522_FILTER_COEF_R419, {0xa0, 0x40, 0xa0, 0xa0, 0x40, 0x40, 0x40} },
  60         {AU8522_FILTER_COEF_R41A, {0x21, 0x09, 0x21, 0x21, 0x09, 0x09, 0x09} },
  61         {AU8522_FILTER_COEF_R41B, {0x6c, 0x38, 0x6c, 0x6c, 0x38, 0x38, 0x38} },
  62         {AU8522_FILTER_COEF_R41C, {0x03, 0xff, 0x03, 0x03, 0xff, 0xff, 0xff} },
  63         {AU8522_FILTER_COEF_R41D, {0xbf, 0xc7, 0xbf, 0xbf, 0xc7, 0xc7, 0xc7} },
  64         {AU8522_FILTER_COEF_R41E, {0xa0, 0xdf, 0xa0, 0xa0, 0xdf, 0xdf, 0xdf} },
  65         {AU8522_FILTER_COEF_R41F, {0x10, 0x06, 0x10, 0x10, 0x06, 0x06, 0x06} },
  66         {AU8522_FILTER_COEF_R420, {0xae, 0x30, 0xae, 0xae, 0x30, 0x30, 0x30} },
  67         {AU8522_FILTER_COEF_R421, {0xc4, 0x01, 0xc4, 0xc4, 0x01, 0x01, 0x01} },
  68         {AU8522_FILTER_COEF_R422, {0x54, 0xdd, 0x54, 0x54, 0xdd, 0xdd, 0xdd} },
  69         {AU8522_FILTER_COEF_R423, {0xd0, 0xaf, 0xd0, 0xd0, 0xaf, 0xaf, 0xaf} },
  70         {AU8522_FILTER_COEF_R424, {0x1c, 0xf7, 0x1c, 0x1c, 0xf7, 0xf7, 0xf7} },
  71         {AU8522_FILTER_COEF_R425, {0x76, 0xdb, 0x76, 0x76, 0xdb, 0xdb, 0xdb} },
  72         {AU8522_FILTER_COEF_R426, {0x61, 0xc0, 0x61, 0x61, 0xc0, 0xc0, 0xc0} },
  73         {AU8522_FILTER_COEF_R427, {0xd1, 0x2f, 0xd1, 0xd1, 0x2f, 0x2f, 0x2f} },
  74         {AU8522_FILTER_COEF_R428, {0x84, 0xd8, 0x84, 0x84, 0xd8, 0xd8, 0xd8} },
  75         {AU8522_FILTER_COEF_R429, {0x06, 0xfb, 0x06, 0x06, 0xfb, 0xfb, 0xfb} },
  76         {AU8522_FILTER_COEF_R42A, {0x21, 0xd5, 0x21, 0x21, 0xd5, 0xd5, 0xd5} },
  77         {AU8522_FILTER_COEF_R42B, {0x0a, 0x3e, 0x0a, 0x0a, 0x3e, 0x3e, 0x3e} },
  78         {AU8522_FILTER_COEF_R42C, {0xe6, 0x15, 0xe6, 0xe6, 0x15, 0x15, 0x15} },
  79         {AU8522_FILTER_COEF_R42D, {0x01, 0x34, 0x01, 0x01, 0x34, 0x34, 0x34} },
  80
  81 };
  82 #define NUM_FILTER_COEF (sizeof(filter_coef)\
  83                          / sizeof(struct au8522_register_config))
  84
  85
  86 /* Registers 0x060b through 0x0652 are the LP Filter coefficients
  87    The values are as follows from left to right
  88    0="SIF" 1="ATVRF/ATVRF13"
  89    Note: the "ATVRF/ATVRF13" mode has never been tested
  90 */
  91 static const struct au8522_register_config lpfilter_coef[] = {
  92         {0x060b, {0x21, 0x0b} },
  93         {0x060c, {0xad, 0xad} },
  94         {0x060d, {0x70, 0xf0} },
  95         {0x060e, {0xea, 0xe9} },
  96         {0x060f, {0xdd, 0xdd} },
  97         {0x0610, {0x08, 0x64} },
  98         {0x0611, {0x60, 0x60} },
  99         {0x0612, {0xf8, 0xb2} },
 100         {0x0613, {0x01, 0x02} },
 101         {0x0614, {0xe4, 0xb4} },
 102         {0x0615, {0x19, 0x02} },
 103         {0x0616, {0xae, 0x2e} },
 104         {0x0617, {0xee, 0xc5} },
 105         {0x0618, {0x56, 0x56} },
 106         {0x0619, {0x30, 0x58} },
 107         {0x061a, {0xf9, 0xf8} },
 108         {0x061b, {0x24, 0x64} },
 109         {0x061c, {0x07, 0x07} },
 110         {0x061d, {0x30, 0x30} },
 111         {0x061e, {0xa9, 0xed} },
 112         {0x061f, {0x09, 0x0b} },
 113         {0x0620, {0x42, 0xc2} },
 114         {0x0621, {0x1d, 0x2a} },
 115         {0x0622, {0xd6, 0x56} },
 116         {0x0623, {0x95, 0x8b} },
 117         {0x0624, {0x2b, 0x2b} },
 118         {0x0625, {0x30, 0x24} },
 119         {0x0626, {0x3e, 0x3e} },
 120         {0x0627, {0x62, 0xe2} },
 121         {0x0628, {0xe9, 0xf5} },
 122         {0x0629, {0x99, 0x19} },
 123         {0x062a, {0xd4, 0x11} },
 124         {0x062b, {0x03, 0x04} },
 125         {0x062c, {0xb5, 0x85} },
 126         {0x062d, {0x1e, 0x20} },
 127         {0x062e, {0x2a, 0xea} },
 128         {0x062f, {0xd7, 0xd2} },
 129         {0x0630, {0x15, 0x15} },
 130         {0x0631, {0xa3, 0xa9} },
 131         {0x0632, {0x1f, 0x1f} },
 132         {0x0633, {0xf9, 0xd1} },
 133         {0x0634, {0xc0, 0xc3} },
 134         {0x0635, {0x4d, 0x8d} },
 135         {0x0636, {0x21, 0x31} },
 136         {0x0637, {0x83, 0x83} },
 137         {0x0638, {0x08, 0x8c} },
 138         {0x0639, {0x19, 0x19} },
 139         {0x063a, {0x45, 0xa5} },
 140         {0x063b, {0xef, 0xec} },
 141         {0x063c, {0x8a, 0x8a} },
 142         {0x063d, {0xf4, 0xf6} },
 143         {0x063e, {0x8f, 0x8f} },
 144         {0x063f, {0x44, 0x0c} },
 145         {0x0640, {0xef, 0xf0} },
 146         {0x0641, {0x66, 0x66} },
 147         {0x0642, {0xcc, 0xd2} },
 148         {0x0643, {0x41, 0x41} },
 149         {0x0644, {0x63, 0x93} },
 150         {0x0645, {0x8e, 0x8e} },
 151         {0x0646, {0xa2, 0x42} },
 152         {0x0647, {0x7b, 0x7b} },
 153         {0x0648, {0x04, 0x04} },
 154         {0x0649, {0x00, 0x00} },
 155         {0x064a, {0x40, 0x40} },
 156         {0x064b, {0x8c, 0x98} },
 157         {0x064c, {0x00, 0x00} },
 158         {0x064d, {0x63, 0xc3} },
 159         {0x064e, {0x04, 0x04} },
 160         {0x064f, {0x20, 0x20} },
 161         {0x0650, {0x00, 0x00} },
 162         {0x0651, {0x40, 0x40} },
 163         {0x0652, {0x01, 0x01} },
 164 };
 165 #define NUM_LPFILTER_COEF (sizeof(lpfilter_coef)\
 166                            / sizeof(struct au8522_register_config))
 167
 168 static inline struct au8522_state *to_state(struct v4l2_subdev *sd)
 169 {
 170         return container_of(sd, struct au8522_state, sd);
 171 }
 172
 173 static void setup_decoder_defaults(struct au8522_state *state, bool is_svideo)
 174 {
 175         int i;
 176         int filter_coef_type;
 177
 178         /* Provide reasonable defaults for picture tuning values */
 179         au8522_writereg(state, AU8522_TVDEC_SHARPNESSREG009H, 0x07);
 180         au8522_writereg(state, AU8522_TVDEC_BRIGHTNESS_REG00AH, 0xed);
 181         au8522_writereg(state, AU8522_TVDEC_CONTRAST_REG00BH, 0x79);
 182         au8522_writereg(state, AU8522_TVDEC_SATURATION_CB_REG00CH, 0x80);
 183         au8522_writereg(state, AU8522_TVDEC_SATURATION_CR_REG00DH, 0x80);
 184         au8522_writereg(state, AU8522_TVDEC_HUE_H_REG00EH, 0x00);
 185         au8522_writereg(state, AU8522_TVDEC_HUE_L_REG00FH, 0x00);
 186
 187         /* Other decoder registers */
 188         au8522_writereg(state, AU8522_TVDEC_INT_MASK_REG010H, 0x00);
 189
 190         if (is_svideo)
 191                 au8522_writereg(state, AU8522_VIDEO_MODE_REG011H, 0x04);
 192         else
 193                 au8522_writereg(state, AU8522_VIDEO_MODE_REG011H, 0x00);
 194
 195         au8522_writereg(state, AU8522_TVDEC_PGA_REG012H,
 196                         AU8522_TVDEC_PGA_REG012H_CVBS);
 197         au8522_writereg(state, AU8522_TVDEC_COMB_MODE_REG015H,
 198                         AU8522_TVDEC_COMB_MODE_REG015H_CVBS);
 199         au8522_writereg(state, AU8522_TVDED_DBG_MODE_REG060H,
 200                         AU8522_TVDED_DBG_MODE_REG060H_CVBS);
 201
 202         if (state->std == V4L2_STD_PAL_M) {
 203                 au8522_writereg(state, AU8522_TVDEC_FORMAT_CTRL1_REG061H,
 204                                 AU8522_TVDEC_FORMAT_CTRL1_REG061H_FIELD_LEN_525 |
 205                                 AU8522_TVDEC_FORMAT_CTRL1_REG061H_LINE_LEN_63_492 |
 206                                 AU8522_TVDEC_FORMAT_CTRL1_REG061H_SUBCARRIER_NTSC_AUTO);
 207                 au8522_writereg(state, AU8522_TVDEC_FORMAT_CTRL2_REG062H,
 208                                 AU8522_TVDEC_FORMAT_CTRL2_REG062H_STD_PAL_M);
 209         } else {
 210                 /* NTSC */
 211                 au8522_writereg(state, AU8522_TVDEC_FORMAT_CTRL1_REG061H,
 212                                 AU8522_TVDEC_FORMAT_CTRL1_REG061H_FIELD_LEN_525 |
 213                                 AU8522_TVDEC_FORMAT_CTRL1_REG061H_LINE_LEN_63_492 |
 214                                 AU8522_TVDEC_FORMAT_CTRL1_REG061H_SUBCARRIER_NTSC_MN);
 215                 au8522_writereg(state, AU8522_TVDEC_FORMAT_CTRL2_REG062H,
 216                                 AU8522_TVDEC_FORMAT_CTRL2_REG062H_STD_NTSC);
 217         }
 218         au8522_writereg(state, AU8522_TVDEC_VCR_DET_LLIM_REG063H,
 219                         AU8522_TVDEC_VCR_DET_LLIM_REG063H_CVBS);
 220         au8522_writereg(state, AU8522_TVDEC_VCR_DET_HLIM_REG064H,
 221                         AU8522_TVDEC_VCR_DET_HLIM_REG064H_CVBS);
 222         au8522_writereg(state, AU8522_TVDEC_COMB_VDIF_THR1_REG065H,
 223                         AU8522_TVDEC_COMB_VDIF_THR1_REG065H_CVBS);
 224         au8522_writereg(state, AU8522_TVDEC_COMB_VDIF_THR2_REG066H,
 225                         AU8522_TVDEC_COMB_VDIF_THR2_REG066H_CVBS);
 226         au8522_writereg(state, AU8522_TVDEC_COMB_VDIF_THR3_REG067H,
 227                         AU8522_TVDEC_COMB_VDIF_THR3_REG067H_CVBS);
 228         au8522_writereg(state, AU8522_TVDEC_COMB_NOTCH_THR_REG068H,
 229                         AU8522_TVDEC_COMB_NOTCH_THR_REG068H_CVBS);
 230         au8522_writereg(state, AU8522_TVDEC_COMB_HDIF_THR1_REG069H,
 231                         AU8522_TVDEC_COMB_HDIF_THR1_REG069H_CVBS);
 232         au8522_writereg(state, AU8522_TVDEC_COMB_HDIF_THR2_REG06AH,
 233                         AU8522_TVDEC_COMB_HDIF_THR2_REG06AH_CVBS);
 234         au8522_writereg(state, AU8522_TVDEC_COMB_HDIF_THR3_REG06BH,
 235                         AU8522_TVDEC_COMB_HDIF_THR3_REG06BH_CVBS);
 236         if (is_svideo) {
 237                 au8522_writereg(state, AU8522_TVDEC_COMB_DCDIF_THR1_REG06CH,
 238                                 AU8522_TVDEC_COMB_DCDIF_THR1_REG06CH_SVIDEO);
 239                 au8522_writereg(state, AU8522_TVDEC_COMB_DCDIF_THR2_REG06DH,
 240                                 AU8522_TVDEC_COMB_DCDIF_THR2_REG06DH_SVIDEO);
 241         } else {
 242                 au8522_writereg(state, AU8522_TVDEC_COMB_DCDIF_THR1_REG06CH,
 243                                 AU8522_TVDEC_COMB_DCDIF_THR1_REG06CH_CVBS);
 244                 au8522_writereg(state, AU8522_TVDEC_COMB_DCDIF_THR2_REG06DH,
 245                                 AU8522_TVDEC_COMB_DCDIF_THR2_REG06DH_CVBS);
 246         }
 247         au8522_writereg(state, AU8522_TVDEC_COMB_DCDIF_THR3_REG06EH,
 248                         AU8522_TVDEC_COMB_DCDIF_THR3_REG06EH_CVBS);
 249         au8522_writereg(state, AU8522_TVDEC_UV_SEP_THR_REG06FH,
 250                         AU8522_TVDEC_UV_SEP_THR_REG06FH_CVBS);
 251         au8522_writereg(state, AU8522_TVDEC_COMB_DC_THR1_NTSC_REG070H,
 252                         AU8522_TVDEC_COMB_DC_THR1_NTSC_REG070H_CVBS);
 253         au8522_writereg(state, AU8522_REG071H, AU8522_REG071H_CVBS);
 254         au8522_writereg(state, AU8522_REG072H, AU8522_REG072H_CVBS);
 255         au8522_writereg(state, AU8522_TVDEC_COMB_DC_THR2_NTSC_REG073H,
 256                         AU8522_TVDEC_COMB_DC_THR2_NTSC_REG073H_CVBS);
 257         au8522_writereg(state, AU8522_REG074H, AU8522_REG074H_CVBS);
 258         au8522_writereg(state, AU8522_REG075H, AU8522_REG075H_CVBS);
 259         au8522_writereg(state, AU8522_TVDEC_DCAGC_CTRL_REG077H,
 260                         AU8522_TVDEC_DCAGC_CTRL_REG077H_CVBS);
 261         au8522_writereg(state, AU8522_TVDEC_PIC_START_ADJ_REG078H,
 262                         AU8522_TVDEC_PIC_START_ADJ_REG078H_CVBS);
 263         au8522_writereg(state, AU8522_TVDEC_AGC_HIGH_LIMIT_REG079H,
 264                         AU8522_TVDEC_AGC_HIGH_LIMIT_REG079H_CVBS);
 265         au8522_writereg(state, AU8522_TVDEC_MACROVISION_SYNC_THR_REG07AH,
 266                         AU8522_TVDEC_MACROVISION_SYNC_THR_REG07AH_CVBS);
 267         au8522_writereg(state, AU8522_TVDEC_INTRP_CTRL_REG07BH,
 268                         AU8522_TVDEC_INTRP_CTRL_REG07BH_CVBS);
 269         au8522_writereg(state, AU8522_TVDEC_AGC_LOW_LIMIT_REG0E4H,
 270                         AU8522_TVDEC_AGC_LOW_LIMIT_REG0E4H_CVBS);
 271         au8522_writereg(state, AU8522_TOREGAAGC_REG0E5H,
 272                         AU8522_TOREGAAGC_REG0E5H_CVBS);
 273         au8522_writereg(state, AU8522_REG016H, AU8522_REG016H_CVBS);
 274
 275         /*
 276          * Despite what the table says, for the HVR-950q we still need
 277          * to be in CVBS mode for the S-Video input (reason unknown).
 278          */
 279         /* filter_coef_type = 3; */
 280         filter_coef_type = 5;
 281
 282         /* Load the Video Decoder Filter Coefficients */
 283         for (i = 0; i < NUM_FILTER_COEF; i++) {
 284                 au8522_writereg(state, filter_coef[i].reg_name,
 285                                 filter_coef[i].reg_val[filter_coef_type]);
 286         }
 287
 288         /* It's not clear what these registers are for, but they are always
 289            set to the same value regardless of what mode we're in */
 290         au8522_writereg(state, AU8522_REG42EH, 0x87);
 291         au8522_writereg(state, AU8522_REG42FH, 0xa2);
 292         au8522_writereg(state, AU8522_REG430H, 0xbf);
 293         au8522_writereg(state, AU8522_REG431H, 0xcb);
 294         au8522_writereg(state, AU8522_REG432H, 0xa1);
 295         au8522_writereg(state, AU8522_REG433H, 0x41);
 296         au8522_writereg(state, AU8522_REG434H, 0x88);
 297         au8522_writereg(state, AU8522_REG435H, 0xc2);
 298         au8522_writereg(state, AU8522_REG436H, 0x3c);
 299 }
 300
 301 static void au8522_setup_cvbs_mode(struct au8522_state *state, u8 input_mode)
 302 {
 303         /* here we're going to try the pre-programmed route */
 304         au8522_writereg(state, AU8522_MODULE_CLOCK_CONTROL_REG0A3H,
 305                         AU8522_MODULE_CLOCK_CONTROL_REG0A3H_CVBS);
 306
 307         /* PGA in automatic mode */
 308         au8522_writereg(state, AU8522_PGA_CONTROL_REG082H, 0x00);
 309
 310         /* Enable clamping control */
 311         au8522_writereg(state, AU8522_CLAMPING_CONTROL_REG083H, 0x00);
 312
 313         au8522_writereg(state, AU8522_INPUT_CONTROL_REG081H, input_mode);
 314
 315         setup_decoder_defaults(state, false);
 316
 317         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H,
 318                         AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H_CVBS);
 319 }
 320
 321 static void au8522_setup_cvbs_tuner_mode(struct au8522_state *state,
 322                                          u8 input_mode)
 323 {
 324         /* here we're going to try the pre-programmed route */
 325         au8522_writereg(state, AU8522_MODULE_CLOCK_CONTROL_REG0A3H,
 326                         AU8522_MODULE_CLOCK_CONTROL_REG0A3H_CVBS);
 327
 328         /* It's not clear why we have to have the PGA in automatic mode while
 329            enabling clamp control, but it's what Windows does */
 330         au8522_writereg(state, AU8522_PGA_CONTROL_REG082H, 0x00);
 331
 332         /* Enable clamping control */
 333         au8522_writereg(state, AU8522_CLAMPING_CONTROL_REG083H, 0x0e);
 334
 335         /* Disable automatic PGA (since the CVBS is coming from the tuner) */
 336         au8522_writereg(state, AU8522_PGA_CONTROL_REG082H, 0x10);
 337
 338         /* Set input mode to CVBS on channel 4 with SIF audio input enabled */
 339         au8522_writereg(state, AU8522_INPUT_CONTROL_REG081H, input_mode);
 340
 341         setup_decoder_defaults(state, false);
 342
 343         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H,
 344                         AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H_CVBS);
 345 }
 346
 347 static void au8522_setup_svideo_mode(struct au8522_state *state,
 348                                      u8 input_mode)
 349 {
 350         au8522_writereg(state, AU8522_MODULE_CLOCK_CONTROL_REG0A3H,
 351                         AU8522_MODULE_CLOCK_CONTROL_REG0A3H_SVIDEO);
 352
 353         /* Set input to Y on Channe1, C on Channel 3 */
 354         au8522_writereg(state, AU8522_INPUT_CONTROL_REG081H, input_mode);
 355
 356         /* PGA in automatic mode */
 357         au8522_writereg(state, AU8522_PGA_CONTROL_REG082H, 0x00);
 358
 359         /* Enable clamping control */
 360         au8522_writereg(state, AU8522_CLAMPING_CONTROL_REG083H, 0x00);
 361
 362         setup_decoder_defaults(state, true);
 363
 364         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H,
 365                         AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H_CVBS);
 366 }
 367
 368 /* ----------------------------------------------------------------------- */
 369
 370 static void disable_audio_input(struct au8522_state *state)
 371 {
 372         au8522_writereg(state, AU8522_AUDIO_VOLUME_L_REG0F2H, 0x00);
 373         au8522_writereg(state, AU8522_AUDIO_VOLUME_R_REG0F3H, 0x00);
 374         au8522_writereg(state, AU8522_AUDIO_VOLUME_REG0F4H, 0x00);
 375
 376         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_1_REG0A5H, 0x04);
 377         au8522_writereg(state, AU8522_I2S_CTRL_2_REG112H, 0x02);
 378
 379         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H,
 380                         AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H_SVIDEO);
 381 }
 382
 383 /* 0=disable, 1=SIF */
 384 static void set_audio_input(struct au8522_state *state)
 385 {
 386         int aud_input = state->aud_input;
 387         int i;
 388
 389         /* Note that this function needs to be used in conjunction with setting
 390            the input routing via register 0x81 */
 391
 392         if (aud_input == AU8522_AUDIO_NONE) {
 393                 disable_audio_input(state);
 394                 return;
 395         }
 396
 397         if (aud_input != AU8522_AUDIO_SIF) {
 398                 /* The caller asked for a mode we don't currently support */
 399                 printk(KERN_ERR "Unsupported audio mode requested! mode=%d\n",
 400                        aud_input);
 401                 return;
 402         }
 403
 404         /* Load the Audio Decoder Filter Coefficients */
 405         for (i = 0; i < NUM_LPFILTER_COEF; i++) {
 406                 au8522_writereg(state, lpfilter_coef[i].reg_name,
 407                                 lpfilter_coef[i].reg_val[0]);
 408         }
 409
 410         /* Set the volume */
 411         au8522_writereg(state, AU8522_AUDIO_VOLUME_L_REG0F2H, 0x7F);
 412         au8522_writereg(state, AU8522_AUDIO_VOLUME_R_REG0F3H, 0x7F);
 413         au8522_writereg(state, AU8522_AUDIO_VOLUME_REG0F4H, 0xff);
 414
 415         /* Not sure what this does */
 416         au8522_writereg(state, AU8522_REG0F9H, AU8522_REG0F9H_AUDIO);
 417
 418         /* Setup the audio mode to stereo DBX */
 419         au8522_writereg(state, AU8522_AUDIO_MODE_REG0F1H, 0x82);
 420         msleep(70);
 421
 422         /* Start the audio processing module */
 423         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H, 0x9d);
 424
 425         /* Set the audio frequency to 48 KHz */
 426         au8522_writereg(state, AU8522_AUDIOFREQ_REG606H, 0x03);
 427
 428         /* Set the I2S parameters (WS, LSB, mode, sample rate */
 429         au8522_writereg(state, AU8522_I2S_CTRL_2_REG112H, 0xc2);
 430
 431         /* Enable the I2S output */
 432         au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_1_REG0A5H, 0x09);
 433 }
 434
 435 /* ----------------------------------------------------------------------- */
 436
 437 static int au8522_s_ctrl(struct v4l2_ctrl *ctrl)
 438 {
 439         struct au8522_state *state =
 440                 container_of(ctrl->handler, struct au8522_state, hdl);
 441
 442         switch (ctrl->id) {
 443         case V4L2_CID_BRIGHTNESS:
 444                 au8522_writereg(state, AU8522_TVDEC_BRIGHTNESS_REG00AH,
 445                                 ctrl->val - 128);
 446                 break;
 447         case V4L2_CID_CONTRAST:
 448                 au8522_writereg(state, AU8522_TVDEC_CONTRAST_REG00BH,
 449                                 ctrl->val);
 450                 break;
 451         case V4L2_CID_SATURATION:
 452                 au8522_writereg(state, AU8522_TVDEC_SATURATION_CB_REG00CH,
 453                                 ctrl->val);
 454                 au8522_writereg(state, AU8522_TVDEC_SATURATION_CR_REG00DH,
 455                                 ctrl->val);
 456                 break;
 457         case V4L2_CID_HUE:
 458                 au8522_writereg(state, AU8522_TVDEC_HUE_H_REG00EH,
 459                                 ctrl->val >> 8);
 460                 au8522_writereg(state, AU8522_TVDEC_HUE_L_REG00FH,
 461                                 ctrl->val & 0xFF);
 462                 break;
 463         default:
 464                 return -EINVAL;
 465         }
 466
 467         return 0;
 468 }
 469
 470 /* ----------------------------------------------------------------------- */
 471
 472 #ifdef CONFIG_VIDEO_ADV_DEBUG
 473 static int au8522_g_register(struct v4l2_subdev *sd,
 474                              struct v4l2_dbg_register *reg)
 475 {
 476         struct au8522_state *state = to_state(sd);
 477
 478         reg->val = au8522_readreg(state, reg->reg & 0xffff);
 479         return 0;
 480 }
 481
 482 static int au8522_s_register(struct v4l2_subdev *sd,
 483                              const struct v4l2_dbg_register *reg)
 484 {
 485         struct au8522_state *state = to_state(sd);
 486
 487         au8522_writereg(state, reg->reg, reg->val & 0xff);
 488         return 0;
 489 }
 490 #endif
 491
 492 static void au8522_video_set(struct au8522_state *state)
 493 {
 494         u8 input_mode;
 495
 496         au8522_writereg(state, 0xa4, 1 << 5);
 497
 498         switch (state->vid_input) {
 499         case AU8522_COMPOSITE_CH1:
 500                 input_mode = AU8522_INPUT_CONTROL_REG081H_CVBS_CH1;
 501                 au8522_setup_cvbs_mode(state, input_mode);
 502                 break;
 503         case AU8522_COMPOSITE_CH2:
 504                 input_mode = AU8522_INPUT_CONTROL_REG081H_CVBS_CH2;
 505                 au8522_setup_cvbs_mode(state, input_mode);
 506                 break;
 507         case AU8522_COMPOSITE_CH3:
 508                 input_mode = AU8522_INPUT_CONTROL_REG081H_CVBS_CH3;
 509                 au8522_setup_cvbs_mode(state, input_mode);
 510                 break;
 511         case AU8522_COMPOSITE_CH4:
 512                 input_mode = AU8522_INPUT_CONTROL_REG081H_CVBS_CH4;
 513                 au8522_setup_cvbs_mode(state, input_mode);
 514                 break;
 515         case AU8522_SVIDEO_CH13:
 516                 input_mode = AU8522_INPUT_CONTROL_REG081H_SVIDEO_CH13;
 517                 au8522_setup_svideo_mode(state, input_mode);
 518                 break;
 519         case AU8522_SVIDEO_CH24:
 520                 input_mode = AU8522_INPUT_CONTROL_REG081H_SVIDEO_CH24;
 521                 au8522_setup_svideo_mode(state, input_mode);
 522                 break;
 523         default:
 524         case AU8522_COMPOSITE_CH4_SIF:
 525                 input_mode = AU8522_INPUT_CONTROL_REG081H_CVBS_CH4_SIF;
 526                 au8522_setup_cvbs_tuner_mode(state, input_mode);
 527                 break;
 528         }
 529 }
 530
 531 static int au8522_s_stream(struct v4l2_subdev *sd, int enable)
 532 {
 533         struct au8522_state *state = to_state(sd);
 534
 535         if (enable) {
 536                 /*
 537                  * Clear out any state associated with the digital side of the
 538                  * chip, so that when it gets powered back up it won't think
 539                  * that it is already tuned
 540                  */
 541                 state->current_frequency = 0;
 542
 543                 au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H,
 544                                 0x01);
 545                 msleep(10);
 546
 547                 au8522_video_set(state);
 548                 set_audio_input(state);
 549
 550                 state->operational_mode = AU8522_ANALOG_MODE;
 551         } else {
 552                 /* This does not completely power down the device
 553                    (it only reduces it from around 140ma to 80ma) */
 554                 au8522_writereg(state, AU8522_SYSTEM_MODULE_CONTROL_0_REG0A4H,
 555                                 1 << 5);
 556                 state->operational_mode = AU8522_SUSPEND_MODE;
 557         }
 558         return 0;
 559 }
 560
 561 static int au8522_s_video_routing(struct v4l2_subdev *sd,
 562                                         u32 input, u32 output, u32 config)
 563 {
 564         struct au8522_state *state = to_state(sd);
 565
 566         switch (input) {
 567         case AU8522_COMPOSITE_CH1:
 568         case AU8522_SVIDEO_CH13:
 569         case AU8522_COMPOSITE_CH4_SIF:
 570                 state->vid_input = input;
 571                 break;
 572         default:
 573                 printk(KERN_ERR "au8522 mode not currently supported\n");
 574                 return -EINVAL;
 575         }
 576
 577         if (state->operational_mode == AU8522_ANALOG_MODE)
 578                 au8522_video_set(state);
 579
 580         return 0;
 581 }
 582
 583 static int au8522_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
 584 {
 585         struct au8522_state *state = to_state(sd);
 586
 587         if ((std & (V4L2_STD_PAL_M | V4L2_STD_NTSC_M)) == 0)
 588                 return -EINVAL;
 589
 590         state->std = std;
 591
 592         if (state->operational_mode == AU8522_ANALOG_MODE)
 593                 au8522_video_set(state);
 594
 595         return 0;
 596 }
 597
 598 static int au8522_s_audio_routing(struct v4l2_subdev *sd,
 599                                         u32 input, u32 output, u32 config)
 600 {
 601         struct au8522_state *state = to_state(sd);
 602
 603         state->aud_input = input;
 604
 605         if (state->operational_mode == AU8522_ANALOG_MODE)
 606                 set_audio_input(state);
 607
 608         return 0;
 609 }
 610
 611 static int au8522_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
 612 {
 613         int val = 0;
 614         struct au8522_state *state = to_state(sd);
 615         u8 lock_status;
 616         u8 pll_status;
 617
 618         /* Interrogate the decoder to see if we are getting a real signal */
 619         lock_status = au8522_readreg(state, 0x00);
 620         pll_status = au8522_readreg(state, 0x7e);
 621         if ((lock_status == 0xa2) && (pll_status & 0x10))
 622                 vt->signal = 0xffff;
 623         else
 624                 vt->signal = 0x00;
 625
 626         vt->capability |=
 627                 V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LANG1 |
 628                 V4L2_TUNER_CAP_LANG2 | V4L2_TUNER_CAP_SAP;
 629
 630         val = V4L2_TUNER_SUB_MONO;
 631         vt->rxsubchans = val;
 632         vt->audmode = V4L2_TUNER_MODE_STEREO;
 633         return 0;
 634 }
 635
 636 /* ----------------------------------------------------------------------- */
 637
 638 static const struct v4l2_subdev_core_ops au8522_core_ops = {
 639         .log_status = v4l2_ctrl_subdev_log_status,
 640 #ifdef CONFIG_VIDEO_ADV_DEBUG
 641         .g_register = au8522_g_register,
 642         .s_register = au8522_s_register,
 643 #endif
 644 };
 645
 646 static const struct v4l2_subdev_tuner_ops au8522_tuner_ops = {
 647         .g_tuner = au8522_g_tuner,
 648 };
 649
 650 static const struct v4l2_subdev_audio_ops au8522_audio_ops = {
 651         .s_routing = au8522_s_audio_routing,
 652 };
 653
 654 static const struct v4l2_subdev_video_ops au8522_video_ops = {
 655         .s_routing = au8522_s_video_routing,
 656         .s_stream = au8522_s_stream,
 657         .s_std = au8522_s_std,
 658 };
 659
 660 static const struct v4l2_subdev_ops au8522_ops = {
 661         .core = &au8522_core_ops,
 662         .tuner = &au8522_tuner_ops,
 663         .audio = &au8522_audio_ops,
 664         .video = &au8522_video_ops,
 665 };
 666
 667 static const struct v4l2_ctrl_ops au8522_ctrl_ops = {
 668         .s_ctrl = au8522_s_ctrl,
 669 };
 670
 671 /* ----------------------------------------------------------------------- */
 672
 673 static int au8522_probe(struct i2c_client *client)
 674 {
 675         struct au8522_state *state;
 676         struct v4l2_ctrl_handler *hdl;
 677         struct v4l2_subdev *sd;
 678         int instance;
 679 #ifdef CONFIG_MEDIA_CONTROLLER
 680         int ret;
 681 #endif
 682
 683         /* Check if the adapter supports the needed features */
 684         if (!i2c_check_functionality(client->adapter,
 685                                      I2C_FUNC_SMBUS_BYTE_DATA)) {
 686                 return -EIO;
 687         }
 688
 689         /* allocate memory for the internal state */
 690         instance = au8522_get_state(&state, client->adapter, client->addr);
 691         switch (instance) {
 692         case 0:
 693                 printk(KERN_ERR "au8522_decoder allocation failed\n");
 694                 return -EIO;
 695         case 1:
 696                 /* new demod instance */
 697                 printk(KERN_INFO "au8522_decoder creating new instance...\n");
 698                 break;
 699         default:
 700                 /* existing demod instance */
 701                 printk(KERN_INFO "au8522_decoder attach existing instance.\n");
 702                 break;
 703         }
 704
 705         state->config.demod_address = 0x8e >> 1;
 706         state->i2c = client->adapter;
 707
 708         sd = &state->sd;
 709         v4l2_i2c_subdev_init(sd, client, &au8522_ops);
 710 #if defined(CONFIG_MEDIA_CONTROLLER)
 711
 712         state->pads[AU8522_PAD_IF_INPUT].flags = MEDIA_PAD_FL_SINK;
 713         state->pads[AU8522_PAD_IF_INPUT].sig_type = PAD_SIGNAL_ANALOG;
 714         state->pads[AU8522_PAD_VID_OUT].flags = MEDIA_PAD_FL_SOURCE;
 715         state->pads[AU8522_PAD_VID_OUT].sig_type = PAD_SIGNAL_DV;
 716         state->pads[AU8522_PAD_AUDIO_OUT].flags = MEDIA_PAD_FL_SOURCE;
 717         state->pads[AU8522_PAD_AUDIO_OUT].sig_type = PAD_SIGNAL_AUDIO;
 718         sd->entity.function = MEDIA_ENT_F_ATV_DECODER;
 719
 720         ret = media_entity_pads_init(&sd->entity, ARRAY_SIZE(state->pads),
 721                                 state->pads);
 722         if (ret < 0) {
 723                 v4l_info(client, "failed to initialize media entity!\n");
 724                 return ret;
 725         }
 726 #endif
 727
 728         hdl = &state->hdl;
 729         v4l2_ctrl_handler_init(hdl, 4);
 730         v4l2_ctrl_new_std(hdl, &au8522_ctrl_ops,
 731                         V4L2_CID_BRIGHTNESS, 0, 255, 1, 109);
 732         v4l2_ctrl_new_std(hdl, &au8522_ctrl_ops,
 733                         V4L2_CID_CONTRAST, 0, 255, 1,
 734                         AU8522_TVDEC_CONTRAST_REG00BH_CVBS);
 735         v4l2_ctrl_new_std(hdl, &au8522_ctrl_ops,
 736                         V4L2_CID_SATURATION, 0, 255, 1, 128);
 737         v4l2_ctrl_new_std(hdl, &au8522_ctrl_ops,
 738                         V4L2_CID_HUE, -32768, 32767, 1, 0);
 739         sd->ctrl_handler = hdl;
 740         if (hdl->error) {
 741                 int err = hdl->error;
 742
 743                 v4l2_ctrl_handler_free(hdl);
 744                 au8522_release_state(state);
 745                 return err;
 746         }
 747
 748         state->c = client;
 749         state->std = V4L2_STD_NTSC_M;
 750         state->vid_input = AU8522_COMPOSITE_CH1;
 751         state->aud_input = AU8522_AUDIO_NONE;
 752         state->id = 8522;
 753         state->rev = 0;
 754
 755         /* Jam open the i2c gate to the tuner */
 756         au8522_writereg(state, 0x106, 1);
 757
 758         return 0;
 759 }
 760
 761 static void au8522_remove(struct i2c_client *client)
 762 {
 763         struct v4l2_subdev *sd = i2c_get_clientdata(client);
 764         v4l2_device_unregister_subdev(sd);
 765         v4l2_ctrl_handler_free(sd->ctrl_handler);
 766         au8522_release_state(to_state(sd));
 767 }
 768
 769 static const struct i2c_device_id au8522_id[] = {
 770         {"au8522", 0},
 771         {}
 772 };
 773
 774 MODULE_DEVICE_TABLE(i2c, au8522_id);
 775
 776 static struct i2c_driver au8522_driver = {
 777         .driver = {
 778                 .name   = "au8522",
 779         },
 780         .probe          = au8522_probe,
 781         .remove         = au8522_remove,
 782         .id_table       = au8522_id,
 783 };
 784
 785 module_i2c_driver(au8522_driver);