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         /*
 365          * STD/MN shouldn't be affected by tm6010_a_mode, as there's just one
 366          * audio standard for each V4L2_STD type.
 367          */
 368         if ((dev->norm & V4L2_STD_NTSC) == V4L2_STD_NTSC_M_KR) {
 369                 areg_05 |= 0x04;
 370         } else if ((dev->norm & V4L2_STD_NTSC) == V4L2_STD_NTSC_M_JP) {
 371                 areg_05 |= 0x43;
 372         } else if (dev->norm & V4L2_STD_MN) {
 373                 areg_05 |= 0x22;
 374         } else switch (tm6010_a_mode) {
 375         /* auto */
 376         case 0:
 377                 if ((dev->norm & V4L2_STD_SECAM) == V4L2_STD_SECAM_L)
 378                         areg_05 |= 0x00;
 379                 else    /* Other PAL/SECAM standards */
 380                         areg_05 |= 0x10;
 381                 break;
 382         /* A2 */
 383         case 1:
 384                 if (dev->norm & V4L2_STD_DK)
 385                         areg_05 = 0x09;
 386                 else
 387                         areg_05 = 0x05;
 388                 break;
 389         /* NICAM */
 390         case 2:
 391                 if (dev->norm & V4L2_STD_DK) {
 392                         areg_05 = 0x06;
 393                 } else if (dev->norm & V4L2_STD_PAL_I) {
 394                         areg_05 = 0x08;
 395                 } else if (dev->norm & V4L2_STD_SECAM_L) {
 396                         areg_05 = 0x0a;
 397                         areg_02 = 0x02;
 398                 } else {
 399                         areg_05 = 0x07;
 400                 }
 401                 nicam_flag = 1;
 402                 break;
 403         /* other */
 404         case 3:
 405                 if (dev->norm & V4L2_STD_DK) {
 406                         areg_05 = 0x0b;
 407                 } else {
 408                         areg_05 = 0x02;
 409                 }
 410                 break;
 411         }
 412
 413         tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x00);
 414         tm6000_set_reg(dev, TM6010_REQ08_R02_A_FIX_GAIN_CTRL, areg_02);
 415         tm6000_set_reg(dev, TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00);
 416         tm6000_set_reg(dev, TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0xa0);
 417         tm6000_set_reg(dev, TM6010_REQ08_R05_A_STANDARD_MOD, areg_05);
 418         tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, areg_06);
 419         tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, 0x00);
 420         tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, 0x00);
 421         tm6000_set_reg(dev, TM6010_REQ08_R09_A_MAIN_VOL, 0x08);
 422         tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, 0x91);
 423         tm6000_set_reg(dev, TM6010_REQ08_R0B_A_ASD_THRES1, 0x20);
 424         tm6000_set_reg(dev, TM6010_REQ08_R0C_A_ASD_THRES2, 0x12);
 425         tm6000_set_reg(dev, TM6010_REQ08_R0D_A_AMD_THRES, 0x20);
 426         tm6000_set_reg(dev, TM6010_REQ08_R0E_A_MONO_THRES1, 0xf0);
 427         tm6000_set_reg(dev, TM6010_REQ08_R0F_A_MONO_THRES2, 0x80);
 428         tm6000_set_reg(dev, TM6010_REQ08_R10_A_MUTE_THRES1, 0xc0);
 429         tm6000_set_reg(dev, TM6010_REQ08_R11_A_MUTE_THRES2, 0x80);
 430         tm6000_set_reg(dev, TM6010_REQ08_R12_A_AGC_U, 0x12);
 431         tm6000_set_reg(dev, TM6010_REQ08_R13_A_AGC_ERR_T, 0xfe);
 432         tm6000_set_reg(dev, TM6010_REQ08_R14_A_AGC_GAIN_INIT, 0x20);
 433         tm6000_set_reg(dev, TM6010_REQ08_R15_A_AGC_STEP_THR, 0x14);
 434         tm6000_set_reg(dev, TM6010_REQ08_R16_A_AGC_GAIN_MAX, 0xfe);
 435         tm6000_set_reg(dev, TM6010_REQ08_R17_A_AGC_GAIN_MIN, 0x01);
 436         tm6000_set_reg(dev, TM6010_REQ08_R18_A_TR_CTRL, 0xa0);
 437         tm6000_set_reg(dev, TM6010_REQ08_R19_A_FH_2FH_GAIN, 0x32);
 438         tm6000_set_reg(dev, TM6010_REQ08_R1A_A_NICAM_SER_MAX, 0x64);
 439         tm6000_set_reg(dev, TM6010_REQ08_R1B_A_NICAM_SER_MIN, 0x20);
 440         tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1c, 0x00);
 441         tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1d, 0x00);
 442         tm6000_set_reg(dev, TM6010_REQ08_R1E_A_GAIN_DEEMPH_OUT, 0x13);
 443         tm6000_set_reg(dev, TM6010_REQ08_R1F_A_TEST_INTF_SEL, 0x00);
 444         tm6000_set_reg(dev, TM6010_REQ08_R20_A_TEST_PIN_SEL, 0x00);
 445         tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x80);
 446
 447         return 0;
 448 }
 449
 450 void tm6000_get_std_res(struct tm6000_core *dev)
 451 {
 452         /* Currently, those are the only supported resoltions */
 453         if (dev->norm & V4L2_STD_525_60)
 454                 dev->height = 480;
 455         else
 456                 dev->height = 576;
 457
 458         dev->width = 720;
 459 }
 460
 461 static int tm6000_load_std(struct tm6000_core *dev, struct tm6000_reg_settings *set)
 462 {
 463         int i, rc;
 464
 465         /* Load board's initialization table */
 466         for (i = 0; set[i].req; i++) {
 467                 rc = tm6000_set_reg(dev, set[i].req, set[i].reg, set[i].value);
 468                 if (rc < 0) {
 469                         printk(KERN_ERR "Error %i while setting "
 470                                "req %d, reg %d to value %d\n",
 471                                rc, set[i].req, set[i].reg, set[i].value);
 472                         return rc;
 473                 }
 474         }
 475
 476         return 0;
 477 }
 478
 479 int tm6000_set_standard(struct tm6000_core *dev)
 480 {
 481         struct tm6000_input *input;
 482         int i, rc = 0;
 483         u8 reg_07_fe = 0x8a;
 484         u8 reg_08_f1 = 0xfc;
 485         u8 reg_08_e2 = 0xf0;
 486         u8 reg_08_e6 = 0x0f;
 487
 488         tm6000_get_std_res(dev);
 489
 490         if (!dev->radio)
 491                 input = &dev->vinput[dev->input];
 492         else
 493                 input = &dev->rinput;
 494
 495         if (dev->dev_type == TM6010) {
 496                 switch (input->vmux) {
 497                 case TM6000_VMUX_VIDEO_A:
 498                         tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4);
 499                         tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf1);
 500                         tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xe0);
 501                         tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
 502                         tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe8);
 503                         reg_07_fe |= 0x01;
 504                         break;
 505                 case TM6000_VMUX_VIDEO_B:
 506                         tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf8);
 507                         tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf1);
 508                         tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xe0);
 509                         tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
 510                         tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe8);
 511                         reg_07_fe |= 0x01;
 512                         break;
 513                 case TM6000_VMUX_VIDEO_AB:
 514                         tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xfc);
 515                         tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8);
 516                         reg_08_e6 = 0x00;
 517                         tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2);
 518                         tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0);
 519                         tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
 520                         tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe0);
 521                         break;
 522                 default:
 523                         break;
 524                 }
 525                 switch (input->amux) {
 526                 case TM6000_AMUX_ADC1:
 527                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 528                                 0x00, 0x0f);
 529                         /* Mux overflow workaround */
 530                         tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
 531                                 0x10, 0xf0);
 532                         break;
 533                 case TM6000_AMUX_ADC2:
 534                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 535                                 0x08, 0x0f);
 536                         /* Mux overflow workaround */
 537                         tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
 538                                 0x10, 0xf0);
 539                         break;
 540                 case TM6000_AMUX_SIF1:
 541                         reg_08_e2 |= 0x02;
 542                         reg_08_e6 = 0x08;
 543                         reg_07_fe |= 0x40;
 544                         reg_08_f1 |= 0x02;
 545                         tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf3);
 546                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 547                                 0x02, 0x0f);
 548                         /* Mux overflow workaround */
 549                         tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
 550                                 0x30, 0xf0);
 551                         break;
 552                 case TM6000_AMUX_SIF2:
 553                         reg_08_e2 |= 0x02;
 554                         reg_08_e6 = 0x08;
 555                         reg_07_fe |= 0x40;
 556                         reg_08_f1 |= 0x02;
 557                         tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf7);
 558                         tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
 559                                 0x02, 0x0f);
 560                         /* Mux overflow workaround */
 561                         tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
 562                                 0x30, 0xf0);
 563                         break;
 564                 default:
 565                         break;
 566                 }
 567                 tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, reg_08_e2);
 568                 tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, reg_08_e6);
 569                 tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, reg_08_f1);
 570                 tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, reg_07_fe);
 571         } else {
 572                 switch (input->vmux) {
 573                 case TM6000_VMUX_VIDEO_A:
 574                         tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10);
 575                         tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00);
 576                         tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x0f);
 577                         tm6000_set_reg(dev,
 578                             REQ_03_SET_GET_MCU_PIN, input->v_gpio, 0);
 579                         break;
 580                 case TM6000_VMUX_VIDEO_B:
 581                         tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x00);
 582                         tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00);
 583                         tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x0f);
 584                         tm6000_set_reg(dev,
 585                             REQ_03_SET_GET_MCU_PIN, input->v_gpio, 0);
 586                         break;
 587                 case TM6000_VMUX_VIDEO_AB:
 588                         tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10);
 589                         tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x10);
 590                         tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00);
 591                         tm6000_set_reg(dev,
 592                             REQ_03_SET_GET_MCU_PIN, input->v_gpio, 1);
 593                         break;
 594                 default:
 595                         break;
 596                 }
 597                 switch (input->amux) {
 598                 case TM6000_AMUX_ADC1:
 599                         tm6000_set_reg_mask(dev,
 600                                 TM6000_REQ07_REB_VADC_AADC_MODE, 0x00, 0x0f);
 601                         break;
 602                 case TM6000_AMUX_ADC2:
 603                         tm6000_set_reg_mask(dev,
 604                                 TM6000_REQ07_REB_VADC_AADC_MODE, 0x04, 0x0f);
 605                         break;
 606                 default:
 607                         break;
 608                 }
 609         }
 610         if (input->type == TM6000_INPUT_SVIDEO) {
 611                 for (i = 0; i < ARRAY_SIZE(svideo_stds); i++) {
 612                         if (dev->norm & svideo_stds[i].id) {
 613                                 rc = tm6000_load_std(dev, svideo_stds[i].common);
 614                                 goto ret;
 615                         }
 616                 }
 617                 return -EINVAL;
 618         } else {
 619                 for (i = 0; i < ARRAY_SIZE(composite_stds); i++) {
 620                         if (dev->norm & composite_stds[i].id) {
 621                                 rc = tm6000_load_std(dev, composite_stds[i].common);
 622                                 goto ret;
 623                         }
 624                 }
 625                 return -EINVAL;
 626         }
 627
 628 ret:
 629         if (rc < 0)
 630                 return rc;
 631
 632         if ((dev->dev_type == TM6010) &&
 633             ((input->amux == TM6000_AMUX_SIF1) ||
 634             (input->amux == TM6000_AMUX_SIF2)))
 635                 tm6000_set_audio_std(dev);
 636
 637         msleep(40);
 638
 639         return 0;
 640 }