drivers/media/video/tm6000/tm6000-stds.c

   1 /*
   2  *  tm6000-stds.c - driver for TM5600/TM6000/TM6010 USB video capture devices
   3  *
   4  *  Copyright (C) 2007 Mauro Carvalho Chehab <mchehab@redhat.com>
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation version 2
   9  *
  10  *  This program is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with this program; if not, write to the Free Software
  17  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18  */
  19
  20 #include <linux/module.h>
  21 #include <linux/kernel.h>
  22 #include "tm6000.h"
  23 #include "tm6000-regs.h"
  24
  25 static unsigned int tm6010_a_mode;
  26 module_param(tm6010_a_mode, int, 0644);
  27 MODULE_PARM_DESC(tm6010_a_mode, "set tm6010 sif audio mode");
  28
  29 struct tm6000_reg_settings {
  30         unsigned char req;
  31         unsigned char reg;
  32         unsigned char value;
  33 };
  34
  35
  36 struct tm6000_std_settings {
  37         v4l2_std_id id;
  38         struct tm6000_reg_settings *common;
  39 };
  40
  41 static struct tm6000_reg_settings composite_pal_m[] = {
  42         { TM6010_REQ07_R3F_RESET, 0x01 },
  43         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x04 },
  44         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  45         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  46         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
  47         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  48         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  49         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x83 },
  50         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x0a },
  51         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe0 },
  52         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  53         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  54         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  55         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  56         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
  57         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x20 },
  58         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
  59         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  60         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  61         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  62         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  63         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  64         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  65         { TM6010_REQ07_R3F_RESET, 0x00 },
  66         { 0, 0, 0 }
  67 };
  68
  69 static struct tm6000_reg_settings composite_pal_nc[] = {
  70         { TM6010_REQ07_R3F_RESET, 0x01 },
  71         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x36 },
  72         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  73         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  74         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x02 },
  75         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  76         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  77         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x91 },
  78         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x1f },
  79         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x0c },
  80         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  81         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  82         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  83         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  84         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
  85         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2c },
  86         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  87         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  88         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  89         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  90         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  91         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  92         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  93         { TM6010_REQ07_R3F_RESET, 0x00 },
  94         { 0, 0, 0 }
  95 };
  96
  97 static struct tm6000_reg_settings composite_pal[] = {
  98         { TM6010_REQ07_R3F_RESET, 0x01 },
  99         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x32 },
 100         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
 101         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 102         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x02 },
 103         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
 104         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x25 },
 105         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0xd5 },
 106         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x63 },
 107         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x50 },
 108         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 109         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 110         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 111         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 112         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
 113         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2c },
 114         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
 115         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
 116         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 117         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
 118         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
 119         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
 120         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 121         { TM6010_REQ07_R3F_RESET, 0x00 },
 122         { 0, 0, 0 }
 123 };
 124
 125 static struct tm6000_reg_settings composite_secam[] = {
 126         { TM6010_REQ07_R3F_RESET, 0x01 },
 127         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x38 },
 128         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
 129         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 130         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x02 },
 131         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
 132         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x24 },
 133         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x92 },
 134         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xe8 },
 135         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xed },
 136         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 137         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 138         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 139         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 140         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
 141         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2c },
 142         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
 143         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x2c },
 144         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x18 },
 145         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
 146         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0xff },
 147         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 148         { TM6010_REQ07_R3F_RESET, 0x00 },
 149         { 0, 0, 0 }
 150 };
 151
 152 static struct tm6000_reg_settings composite_ntsc[] = {
 153         { TM6010_REQ07_R3F_RESET, 0x01 },
 154         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
 155         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0f },
 156         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 157         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
 158         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
 159         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
 160         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
 161         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
 162         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
 163         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 164         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 165         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 166         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 167         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
 168         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
 169         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
 170         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
 171         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 172         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
 173         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
 174         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdd },
 175         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 176         { TM6010_REQ07_R3F_RESET, 0x00 },
 177         { 0, 0, 0 }
 178 };
 179
 180 static struct tm6000_std_settings composite_stds[] = {
 181         { .id = V4L2_STD_PAL_M, .common = composite_pal_m, },
 182         { .id = V4L2_STD_PAL_Nc, .common = composite_pal_nc, },
 183         { .id = V4L2_STD_PAL, .common = composite_pal, },
 184         { .id = V4L2_STD_SECAM, .common = composite_secam, },
 185         { .id = V4L2_STD_NTSC, .common = composite_ntsc, },
 186 };
 187
 188 static struct tm6000_reg_settings svideo_pal_m[] = {
 189         { TM6010_REQ07_R3F_RESET, 0x01 },
 190         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x05 },
 191         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
 192         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 193         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x04 },
 194         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
 195         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
 196         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x83 },
 197         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x0a },
 198         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe0 },
 199         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 200         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 201         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 202         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 203         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
 204         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
 205         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
 206         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
 207         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 208         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
 209         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
 210         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
 211         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 212         { TM6010_REQ07_R3F_RESET, 0x00 },
 213         { 0, 0, 0 }
 214 };
 215
 216 static struct tm6000_reg_settings svideo_pal_nc[] = {
 217         { TM6010_REQ07_R3F_RESET, 0x01 },
 218         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x37 },
 219         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
 220         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 221         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x04 },
 222         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
 223         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
 224         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x91 },
 225         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x1f },
 226         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x0c },
 227         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 228         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 229         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 230         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 231         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
 232         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
 233         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
 234         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
 235         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 236         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
 237         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
 238         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
 239         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 240         { TM6010_REQ07_R3F_RESET, 0x00 },
 241         { 0, 0, 0 }
 242 };
 243
 244 static struct tm6000_reg_settings svideo_pal[] = {
 245         { TM6010_REQ07_R3F_RESET, 0x01 },
 246         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x33 },
 247         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
 248         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 249         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x04 },
 250         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x30 },
 251         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x25 },
 252         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0xd5 },
 253         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x63 },
 254         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x50 },
 255         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 256         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 257         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 258         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 259         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
 260         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2a },
 261         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
 262         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
 263         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 264         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
 265         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
 266         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
 267         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 268         { TM6010_REQ07_R3F_RESET, 0x00 },
 269         { 0, 0, 0 }
 270 };
 271
 272 static struct tm6000_reg_settings svideo_secam[] = {
 273         { TM6010_REQ07_R3F_RESET, 0x01 },
 274         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x39 },
 275         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
 276         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 277         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x03 },
 278         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
 279         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x24 },
 280         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x92 },
 281         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xe8 },
 282         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xed },
 283         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 284         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 285         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 286         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 287         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
 288         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2a },
 289         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
 290         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x2c },
 291         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x18 },
 292         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
 293         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0xff },
 294         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 295         { TM6010_REQ07_R3F_RESET, 0x00 },
 296         { 0, 0, 0 }
 297 };
 298
 299 static struct tm6000_reg_settings svideo_ntsc[] = {
 300         { TM6010_REQ07_R3F_RESET, 0x01 },
 301         { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x01 },
 302         { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0f },
 303         { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
 304         { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x03 },
 305         { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x30 },
 306         { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0x8b },
 307         { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
 308         { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
 309         { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
 310         { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
 311         { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
 312         { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
 313         { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
 314         { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
 315         { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
 316         { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
 317         { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
 318         { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
 319         { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
 320         { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
 321         { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
 322         { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdd },
 323         { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
 324         { TM6010_REQ07_R3F_RESET, 0x00 },
 325         { 0, 0, 0 }
 326 };
 327
 328 static struct tm6000_std_settings svideo_stds[] = {
 329         { .id = V4L2_STD_PAL_M, .common = svideo_pal_m, },
 330         { .id = V4L2_STD_PAL_Nc, .common = svideo_pal_nc, },
 331         { .id = V4L2_STD_PAL, .common = svideo_pal, },
 332         { .id = V4L2_STD_SECAM, .common = svideo_secam, },
 333         { .id = V4L2_STD_NTSC, .common = svideo_ntsc, },
 334 };
 335
 336 static int tm6000_set_audio_std(struct tm6000_core *dev)
 337 {
 338         uint8_t areg_02 = 0x04; /* GC1 Fixed gain 0dB */
 339         uint8_t areg_05 = 0x01; /* Auto 4.5 = M Japan, Auto 6.5 = DK */
 340         uint8_t areg_06 = 0x02; /* Auto de-emphasis, mannual channel mode */
 341         uint8_t nicam_flag = 0; /* No NICAM */
 342
 343         if (dev->radio) {
 344                 tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x00);
 345                 tm6000_set_reg(dev, TM6010_REQ08_R02_A_FIX_GAIN_CTRL, 0x04);
 346                 tm6000_set_reg(dev, TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00);
 347                 tm6000_set_reg(dev, TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0x80);
 348                 tm6000_set_reg(dev, TM6010_REQ08_R05_A_STANDARD_MOD, 0x0c);
 349                 /* set mono or stereo */
 350                 if (dev->amode == V4L2_TUNER_MODE_MONO)
 351                         tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, 0x00);
 352                 else if (dev->amode == V4L2_TUNER_MODE_STEREO)
 353                         tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, 0x02);
 354                 tm6000_set_reg(dev, TM6010_REQ08_R09_A_MAIN_VOL, 0x18);
 355                 tm6000_set_reg(dev, TM6010_REQ08_R0C_A_ASD_THRES2, 0x0a);
 356                 tm6000_set_reg(dev, TM6010_REQ08_R0D_A_AMD_THRES, 0x40);
 357                 tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfe);
 358                 tm6000_set_reg(dev, TM6010_REQ08_R1E_A_GAIN_DEEMPH_OUT, 0x13);
 359                 tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x80);
 360                 tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0xff);
 361                 return 0;
 362         }
 363
 364         switch (tm6010_a_mode) {
 365         /* auto */
 366         case 0:
 367                 switch (dev->norm) {
 368                 case V4L2_STD_NTSC_M_KR:
 369                         areg_05 |= 0x00;
 370                         break;
 371                 case V4L2_STD_NTSC_M_JP:
 372                         areg_05 |= 0x40;
 373                         break;
 374                 case V4L2_STD_NTSC_M:
 375                 case V4L2_STD_PAL_M:
 376                 case V4L2_STD_PAL_N:
 377                         areg_05 |= 0x20;
 378                         break;
 379                 case V4L2_STD_PAL_Nc:
 380                         areg_05 |= 0x60;
 381                         break;
 382                 case V4L2_STD_SECAM_L:
 383                         areg_05 |= 0x00;
 384                         break;
 385                 case V4L2_STD_DK:
 386                         areg_05 |= 0x10;
 387                         break;
 388                 }
 389                 break;
 390         /* A2 */
 391         case 1:
 392                 switch (dev->norm) {
 393                 case V4L2_STD_B:
 394                 case V4L2_STD_GH:
 395                         areg_05 = 0x05;
 396                         break;
 397                 case V4L2_STD_DK:
 398                         areg_05 = 0x09;
 399                         break;
 400                 }
 401                 break;
 402         /* NICAM */
 403         case 2:
 404                 switch (dev->norm) {
 405                 case V4L2_STD_B:
 406                 case V4L2_STD_GH:
 407                         areg_05 = 0x07;
 408                         break;
 409                 case V4L2_STD_DK:
 410                         areg_05 = 0x06;
 411                         break;
 412                 case V4L2_STD_PAL_I:
 413                         areg_05 = 0x08;
 414                         break;
 415                 case V4L2_STD_SECAM_L:
 416                         areg_05 = 0x0a;
 417                         areg_02 = 0x02;
 418                         break;
 419                 }
 420                 nicam_flag = 1;
 421                 break;
 422         /* other */
 423         case 3:
 424                 switch (dev->norm) {
 425                 /* DK3_A2 */
 426                 case V4L2_STD_DK:
 427                         areg_05 = 0x0b;
 428                         break;
 429                 /* Korea */
 430                 case V4L2_STD_NTSC_M_KR:
 431                         areg_05 = 0x04;
 432                         break;
 433                 /* EIAJ */
 434                 case V4L2_STD_NTSC_M_JP:
 435                         areg_05 = 0x03;
 436                         break;
 437                 default:
 438                         areg_05 = 0x02;
 439                         break;
 440                 }
 441                 break;
 442         }
 443
 444         tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x00);
 445         tm6000_set_reg(dev, TM6010_REQ08_R02_A_FIX_GAIN_CTRL, areg_02);
 446         tm6000_set_reg(dev, TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00);
 447         tm6000_set_reg(dev, TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0xa0);
 448         tm6000_set_reg(dev, TM6010_REQ08_R05_A_STANDARD_MOD, areg_05);
 449         tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, areg_06);
 450         tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, 0x00);
 451         tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, 0x00);
 452         tm6000_set_reg(dev, TM6010_REQ08_R09_A_MAIN_VOL, 0x08);
 453         tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, 0x91);
 454         tm6000_set_reg(dev, TM6010_REQ08_R0B_A_ASD_THRES1, 0x20);
 455         tm6000_set_reg(dev, TM6010_REQ08_R0C_A_ASD_THRES2, 0x12);
 456         tm6000_set_reg(dev, TM6010_REQ08_R0D_A_AMD_THRES, 0x20);
 457         tm6000_set_reg(dev, TM6010_REQ08_R0E_A_MONO_THRES1, 0xf0);
 458         tm6000_set_reg(dev, TM6010_REQ08_R0F_A_MONO_THRES2, 0x80);
 459         tm6000_set_reg(dev, TM6010_REQ08_R10_A_MUTE_THRES1, 0xc0);
 460         tm6000_set_reg(dev, TM6010_REQ08_R11_A_MUTE_THRES2, 0x80);
 461         tm6000_set_reg(dev, TM6010_REQ08_R12_A_AGC_U, 0x12);
 462         tm6000_set_reg(dev, TM6010_REQ08_R13_A_AGC_ERR_T, 0xfe);
 463         tm6000_set_reg(dev, TM6010_REQ08_R14_A_AGC_GAIN_INIT, 0x20);
 464         tm6000_set_reg(dev, TM6010_REQ08_R15_A_AGC_STEP_THR, 0x14);
 465         tm6000_set_reg(dev, TM6010_REQ08_R16_A_AGC_GAIN_MAX, 0xfe);
 466         tm6000_set_reg(dev, TM6010_REQ08_R17_A_AGC_GAIN_MIN, 0x01);
 467         tm6000_set_reg(dev, TM6010_REQ08_R18_A_TR_CTRL, 0xa0);
 468         tm6000_set_reg(dev, TM6010_REQ08_R19_A_FH_2FH_GAIN, 0x32);
 469         tm6000_set_reg(dev, TM6010_REQ08_R1A_A_NICAM_SER_MAX, 0x64);
 470         tm6000_set_reg(dev, TM6010_REQ08_R1B_A_NICAM_SER_MIN, 0x20);
 471         tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1c, 0x00);
 472         tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1d, 0x00);
 473         tm6000_set_reg(dev, TM6010_REQ08_R1E_A_GAIN_DEEMPH_OUT, 0x13);
 474         tm6000_set_reg(dev, TM6010_REQ08_R1F_A_TEST_INTF_SEL, 0x00);
 475         tm6000_set_reg(dev, TM6010_REQ08_R20_A_TEST_PIN_SEL, 0x00);
 476         tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x80);
 477
 478         return 0;
 479 }
 480
 481 void tm6000_get_std_res(struct tm6000_core *dev)
 482 {
 483         /* Currently, those are the only supported resoltions */
 484         if (dev->norm & V4L2_STD_525_60)
 485                 dev->height = 480;
 486         else
 487                 dev->height = 576;
 488
 489         dev->width = 720;
 490 }
 491
 492 static int tm6000_load_std(struct tm6000_core *dev, struct tm6000_reg_settings *set)
 493 {
 494         int i, rc;
 495
 496         /* Load board's initialization table */
 497         for (i = 0; set[i].req; i++) {
 498                 rc = tm6000_set_reg(dev, set[i].req, set[i].reg, set[i].value);
 499                 if (rc < 0) {
 500                         printk(KERN_ERR "Error %i while setting "
 501                                "req %d, reg %d to value %d\n",
 502                                rc, set[i].req, set[i].reg, set[i].value);
 503                         return rc;
 504                 }
 505         }
 506
 507         return 0;
 508 }
 509
 510 int tm6000_set_standard(struct tm6000_core *dev)
 511 {
 512         struct tm6000_input *input;
 513         int i, rc = 0;
 514         u8 reg_07_fe = 0x8a;
 515         u8 reg_08_f1 = 0xfc;
 516         u8 reg_08_e2 = 0xf0;
 517         u8 reg_08_e6 = 0x0f;
 518
 519         tm6000_get_std_res(dev);
 520
 521         if (!dev->radio)
 522                 input = &dev->vinput[dev->input];
 523         else
 524                 input = &dev->rinput;
 525
 526         if (dev->dev_type == TM6010) {
 527                 switch (input->vmux) {
 528                 case TM6000_VMUX_VIDEO_A:
 529                         tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4);
 530                         tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf1);
 531                         tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xe0);
 532                         tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
 533                         tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe8);
 534                         reg_07_fe |= 0x01;
 535                         break;
 536                 case TM6000_VMUX_VIDEO_B:
 537                         tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf8);
 538                         tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf1);
 539                         tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xe0);
 540                         tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
 541                         tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe8);
 542                         reg_07_fe |= 0x01;
 543                         break;
 544                 case TM6000_VMUX_VIDEO_AB:
 545                         tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xfc);
 546                         tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8);
 547                         reg_08_e6 = 0x00;
 548                         tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2);
 549                         tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0);
 550                         tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
 551                         tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe0);
 552                         break;
 553                 default:
 554                         break;
 555                 }
 556                 switch (input->amux) {
 557                 case TM6000_AMUX_ADC1:
 558                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 559                                 0x00, 0x0f);
 560                         break;
 561                 case TM6000_AMUX_ADC2:
 562                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 563                                 0x08, 0x0f);
 564                         break;
 565                 case TM6000_AMUX_SIF1:
 566                         reg_08_e2 |= 0x02;
 567                         reg_08_e6 = 0x08;
 568                         reg_07_fe |= 0x40;
 569                         reg_08_f1 |= 0x02;
 570                         tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf3);
 571                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 572                                 0x02, 0x0f);
 573                         break;
 574                 case TM6000_AMUX_SIF2:
 575                         reg_08_e2 |= 0x02;
 576                         reg_08_e6 = 0x08;
 577                         reg_07_fe |= 0x40;
 578                         reg_08_f1 |= 0x02;
 579                         tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf7);
 580                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 581                                 0x02, 0x0f);
 582                         break;
 583                 default:
 584                         break;
 585                 }
 586                 tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, reg_08_e2);
 587                 tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, reg_08_e6);
 588                 tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, reg_08_f1);
 589                 tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, reg_07_fe);
 590         } else {
 591                 switch (input->vmux) {
 592                 case TM6000_VMUX_VIDEO_A:
 593                         tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10);
 594                         tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00);
 595                         tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x0f);
 596                         tm6000_set_reg(dev,
 597                             REQ_03_SET_GET_MCU_PIN, input->v_gpio, 0);
 598                         break;
 599                 case TM6000_VMUX_VIDEO_B:
 600                         tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x00);
 601                         tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00);
 602                         tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x0f);
 603                         tm6000_set_reg(dev,
 604                             REQ_03_SET_GET_MCU_PIN, input->v_gpio, 0);
 605                         break;
 606                 case TM6000_VMUX_VIDEO_AB:
 607                         tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10);
 608                         tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x10);
 609                         tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00);
 610                         tm6000_set_reg(dev,
 611                             REQ_03_SET_GET_MCU_PIN, input->v_gpio, 1);
 612                         break;
 613                 default:
 614                         break;
 615                 }
 616                 switch (input->amux) {
 617                 case TM6000_AMUX_ADC1:
 618                         tm6000_set_reg_mask(dev,
 619                                 TM6000_REQ07_REB_VADC_AADC_MODE, 0x00, 0x0f);
 620                         break;
 621                 case TM6000_AMUX_ADC2:
 622                         tm6000_set_reg_mask(dev,
 623                                 TM6000_REQ07_REB_VADC_AADC_MODE, 0x04, 0x0f);
 624                         break;
 625                 default:
 626                         break;
 627                 }
 628         }
 629         if (input->type == TM6000_INPUT_SVIDEO) {
 630                 for (i = 0; i < ARRAY_SIZE(svideo_stds); i++) {
 631                         if (dev->norm & svideo_stds[i].id) {
 632                                 rc = tm6000_load_std(dev, svideo_stds[i].common);
 633                                 goto ret;
 634                         }
 635                 }
 636                 return -EINVAL;
 637         } else {
 638                 for (i = 0; i < ARRAY_SIZE(composite_stds); i++) {
 639                         if (dev->norm & composite_stds[i].id) {
 640                                 rc = tm6000_load_std(dev, composite_stds[i].common);
 641                                 goto ret;
 642                         }
 643                 }
 644                 return -EINVAL;
 645         }
 646
 647 ret:
 648         if (rc < 0)
 649                 return rc;
 650
 651         if ((dev->dev_type == TM6010) &&
 652             ((input->amux == TM6000_AMUX_SIF1) ||
 653             (input->amux == TM6000_AMUX_SIF2)))
 654                 tm6000_set_audio_std(dev);
 655
 656         msleep(40);
 657
 658         return 0;
 659 }