drivers/gpu/drm/i915/intel_tv.c

   1 /*
   2  * Copyright © 2006-2008 Intel Corporation
   3  *   Jesse Barnes <jesse.barnes@intel.com>
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining a
   6  * copy of this software and associated documentation files (the "Software"),
   7  * to deal in the Software without restriction, including without limitation
   8  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   9  * and/or sell copies of the Software, and to permit persons to whom the
  10  * Software is furnished to do so, subject to the following conditions:
  11  *
  12  * The above copyright notice and this permission notice (including the next
  13  * paragraph) shall be included in all copies or substantial portions of the
  14  * Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  21  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  22  * DEALINGS IN THE SOFTWARE.
  23  *
  24  * Authors:
  25  *    Eric Anholt <eric@anholt.net>
  26  *
  27  */
  28
  29 /** @file
  30  * Integrated TV-out support for the 915GM and 945GM.
  31  */
  32
  33 #include "drmP.h"
  34 #include "drm.h"
  35 #include "drm_crtc.h"
  36 #include "drm_edid.h"
  37 #include "intel_drv.h"
  38 #include "i915_drm.h"
  39 #include "i915_drv.h"
  40
  41 enum tv_margin {
  42         TV_MARGIN_LEFT, TV_MARGIN_TOP,
  43         TV_MARGIN_RIGHT, TV_MARGIN_BOTTOM
  44 };
  45
  46 /** Private structure for the integrated TV support */
  47 struct intel_tv {
  48         struct intel_encoder base;
  49
  50         int type;
  51         char *tv_format;
  52         int margin[4];
  53         u32 save_TV_H_CTL_1;
  54         u32 save_TV_H_CTL_2;
  55         u32 save_TV_H_CTL_3;
  56         u32 save_TV_V_CTL_1;
  57         u32 save_TV_V_CTL_2;
  58         u32 save_TV_V_CTL_3;
  59         u32 save_TV_V_CTL_4;
  60         u32 save_TV_V_CTL_5;
  61         u32 save_TV_V_CTL_6;
  62         u32 save_TV_V_CTL_7;
  63         u32 save_TV_SC_CTL_1, save_TV_SC_CTL_2, save_TV_SC_CTL_3;
  64
  65         u32 save_TV_CSC_Y;
  66         u32 save_TV_CSC_Y2;
  67         u32 save_TV_CSC_U;
  68         u32 save_TV_CSC_U2;
  69         u32 save_TV_CSC_V;
  70         u32 save_TV_CSC_V2;
  71         u32 save_TV_CLR_KNOBS;
  72         u32 save_TV_CLR_LEVEL;
  73         u32 save_TV_WIN_POS;
  74         u32 save_TV_WIN_SIZE;
  75         u32 save_TV_FILTER_CTL_1;
  76         u32 save_TV_FILTER_CTL_2;
  77         u32 save_TV_FILTER_CTL_3;
  78
  79         u32 save_TV_H_LUMA[60];
  80         u32 save_TV_H_CHROMA[60];
  81         u32 save_TV_V_LUMA[43];
  82         u32 save_TV_V_CHROMA[43];
  83
  84         u32 save_TV_DAC;
  85         u32 save_TV_CTL;
  86 };
  87
  88 struct video_levels {
  89         int blank, black, burst;
  90 };
  91
  92 struct color_conversion {
  93         u16 ry, gy, by, ay;
  94         u16 ru, gu, bu, au;
  95         u16 rv, gv, bv, av;
  96 };
  97
  98 static const u32 filter_table[] = {
  99         0xB1403000, 0x2E203500, 0x35002E20, 0x3000B140,
 100         0x35A0B160, 0x2DC02E80, 0xB1403480, 0xB1603000,
 101         0x2EA03640, 0x34002D80, 0x3000B120, 0x36E0B160,
 102         0x2D202EF0, 0xB1203380, 0xB1603000, 0x2F303780,
 103         0x33002CC0, 0x3000B100, 0x3820B160, 0x2C802F50,
 104         0xB10032A0, 0xB1603000, 0x2F9038C0, 0x32202C20,
 105         0x3000B0E0, 0x3980B160, 0x2BC02FC0, 0xB0E031C0,
 106         0xB1603000, 0x2FF03A20, 0x31602B60, 0xB020B0C0,
 107         0x3AE0B160, 0x2B001810, 0xB0C03120, 0xB140B020,
 108         0x18283BA0, 0x30C02A80, 0xB020B0A0, 0x3C60B140,
 109         0x2A201838, 0xB0A03080, 0xB120B020, 0x18383D20,
 110         0x304029C0, 0xB040B080, 0x3DE0B100, 0x29601848,
 111         0xB0803000, 0xB100B040, 0x18483EC0, 0xB0402900,
 112         0xB040B060, 0x3F80B0C0, 0x28801858, 0xB060B080,
 113         0xB0A0B060, 0x18602820, 0xB0A02820, 0x0000B060,
 114         0xB1403000, 0x2E203500, 0x35002E20, 0x3000B140,
 115         0x35A0B160, 0x2DC02E80, 0xB1403480, 0xB1603000,
 116         0x2EA03640, 0x34002D80, 0x3000B120, 0x36E0B160,
 117         0x2D202EF0, 0xB1203380, 0xB1603000, 0x2F303780,
 118         0x33002CC0, 0x3000B100, 0x3820B160, 0x2C802F50,
 119         0xB10032A0, 0xB1603000, 0x2F9038C0, 0x32202C20,
 120         0x3000B0E0, 0x3980B160, 0x2BC02FC0, 0xB0E031C0,
 121         0xB1603000, 0x2FF03A20, 0x31602B60, 0xB020B0C0,
 122         0x3AE0B160, 0x2B001810, 0xB0C03120, 0xB140B020,
 123         0x18283BA0, 0x30C02A80, 0xB020B0A0, 0x3C60B140,
 124         0x2A201838, 0xB0A03080, 0xB120B020, 0x18383D20,
 125         0x304029C0, 0xB040B080, 0x3DE0B100, 0x29601848,
 126         0xB0803000, 0xB100B040, 0x18483EC0, 0xB0402900,
 127         0xB040B060, 0x3F80B0C0, 0x28801858, 0xB060B080,
 128         0xB0A0B060, 0x18602820, 0xB0A02820, 0x0000B060,
 129         0x36403000, 0x2D002CC0, 0x30003640, 0x2D0036C0,
 130         0x35C02CC0, 0x37403000, 0x2C802D40, 0x30003540,
 131         0x2D8037C0, 0x34C02C40, 0x38403000, 0x2BC02E00,
 132         0x30003440, 0x2E2038C0, 0x34002B80, 0x39803000,
 133         0x2B402E40, 0x30003380, 0x2E603A00, 0x33402B00,
 134         0x3A803040, 0x2A802EA0, 0x30403300, 0x2EC03B40,
 135         0x32802A40, 0x3C003040, 0x2A002EC0, 0x30803240,
 136         0x2EC03C80, 0x320029C0, 0x3D403080, 0x29402F00,
 137         0x308031C0, 0x2F203DC0, 0x31802900, 0x3E8030C0,
 138         0x28802F40, 0x30C03140, 0x2F203F40, 0x31402840,
 139         0x28003100, 0x28002F00, 0x00003100, 0x36403000,
 140         0x2D002CC0, 0x30003640, 0x2D0036C0,
 141         0x35C02CC0, 0x37403000, 0x2C802D40, 0x30003540,
 142         0x2D8037C0, 0x34C02C40, 0x38403000, 0x2BC02E00,
 143         0x30003440, 0x2E2038C0, 0x34002B80, 0x39803000,
 144         0x2B402E40, 0x30003380, 0x2E603A00, 0x33402B00,
 145         0x3A803040, 0x2A802EA0, 0x30403300, 0x2EC03B40,
 146         0x32802A40, 0x3C003040, 0x2A002EC0, 0x30803240,
 147         0x2EC03C80, 0x320029C0, 0x3D403080, 0x29402F00,
 148         0x308031C0, 0x2F203DC0, 0x31802900, 0x3E8030C0,
 149         0x28802F40, 0x30C03140, 0x2F203F40, 0x31402840,
 150         0x28003100, 0x28002F00, 0x00003100,
 151 };
 152
 153 /*
 154  * Color conversion values have 3 separate fixed point formats:
 155  *
 156  * 10 bit fields (ay, au)
 157  *   1.9 fixed point (b.bbbbbbbbb)
 158  * 11 bit fields (ry, by, ru, gu, gv)
 159  *   exp.mantissa (ee.mmmmmmmmm)
 160  *   ee = 00 = 10^-1 (0.mmmmmmmmm)
 161  *   ee = 01 = 10^-2 (0.0mmmmmmmmm)
 162  *   ee = 10 = 10^-3 (0.00mmmmmmmmm)
 163  *   ee = 11 = 10^-4 (0.000mmmmmmmmm)
 164  * 12 bit fields (gy, rv, bu)
 165  *   exp.mantissa (eee.mmmmmmmmm)
 166  *   eee = 000 = 10^-1 (0.mmmmmmmmm)
 167  *   eee = 001 = 10^-2 (0.0mmmmmmmmm)
 168  *   eee = 010 = 10^-3 (0.00mmmmmmmmm)
 169  *   eee = 011 = 10^-4 (0.000mmmmmmmmm)
 170  *   eee = 100 = reserved
 171  *   eee = 101 = reserved
 172  *   eee = 110 = reserved
 173  *   eee = 111 = 10^0 (m.mmmmmmmm) (only usable for 1.0 representation)
 174  *
 175  * Saturation and contrast are 8 bits, with their own representation:
 176  * 8 bit field (saturation, contrast)
 177  *   exp.mantissa (ee.mmmmmm)
 178  *   ee = 00 = 10^-1 (0.mmmmmm)
 179  *   ee = 01 = 10^0 (m.mmmmm)
 180  *   ee = 10 = 10^1 (mm.mmmm)
 181  *   ee = 11 = 10^2 (mmm.mmm)
 182  *
 183  * Simple conversion function:
 184  *
 185  * static u32
 186  * float_to_csc_11(float f)
 187  * {
 188  *     u32 exp;
 189  *     u32 mant;
 190  *     u32 ret;
 191  *
 192  *     if (f < 0)
 193  *         f = -f;
 194  *
 195  *     if (f >= 1) {
 196  *         exp = 0x7;
 197  *         mant = 1 << 8;
 198  *     } else {
 199  *         for (exp = 0; exp < 3 && f < 0.5; exp++)
 200  *             f *= 2.0;
 201  *         mant = (f * (1 << 9) + 0.5);
 202  *         if (mant >= (1 << 9))
 203  *             mant = (1 << 9) - 1;
 204  *     }
 205  *     ret = (exp << 9) | mant;
 206  *     return ret;
 207  * }
 208  */
 209
 210 /*
 211  * Behold, magic numbers!  If we plant them they might grow a big
 212  * s-video cable to the sky... or something.
 213  *
 214  * Pre-converted to appropriate hex value.
 215  */
 216
 217 /*
 218  * PAL & NTSC values for composite & s-video connections
 219  */
 220 static const struct color_conversion ntsc_m_csc_composite = {
 221         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0104,
 222         .ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
 223         .rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
 224 };
 225
 226 static const struct video_levels ntsc_m_levels_composite = {
 227         .blank = 225, .black = 267, .burst = 113,
 228 };
 229
 230 static const struct color_conversion ntsc_m_csc_svideo = {
 231         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0133,
 232         .ru = 0x076a, .gu = 0x0564, .bu = 0x030d, .au = 0x0200,
 233         .rv = 0x037a, .gv = 0x033d, .bv = 0x06f6, .av = 0x0200,
 234 };
 235
 236 static const struct video_levels ntsc_m_levels_svideo = {
 237         .blank = 266, .black = 316, .burst = 133,
 238 };
 239
 240 static const struct color_conversion ntsc_j_csc_composite = {
 241         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0119,
 242         .ru = 0x074c, .gu = 0x0546, .bu = 0x05ec, .au = 0x0200,
 243         .rv = 0x035a, .gv = 0x0322, .bv = 0x06e1, .av = 0x0200,
 244 };
 245
 246 static const struct video_levels ntsc_j_levels_composite = {
 247         .blank = 225, .black = 225, .burst = 113,
 248 };
 249
 250 static const struct color_conversion ntsc_j_csc_svideo = {
 251         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x014c,
 252         .ru = 0x0788, .gu = 0x0581, .bu = 0x0322, .au = 0x0200,
 253         .rv = 0x0399, .gv = 0x0356, .bv = 0x070a, .av = 0x0200,
 254 };
 255
 256 static const struct video_levels ntsc_j_levels_svideo = {
 257         .blank = 266, .black = 266, .burst = 133,
 258 };
 259
 260 static const struct color_conversion pal_csc_composite = {
 261         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0113,
 262         .ru = 0x0745, .gu = 0x053f, .bu = 0x05e1, .au = 0x0200,
 263         .rv = 0x0353, .gv = 0x031c, .bv = 0x06dc, .av = 0x0200,
 264 };
 265
 266 static const struct video_levels pal_levels_composite = {
 267         .blank = 237, .black = 237, .burst = 118,
 268 };
 269
 270 static const struct color_conversion pal_csc_svideo = {
 271         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0145,
 272         .ru = 0x0780, .gu = 0x0579, .bu = 0x031c, .au = 0x0200,
 273         .rv = 0x0390, .gv = 0x034f, .bv = 0x0705, .av = 0x0200,
 274 };
 275
 276 static const struct video_levels pal_levels_svideo = {
 277         .blank = 280, .black = 280, .burst = 139,
 278 };
 279
 280 static const struct color_conversion pal_m_csc_composite = {
 281         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0104,
 282         .ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
 283         .rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
 284 };
 285
 286 static const struct video_levels pal_m_levels_composite = {
 287         .blank = 225, .black = 267, .burst = 113,
 288 };
 289
 290 static const struct color_conversion pal_m_csc_svideo = {
 291         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0133,
 292         .ru = 0x076a, .gu = 0x0564, .bu = 0x030d, .au = 0x0200,
 293         .rv = 0x037a, .gv = 0x033d, .bv = 0x06f6, .av = 0x0200,
 294 };
 295
 296 static const struct video_levels pal_m_levels_svideo = {
 297         .blank = 266, .black = 316, .burst = 133,
 298 };
 299
 300 static const struct color_conversion pal_n_csc_composite = {
 301         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0104,
 302         .ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
 303         .rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
 304 };
 305
 306 static const struct video_levels pal_n_levels_composite = {
 307         .blank = 225, .black = 267, .burst = 118,
 308 };
 309
 310 static const struct color_conversion pal_n_csc_svideo = {
 311         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0133,
 312         .ru = 0x076a, .gu = 0x0564, .bu = 0x030d, .au = 0x0200,
 313         .rv = 0x037a, .gv = 0x033d, .bv = 0x06f6, .av = 0x0200,
 314 };
 315
 316 static const struct video_levels pal_n_levels_svideo = {
 317         .blank = 266, .black = 316, .burst = 139,
 318 };
 319
 320 /*
 321  * Component connections
 322  */
 323 static const struct color_conversion sdtv_csc_yprpb = {
 324         .ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0145,
 325         .ru = 0x0559, .gu = 0x0353, .bu = 0x0100, .au = 0x0200,
 326         .rv = 0x0100, .gv = 0x03ad, .bv = 0x074d, .av = 0x0200,
 327 };
 328
 329 static const struct color_conversion sdtv_csc_rgb = {
 330         .ry = 0x0000, .gy = 0x0f00, .by = 0x0000, .ay = 0x0166,
 331         .ru = 0x0000, .gu = 0x0000, .bu = 0x0f00, .au = 0x0166,
 332         .rv = 0x0f00, .gv = 0x0000, .bv = 0x0000, .av = 0x0166,
 333 };
 334
 335 static const struct color_conversion hdtv_csc_yprpb = {
 336         .ry = 0x05b3, .gy = 0x016e, .by = 0x0728, .ay = 0x0145,
 337         .ru = 0x07d5, .gu = 0x038b, .bu = 0x0100, .au = 0x0200,
 338         .rv = 0x0100, .gv = 0x03d1, .bv = 0x06bc, .av = 0x0200,
 339 };
 340
 341 static const struct color_conversion hdtv_csc_rgb = {
 342         .ry = 0x0000, .gy = 0x0f00, .by = 0x0000, .ay = 0x0166,
 343         .ru = 0x0000, .gu = 0x0000, .bu = 0x0f00, .au = 0x0166,
 344         .rv = 0x0f00, .gv = 0x0000, .bv = 0x0000, .av = 0x0166,
 345 };
 346
 347 static const struct video_levels component_levels = {
 348         .blank = 279, .black = 279, .burst = 0,
 349 };
 350
 351
 352 struct tv_mode {
 353         char *name;
 354         int clock;
 355         int refresh; /* in millihertz (for precision) */
 356         u32 oversample;
 357         int hsync_end, hblank_start, hblank_end, htotal;
 358         bool progressive, trilevel_sync, component_only;
 359         int vsync_start_f1, vsync_start_f2, vsync_len;
 360         bool veq_ena;
 361         int veq_start_f1, veq_start_f2, veq_len;
 362         int vi_end_f1, vi_end_f2, nbr_end;
 363         bool burst_ena;
 364         int hburst_start, hburst_len;
 365         int vburst_start_f1, vburst_end_f1;
 366         int vburst_start_f2, vburst_end_f2;
 367         int vburst_start_f3, vburst_end_f3;
 368         int vburst_start_f4, vburst_end_f4;
 369         /*
 370          * subcarrier programming
 371          */
 372         int dda2_size, dda3_size, dda1_inc, dda2_inc, dda3_inc;
 373         u32 sc_reset;
 374         bool pal_burst;
 375         /*
 376          * blank/black levels
 377          */
 378         const struct video_levels *composite_levels, *svideo_levels;
 379         const struct color_conversion *composite_color, *svideo_color;
 380         const u32 *filter_table;
 381         int max_srcw;
 382 };
 383
 384
 385 /*
 386  * Sub carrier DDA
 387  *
 388  *  I think this works as follows:
 389  *
 390  *  subcarrier freq = pixel_clock * (dda1_inc + dda2_inc / dda2_size) / 4096
 391  *
 392  * Presumably, when dda3 is added in, it gets to adjust the dda2_inc value
 393  *
 394  * So,
 395  *  dda1_ideal = subcarrier/pixel * 4096
 396  *  dda1_inc = floor (dda1_ideal)
 397  *  dda2 = dda1_ideal - dda1_inc
 398  *
 399  *  then pick a ratio for dda2 that gives the closest approximation. If
 400  *  you can't get close enough, you can play with dda3 as well. This
 401  *  seems likely to happen when dda2 is small as the jumps would be larger
 402  *
 403  * To invert this,
 404  *
 405  *  pixel_clock = subcarrier * 4096 / (dda1_inc + dda2_inc / dda2_size)
 406  *
 407  * The constants below were all computed using a 107.520MHz clock
 408  */
 409
 410 /**
 411  * Register programming values for TV modes.
 412  *
 413  * These values account for -1s required.
 414  */
 415
 416 static const struct tv_mode tv_modes[] = {
 417         {
 418                 .name           = "NTSC-M",
 419                 .clock          = 108000,
 420                 .refresh        = 29970,
 421                 .oversample     = TV_OVERSAMPLE_8X,
 422                 .component_only = 0,
 423                 /* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 3.580MHz */
 424
 425                 .hsync_end      = 64,               .hblank_end         = 124,
 426                 .hblank_start   = 836,              .htotal             = 857,
 427
 428                 .progressive    = false,            .trilevel_sync = false,
 429
 430                 .vsync_start_f1 = 6,                .vsync_start_f2     = 7,
 431                 .vsync_len      = 6,
 432
 433                 .veq_ena        = true,             .veq_start_f1       = 0,
 434                 .veq_start_f2   = 1,                .veq_len            = 18,
 435
 436                 .vi_end_f1      = 20,               .vi_end_f2          = 21,
 437                 .nbr_end        = 240,
 438
 439                 .burst_ena      = true,
 440                 .hburst_start   = 72,               .hburst_len         = 34,
 441                 .vburst_start_f1 = 9,               .vburst_end_f1      = 240,
 442                 .vburst_start_f2 = 10,              .vburst_end_f2      = 240,
 443                 .vburst_start_f3 = 9,               .vburst_end_f3      = 240,
 444                 .vburst_start_f4 = 10,              .vburst_end_f4      = 240,
 445
 446                 /* desired 3.5800000 actual 3.5800000 clock 107.52 */
 447                 .dda1_inc       =    135,
 448                 .dda2_inc       =  20800,           .dda2_size          =  27456,
 449                 .dda3_inc       =      0,           .dda3_size          =      0,
 450                 .sc_reset       = TV_SC_RESET_EVERY_4,
 451                 .pal_burst      = false,
 452
 453                 .composite_levels = &ntsc_m_levels_composite,
 454                 .composite_color = &ntsc_m_csc_composite,
 455                 .svideo_levels  = &ntsc_m_levels_svideo,
 456                 .svideo_color = &ntsc_m_csc_svideo,
 457
 458                 .filter_table = filter_table,
 459         },
 460         {
 461                 .name           = "NTSC-443",
 462                 .clock          = 108000,
 463                 .refresh        = 29970,
 464                 .oversample     = TV_OVERSAMPLE_8X,
 465                 .component_only = 0,
 466                 /* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 4.43MHz */
 467                 .hsync_end      = 64,               .hblank_end         = 124,
 468                 .hblank_start   = 836,              .htotal             = 857,
 469
 470                 .progressive    = false,            .trilevel_sync = false,
 471
 472                 .vsync_start_f1 = 6,                .vsync_start_f2     = 7,
 473                 .vsync_len      = 6,
 474
 475                 .veq_ena        = true,             .veq_start_f1       = 0,
 476                 .veq_start_f2   = 1,                .veq_len            = 18,
 477
 478                 .vi_end_f1      = 20,               .vi_end_f2          = 21,
 479                 .nbr_end        = 240,
 480
 481                 .burst_ena      = true,
 482                 .hburst_start   = 72,               .hburst_len         = 34,
 483                 .vburst_start_f1 = 9,               .vburst_end_f1      = 240,
 484                 .vburst_start_f2 = 10,              .vburst_end_f2      = 240,
 485                 .vburst_start_f3 = 9,               .vburst_end_f3      = 240,
 486                 .vburst_start_f4 = 10,              .vburst_end_f4      = 240,
 487
 488                 /* desired 4.4336180 actual 4.4336180 clock 107.52 */
 489                 .dda1_inc       =    168,
 490                 .dda2_inc       =   4093,       .dda2_size      =  27456,
 491                 .dda3_inc       =    310,       .dda3_size      =    525,
 492                 .sc_reset   = TV_SC_RESET_NEVER,
 493                 .pal_burst  = false,
 494
 495                 .composite_levels = &ntsc_m_levels_composite,
 496                 .composite_color = &ntsc_m_csc_composite,
 497                 .svideo_levels  = &ntsc_m_levels_svideo,
 498                 .svideo_color = &ntsc_m_csc_svideo,
 499
 500                 .filter_table = filter_table,
 501         },
 502         {
 503                 .name           = "NTSC-J",
 504                 .clock          = 108000,
 505                 .refresh        = 29970,
 506                 .oversample     = TV_OVERSAMPLE_8X,
 507                 .component_only = 0,
 508
 509                 /* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 3.580MHz */
 510                 .hsync_end      = 64,               .hblank_end         = 124,
 511                 .hblank_start = 836,        .htotal             = 857,
 512
 513                 .progressive    = false,    .trilevel_sync = false,
 514
 515                 .vsync_start_f1 = 6,        .vsync_start_f2     = 7,
 516                 .vsync_len      = 6,
 517
 518                 .veq_ena        = true,             .veq_start_f1       = 0,
 519                 .veq_start_f2 = 1,          .veq_len            = 18,
 520
 521                 .vi_end_f1      = 20,               .vi_end_f2          = 21,
 522                 .nbr_end        = 240,
 523
 524                 .burst_ena      = true,
 525                 .hburst_start   = 72,               .hburst_len         = 34,
 526                 .vburst_start_f1 = 9,               .vburst_end_f1      = 240,
 527                 .vburst_start_f2 = 10,              .vburst_end_f2      = 240,
 528                 .vburst_start_f3 = 9,               .vburst_end_f3      = 240,
 529                 .vburst_start_f4 = 10,              .vburst_end_f4      = 240,
 530
 531                 /* desired 3.5800000 actual 3.5800000 clock 107.52 */
 532                 .dda1_inc       =    135,
 533                 .dda2_inc       =  20800,           .dda2_size          =  27456,
 534                 .dda3_inc       =      0,           .dda3_size          =      0,
 535                 .sc_reset       = TV_SC_RESET_EVERY_4,
 536                 .pal_burst      = false,
 537
 538                 .composite_levels = &ntsc_j_levels_composite,
 539                 .composite_color = &ntsc_j_csc_composite,
 540                 .svideo_levels  = &ntsc_j_levels_svideo,
 541                 .svideo_color = &ntsc_j_csc_svideo,
 542
 543                 .filter_table = filter_table,
 544         },
 545         {
 546                 .name           = "PAL-M",
 547                 .clock          = 108000,
 548                 .refresh        = 29970,
 549                 .oversample     = TV_OVERSAMPLE_8X,
 550                 .component_only = 0,
 551
 552                 /* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 3.580MHz */
 553                 .hsync_end      = 64,             .hblank_end           = 124,
 554                 .hblank_start = 836,      .htotal               = 857,
 555
 556                 .progressive    = false,            .trilevel_sync = false,
 557
 558                 .vsync_start_f1 = 6,                .vsync_start_f2     = 7,
 559                 .vsync_len      = 6,
 560
 561                 .veq_ena        = true,             .veq_start_f1       = 0,
 562                 .veq_start_f2   = 1,                .veq_len            = 18,
 563
 564                 .vi_end_f1      = 20,               .vi_end_f2          = 21,
 565                 .nbr_end        = 240,
 566
 567                 .burst_ena      = true,
 568                 .hburst_start   = 72,               .hburst_len         = 34,
 569                 .vburst_start_f1 = 9,               .vburst_end_f1      = 240,
 570                 .vburst_start_f2 = 10,              .vburst_end_f2      = 240,
 571                 .vburst_start_f3 = 9,               .vburst_end_f3      = 240,
 572                 .vburst_start_f4 = 10,              .vburst_end_f4      = 240,
 573
 574                 /* desired 3.5800000 actual 3.5800000 clock 107.52 */
 575                 .dda1_inc       =    135,
 576                 .dda2_inc       =  16704,           .dda2_size          =  27456,
 577                 .dda3_inc       =      0,           .dda3_size          =      0,
 578                 .sc_reset       = TV_SC_RESET_EVERY_8,
 579                 .pal_burst  = true,
 580
 581                 .composite_levels = &pal_m_levels_composite,
 582                 .composite_color = &pal_m_csc_composite,
 583                 .svideo_levels  = &pal_m_levels_svideo,
 584                 .svideo_color = &pal_m_csc_svideo,
 585
 586                 .filter_table = filter_table,
 587         },
 588         {
 589                 /* 625 Lines, 50 Fields, 15.625KHz line, Sub-Carrier 4.434MHz */
 590                 .name       = "PAL-N",
 591                 .clock          = 108000,
 592                 .refresh        = 25000,
 593                 .oversample     = TV_OVERSAMPLE_8X,
 594                 .component_only = 0,
 595
 596                 .hsync_end      = 64,               .hblank_end         = 128,
 597                 .hblank_start = 844,        .htotal             = 863,
 598
 599                 .progressive  = false,    .trilevel_sync = false,
 600
 601
 602                 .vsync_start_f1 = 6,       .vsync_start_f2      = 7,
 603                 .vsync_len      = 6,
 604
 605                 .veq_ena        = true,             .veq_start_f1       = 0,
 606                 .veq_start_f2   = 1,                .veq_len            = 18,
 607
 608                 .vi_end_f1      = 24,               .vi_end_f2          = 25,
 609                 .nbr_end        = 286,
 610
 611                 .burst_ena      = true,
 612                 .hburst_start = 73,                 .hburst_len         = 34,
 613                 .vburst_start_f1 = 8,       .vburst_end_f1      = 285,
 614                 .vburst_start_f2 = 8,       .vburst_end_f2      = 286,
 615                 .vburst_start_f3 = 9,       .vburst_end_f3      = 286,
 616                 .vburst_start_f4 = 9,       .vburst_end_f4      = 285,
 617
 618
 619                 /* desired 4.4336180 actual 4.4336180 clock 107.52 */
 620                 .dda1_inc       =    135,
 621                 .dda2_inc       =  23578,       .dda2_size      =  27648,
 622                 .dda3_inc       =    134,       .dda3_size      =    625,
 623                 .sc_reset   = TV_SC_RESET_EVERY_8,
 624                 .pal_burst  = true,
 625
 626                 .composite_levels = &pal_n_levels_composite,
 627                 .composite_color = &pal_n_csc_composite,
 628                 .svideo_levels  = &pal_n_levels_svideo,
 629                 .svideo_color = &pal_n_csc_svideo,
 630
 631                 .filter_table = filter_table,
 632         },
 633         {
 634                 /* 625 Lines, 50 Fields, 15.625KHz line, Sub-Carrier 4.434MHz */
 635                 .name       = "PAL",
 636                 .clock          = 108000,
 637                 .refresh        = 25000,
 638                 .oversample     = TV_OVERSAMPLE_8X,
 639                 .component_only = 0,
 640
 641                 .hsync_end      = 64,               .hblank_end         = 142,
 642                 .hblank_start   = 844,      .htotal             = 863,
 643
 644                 .progressive    = false,    .trilevel_sync = false,
 645
 646                 .vsync_start_f1 = 5,        .vsync_start_f2     = 6,
 647                 .vsync_len      = 5,
 648
 649                 .veq_ena        = true,             .veq_start_f1       = 0,
 650                 .veq_start_f2   = 1,        .veq_len            = 15,
 651
 652                 .vi_end_f1      = 24,               .vi_end_f2          = 25,
 653                 .nbr_end        = 286,
 654
 655                 .burst_ena      = true,
 656                 .hburst_start   = 73,               .hburst_len         = 32,
 657                 .vburst_start_f1 = 8,               .vburst_end_f1      = 285,
 658                 .vburst_start_f2 = 8,               .vburst_end_f2      = 286,
 659                 .vburst_start_f3 = 9,               .vburst_end_f3      = 286,
 660                 .vburst_start_f4 = 9,               .vburst_end_f4      = 285,
 661
 662                 /* desired 4.4336180 actual 4.4336180 clock 107.52 */
 663                 .dda1_inc       =    168,
 664                 .dda2_inc       =   4122,       .dda2_size      =  27648,
 665                 .dda3_inc       =     67,       .dda3_size      =    625,
 666                 .sc_reset   = TV_SC_RESET_EVERY_8,
 667                 .pal_burst  = true,
 668
 669                 .composite_levels = &pal_levels_composite,
 670                 .composite_color = &pal_csc_composite,
 671                 .svideo_levels  = &pal_levels_svideo,
 672                 .svideo_color = &pal_csc_svideo,
 673
 674                 .filter_table = filter_table,
 675         },
 676         {
 677                 .name       = "480p@59.94Hz",
 678                 .clock  = 107520,
 679                 .refresh        = 59940,
 680                 .oversample     = TV_OVERSAMPLE_4X,
 681                 .component_only = 1,
 682
 683                 .hsync_end      = 64,               .hblank_end         = 122,
 684                 .hblank_start   = 842,              .htotal             = 857,
 685
 686                 .progressive    = true,.trilevel_sync = false,
 687
 688                 .vsync_start_f1 = 12,               .vsync_start_f2     = 12,
 689                 .vsync_len      = 12,
 690
 691                 .veq_ena        = false,
 692
 693                 .vi_end_f1      = 44,               .vi_end_f2          = 44,
 694                 .nbr_end        = 479,
 695
 696                 .burst_ena      = false,
 697
 698                 .filter_table = filter_table,
 699         },
 700         {
 701                 .name       = "480p@60Hz",
 702                 .clock  = 107520,
 703                 .refresh        = 60000,
 704                 .oversample     = TV_OVERSAMPLE_4X,
 705                 .component_only = 1,
 706
 707                 .hsync_end      = 64,               .hblank_end         = 122,
 708                 .hblank_start   = 842,              .htotal             = 856,
 709
 710                 .progressive    = true,.trilevel_sync = false,
 711
 712                 .vsync_start_f1 = 12,               .vsync_start_f2     = 12,
 713                 .vsync_len      = 12,
 714
 715                 .veq_ena        = false,
 716
 717                 .vi_end_f1      = 44,               .vi_end_f2          = 44,
 718                 .nbr_end        = 479,
 719
 720                 .burst_ena      = false,
 721
 722                 .filter_table = filter_table,
 723         },
 724         {
 725                 .name       = "576p",
 726                 .clock  = 107520,
 727                 .refresh        = 50000,
 728                 .oversample     = TV_OVERSAMPLE_4X,
 729                 .component_only = 1,
 730
 731                 .hsync_end      = 64,               .hblank_end         = 139,
 732                 .hblank_start   = 859,              .htotal             = 863,
 733
 734                 .progressive    = true,         .trilevel_sync = false,
 735
 736                 .vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 737                 .vsync_len      = 10,
 738
 739                 .veq_ena        = false,
 740
 741                 .vi_end_f1      = 48,               .vi_end_f2          = 48,
 742                 .nbr_end        = 575,
 743
 744                 .burst_ena      = false,
 745
 746                 .filter_table = filter_table,
 747         },
 748         {
 749                 .name       = "720p@60Hz",
 750                 .clock          = 148800,
 751                 .refresh        = 60000,
 752                 .oversample     = TV_OVERSAMPLE_2X,
 753                 .component_only = 1,
 754
 755                 .hsync_end      = 80,               .hblank_end         = 300,
 756                 .hblank_start   = 1580,             .htotal             = 1649,
 757
 758                 .progressive    = true,             .trilevel_sync = true,
 759
 760                 .vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 761                 .vsync_len      = 10,
 762
 763                 .veq_ena        = false,
 764
 765                 .vi_end_f1      = 29,               .vi_end_f2          = 29,
 766                 .nbr_end        = 719,
 767
 768                 .burst_ena      = false,
 769
 770                 .filter_table = filter_table,
 771         },
 772         {
 773                 .name       = "720p@59.94Hz",
 774                 .clock          = 148800,
 775                 .refresh        = 59940,
 776                 .oversample     = TV_OVERSAMPLE_2X,
 777                 .component_only = 1,
 778
 779                 .hsync_end      = 80,               .hblank_end         = 300,
 780                 .hblank_start   = 1580,             .htotal             = 1651,
 781
 782                 .progressive    = true,             .trilevel_sync = true,
 783
 784                 .vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 785                 .vsync_len      = 10,
 786
 787                 .veq_ena        = false,
 788
 789                 .vi_end_f1      = 29,               .vi_end_f2          = 29,
 790                 .nbr_end        = 719,
 791
 792                 .burst_ena      = false,
 793
 794                 .filter_table = filter_table,
 795         },
 796         {
 797                 .name       = "720p@50Hz",
 798                 .clock          = 148800,
 799                 .refresh        = 50000,
 800                 .oversample     = TV_OVERSAMPLE_2X,
 801                 .component_only = 1,
 802
 803                 .hsync_end      = 80,               .hblank_end         = 300,
 804                 .hblank_start   = 1580,             .htotal             = 1979,
 805
 806                 .progressive    = true,                 .trilevel_sync = true,
 807
 808                 .vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 809                 .vsync_len      = 10,
 810
 811                 .veq_ena        = false,
 812
 813                 .vi_end_f1      = 29,               .vi_end_f2          = 29,
 814                 .nbr_end        = 719,
 815
 816                 .burst_ena      = false,
 817
 818                 .filter_table = filter_table,
 819                 .max_srcw = 800
 820         },
 821         {
 822                 .name       = "1080i@50Hz",
 823                 .clock          = 148800,
 824                 .refresh        = 25000,
 825                 .oversample     = TV_OVERSAMPLE_2X,
 826                 .component_only = 1,
 827
 828                 .hsync_end      = 88,               .hblank_end         = 235,
 829                 .hblank_start   = 2155,             .htotal             = 2639,
 830
 831                 .progressive    = false,            .trilevel_sync = true,
 832
 833                 .vsync_start_f1 = 4,              .vsync_start_f2     = 5,
 834                 .vsync_len      = 10,
 835
 836                 .veq_ena        = true,             .veq_start_f1       = 4,
 837                 .veq_start_f2   = 4,        .veq_len            = 10,
 838
 839
 840                 .vi_end_f1      = 21,           .vi_end_f2          = 22,
 841                 .nbr_end        = 539,
 842
 843                 .burst_ena      = false,
 844
 845                 .filter_table = filter_table,
 846         },
 847         {
 848                 .name       = "1080i@60Hz",
 849                 .clock          = 148800,
 850                 .refresh        = 30000,
 851                 .oversample     = TV_OVERSAMPLE_2X,
 852                 .component_only = 1,
 853
 854                 .hsync_end      = 88,               .hblank_end         = 235,
 855                 .hblank_start   = 2155,             .htotal             = 2199,
 856
 857                 .progressive    = false,            .trilevel_sync = true,
 858
 859                 .vsync_start_f1 = 4,               .vsync_start_f2     = 5,
 860                 .vsync_len      = 10,
 861
 862                 .veq_ena        = true,             .veq_start_f1       = 4,
 863                 .veq_start_f2   = 4,                .veq_len            = 10,
 864
 865
 866                 .vi_end_f1      = 21,               .vi_end_f2          = 22,
 867                 .nbr_end        = 539,
 868
 869                 .burst_ena      = false,
 870
 871                 .filter_table = filter_table,
 872         },
 873         {
 874                 .name       = "1080i@59.94Hz",
 875                 .clock          = 148800,
 876                 .refresh        = 29970,
 877                 .oversample     = TV_OVERSAMPLE_2X,
 878                 .component_only = 1,
 879
 880                 .hsync_end      = 88,               .hblank_end         = 235,
 881                 .hblank_start   = 2155,             .htotal             = 2201,
 882
 883                 .progressive    = false,            .trilevel_sync = true,
 884
 885                 .vsync_start_f1 = 4,            .vsync_start_f2    = 5,
 886                 .vsync_len      = 10,
 887
 888                 .veq_ena        = true,             .veq_start_f1       = 4,
 889                 .veq_start_f2 = 4,                  .veq_len = 10,
 890
 891
 892                 .vi_end_f1      = 21,           .vi_end_f2              = 22,
 893                 .nbr_end        = 539,
 894
 895                 .burst_ena      = false,
 896
 897                 .filter_table = filter_table,
 898         },
 899 };
 900
 901 static struct intel_tv *enc_to_intel_tv(struct drm_encoder *encoder)
 902 {
 903         return container_of(enc_to_intel_encoder(encoder), struct intel_tv, base);
 904 }
 905
 906 static void
 907 intel_tv_dpms(struct drm_encoder *encoder, int mode)
 908 {
 909         struct drm_device *dev = encoder->dev;
 910         struct drm_i915_private *dev_priv = dev->dev_private;
 911
 912         switch(mode) {
 913         case DRM_MODE_DPMS_ON:
 914                 I915_WRITE(TV_CTL, I915_READ(TV_CTL) | TV_ENC_ENABLE);
 915                 break;
 916         case DRM_MODE_DPMS_STANDBY:
 917         case DRM_MODE_DPMS_SUSPEND:
 918         case DRM_MODE_DPMS_OFF:
 919                 I915_WRITE(TV_CTL, I915_READ(TV_CTL) & ~TV_ENC_ENABLE);
 920                 break;
 921         }
 922 }
 923
 924 static const struct tv_mode *
 925 intel_tv_mode_lookup (char *tv_format)
 926 {
 927         int i;
 928
 929         for (i = 0; i < sizeof(tv_modes) / sizeof (tv_modes[0]); i++) {
 930                 const struct tv_mode *tv_mode = &tv_modes[i];
 931
 932                 if (!strcmp(tv_format, tv_mode->name))
 933                         return tv_mode;
 934         }
 935         return NULL;
 936 }
 937
 938 static const struct tv_mode *
 939 intel_tv_mode_find (struct intel_tv *intel_tv)
 940 {
 941         return intel_tv_mode_lookup(intel_tv->tv_format);
 942 }
 943
 944 static enum drm_mode_status
 945 intel_tv_mode_valid(struct drm_connector *connector, struct drm_display_mode *mode)
 946 {
 947         struct drm_encoder *encoder = intel_attached_encoder(connector);
 948         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
 949         const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 950
 951         /* Ensure TV refresh is close to desired refresh */
 952         if (tv_mode && abs(tv_mode->refresh - drm_mode_vrefresh(mode) * 1000)
 953                                 < 1000)
 954                 return MODE_OK;
 955         return MODE_CLOCK_RANGE;
 956 }
 957
 958
 959 static bool
 960 intel_tv_mode_fixup(struct drm_encoder *encoder, struct drm_display_mode *mode,
 961                     struct drm_display_mode *adjusted_mode)
 962 {
 963         struct drm_device *dev = encoder->dev;
 964         struct drm_mode_config *drm_config = &dev->mode_config;
 965         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
 966         const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 967         struct drm_encoder *other_encoder;
 968
 969         if (!tv_mode)
 970                 return false;
 971
 972         /* FIXME: lock encoder list */
 973         list_for_each_entry(other_encoder, &drm_config->encoder_list, head) {
 974                 if (other_encoder != encoder &&
 975                     other_encoder->crtc == encoder->crtc)
 976                         return false;
 977         }
 978
 979         adjusted_mode->clock = tv_mode->clock;
 980         return true;
 981 }
 982
 983 static void
 984 intel_tv_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
 985                   struct drm_display_mode *adjusted_mode)
 986 {
 987         struct drm_device *dev = encoder->dev;
 988         struct drm_i915_private *dev_priv = dev->dev_private;
 989         struct drm_crtc *crtc = encoder->crtc;
 990         struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
 991         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
 992         const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 993         u32 tv_ctl;
 994         u32 hctl1, hctl2, hctl3;
 995         u32 vctl1, vctl2, vctl3, vctl4, vctl5, vctl6, vctl7;
 996         u32 scctl1, scctl2, scctl3;
 997         int i, j;
 998         const struct video_levels *video_levels;
 999         const struct color_conversion *color_conversion;
1000         bool burst_ena;
1001
1002         if (!tv_mode)
1003                 return; /* can't happen (mode_prepare prevents this) */
1004
1005         tv_ctl = I915_READ(TV_CTL);
1006         tv_ctl &= TV_CTL_SAVE;
1007
1008         switch (intel_tv->type) {
1009         default:
1010         case DRM_MODE_CONNECTOR_Unknown:
1011         case DRM_MODE_CONNECTOR_Composite:
1012                 tv_ctl |= TV_ENC_OUTPUT_COMPOSITE;
1013                 video_levels = tv_mode->composite_levels;
1014                 color_conversion = tv_mode->composite_color;
1015                 burst_ena = tv_mode->burst_ena;
1016                 break;
1017         case DRM_MODE_CONNECTOR_Component:
1018                 tv_ctl |= TV_ENC_OUTPUT_COMPONENT;
1019                 video_levels = &component_levels;
1020                 if (tv_mode->burst_ena)
1021                         color_conversion = &sdtv_csc_yprpb;
1022                 else
1023                         color_conversion = &hdtv_csc_yprpb;
1024                 burst_ena = false;
1025                 break;
1026         case DRM_MODE_CONNECTOR_SVIDEO:
1027                 tv_ctl |= TV_ENC_OUTPUT_SVIDEO;
1028                 video_levels = tv_mode->svideo_levels;
1029                 color_conversion = tv_mode->svideo_color;
1030                 burst_ena = tv_mode->burst_ena;
1031                 break;
1032         }
1033         hctl1 = (tv_mode->hsync_end << TV_HSYNC_END_SHIFT) |
1034                 (tv_mode->htotal << TV_HTOTAL_SHIFT);
1035
1036         hctl2 = (tv_mode->hburst_start << 16) |
1037                 (tv_mode->hburst_len << TV_HBURST_LEN_SHIFT);
1038
1039         if (burst_ena)
1040                 hctl2 |= TV_BURST_ENA;
1041
1042         hctl3 = (tv_mode->hblank_start << TV_HBLANK_START_SHIFT) |
1043                 (tv_mode->hblank_end << TV_HBLANK_END_SHIFT);
1044
1045         vctl1 = (tv_mode->nbr_end << TV_NBR_END_SHIFT) |
1046                 (tv_mode->vi_end_f1 << TV_VI_END_F1_SHIFT) |
1047                 (tv_mode->vi_end_f2 << TV_VI_END_F2_SHIFT);
1048
1049         vctl2 = (tv_mode->vsync_len << TV_VSYNC_LEN_SHIFT) |
1050                 (tv_mode->vsync_start_f1 << TV_VSYNC_START_F1_SHIFT) |
1051                 (tv_mode->vsync_start_f2 << TV_VSYNC_START_F2_SHIFT);
1052
1053         vctl3 = (tv_mode->veq_len << TV_VEQ_LEN_SHIFT) |
1054                 (tv_mode->veq_start_f1 << TV_VEQ_START_F1_SHIFT) |
1055                 (tv_mode->veq_start_f2 << TV_VEQ_START_F2_SHIFT);
1056
1057         if (tv_mode->veq_ena)
1058                 vctl3 |= TV_EQUAL_ENA;
1059
1060         vctl4 = (tv_mode->vburst_start_f1 << TV_VBURST_START_F1_SHIFT) |
1061                 (tv_mode->vburst_end_f1 << TV_VBURST_END_F1_SHIFT);
1062
1063         vctl5 = (tv_mode->vburst_start_f2 << TV_VBURST_START_F2_SHIFT) |
1064                 (tv_mode->vburst_end_f2 << TV_VBURST_END_F2_SHIFT);
1065
1066         vctl6 = (tv_mode->vburst_start_f3 << TV_VBURST_START_F3_SHIFT) |
1067                 (tv_mode->vburst_end_f3 << TV_VBURST_END_F3_SHIFT);
1068
1069         vctl7 = (tv_mode->vburst_start_f4 << TV_VBURST_START_F4_SHIFT) |
1070                 (tv_mode->vburst_end_f4 << TV_VBURST_END_F4_SHIFT);
1071
1072         if (intel_crtc->pipe == 1)
1073                 tv_ctl |= TV_ENC_PIPEB_SELECT;
1074         tv_ctl |= tv_mode->oversample;
1075
1076         if (tv_mode->progressive)
1077                 tv_ctl |= TV_PROGRESSIVE;
1078         if (tv_mode->trilevel_sync)
1079                 tv_ctl |= TV_TRILEVEL_SYNC;
1080         if (tv_mode->pal_burst)
1081                 tv_ctl |= TV_PAL_BURST;
1082
1083         scctl1 = 0;
1084         if (tv_mode->dda1_inc)
1085                 scctl1 |= TV_SC_DDA1_EN;
1086         if (tv_mode->dda2_inc)
1087                 scctl1 |= TV_SC_DDA2_EN;
1088         if (tv_mode->dda3_inc)
1089                 scctl1 |= TV_SC_DDA3_EN;
1090         scctl1 |= tv_mode->sc_reset;
1091         if (video_levels)
1092                 scctl1 |= video_levels->burst << TV_BURST_LEVEL_SHIFT;
1093         scctl1 |= tv_mode->dda1_inc << TV_SCDDA1_INC_SHIFT;
1094
1095         scctl2 = tv_mode->dda2_size << TV_SCDDA2_SIZE_SHIFT |
1096                 tv_mode->dda2_inc << TV_SCDDA2_INC_SHIFT;
1097
1098         scctl3 = tv_mode->dda3_size << TV_SCDDA3_SIZE_SHIFT |
1099                 tv_mode->dda3_inc << TV_SCDDA3_INC_SHIFT;
1100
1101         /* Enable two fixes for the chips that need them. */
1102         if (dev->pci_device < 0x2772)
1103                 tv_ctl |= TV_ENC_C0_FIX | TV_ENC_SDP_FIX;
1104
1105         I915_WRITE(TV_H_CTL_1, hctl1);
1106         I915_WRITE(TV_H_CTL_2, hctl2);
1107         I915_WRITE(TV_H_CTL_3, hctl3);
1108         I915_WRITE(TV_V_CTL_1, vctl1);
1109         I915_WRITE(TV_V_CTL_2, vctl2);
1110         I915_WRITE(TV_V_CTL_3, vctl3);
1111         I915_WRITE(TV_V_CTL_4, vctl4);
1112         I915_WRITE(TV_V_CTL_5, vctl5);
1113         I915_WRITE(TV_V_CTL_6, vctl6);
1114         I915_WRITE(TV_V_CTL_7, vctl7);
1115         I915_WRITE(TV_SC_CTL_1, scctl1);
1116         I915_WRITE(TV_SC_CTL_2, scctl2);
1117         I915_WRITE(TV_SC_CTL_3, scctl3);
1118
1119         if (color_conversion) {
1120                 I915_WRITE(TV_CSC_Y, (color_conversion->ry << 16) |
1121                            color_conversion->gy);
1122                 I915_WRITE(TV_CSC_Y2,(color_conversion->by << 16) |
1123                            color_conversion->ay);
1124                 I915_WRITE(TV_CSC_U, (color_conversion->ru << 16) |
1125                            color_conversion->gu);
1126                 I915_WRITE(TV_CSC_U2, (color_conversion->bu << 16) |
1127                            color_conversion->au);
1128                 I915_WRITE(TV_CSC_V, (color_conversion->rv << 16) |
1129                            color_conversion->gv);
1130                 I915_WRITE(TV_CSC_V2, (color_conversion->bv << 16) |
1131                            color_conversion->av);
1132         }
1133
1134         if (IS_I965G(dev))
1135                 I915_WRITE(TV_CLR_KNOBS, 0x00404000);
1136         else
1137                 I915_WRITE(TV_CLR_KNOBS, 0x00606000);
1138
1139         if (video_levels)
1140                 I915_WRITE(TV_CLR_LEVEL,
1141                            ((video_levels->black << TV_BLACK_LEVEL_SHIFT) |
1142                             (video_levels->blank << TV_BLANK_LEVEL_SHIFT)));
1143         {
1144                 int pipeconf_reg = (intel_crtc->pipe == 0) ?
1145                         PIPEACONF : PIPEBCONF;
1146                 int dspcntr_reg = (intel_crtc->plane == 0) ?
1147                         DSPACNTR : DSPBCNTR;
1148                 int pipeconf = I915_READ(pipeconf_reg);
1149                 int dspcntr = I915_READ(dspcntr_reg);
1150                 int dspbase_reg = (intel_crtc->plane == 0) ?
1151                         DSPAADDR : DSPBADDR;
1152                 int xpos = 0x0, ypos = 0x0;
1153                 unsigned int xsize, ysize;
1154                 /* Pipe must be off here */
1155                 I915_WRITE(dspcntr_reg, dspcntr & ~DISPLAY_PLANE_ENABLE);
1156                 /* Flush the plane changes */
1157                 I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1158
1159                 /* Wait for vblank for the disable to take effect */
1160                 if (!IS_I9XX(dev))
1161                         intel_wait_for_vblank(dev, intel_crtc->pipe);
1162
1163                 I915_WRITE(pipeconf_reg, pipeconf & ~PIPEACONF_ENABLE);
1164                 /* Wait for vblank for the disable to take effect. */
1165                 intel_wait_for_vblank(dev, intel_crtc->pipe);
1166
1167                 /* Filter ctl must be set before TV_WIN_SIZE */
1168                 I915_WRITE(TV_FILTER_CTL_1, TV_AUTO_SCALE);
1169                 xsize = tv_mode->hblank_start - tv_mode->hblank_end;
1170                 if (tv_mode->progressive)
1171                         ysize = tv_mode->nbr_end + 1;
1172                 else
1173                         ysize = 2*tv_mode->nbr_end + 1;
1174
1175                 xpos += intel_tv->margin[TV_MARGIN_LEFT];
1176                 ypos += intel_tv->margin[TV_MARGIN_TOP];
1177                 xsize -= (intel_tv->margin[TV_MARGIN_LEFT] +
1178                           intel_tv->margin[TV_MARGIN_RIGHT]);
1179                 ysize -= (intel_tv->margin[TV_MARGIN_TOP] +
1180                           intel_tv->margin[TV_MARGIN_BOTTOM]);
1181                 I915_WRITE(TV_WIN_POS, (xpos<<16)|ypos);
1182                 I915_WRITE(TV_WIN_SIZE, (xsize<<16)|ysize);
1183
1184                 I915_WRITE(pipeconf_reg, pipeconf);
1185                 I915_WRITE(dspcntr_reg, dspcntr);
1186                 /* Flush the plane changes */
1187                 I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1188         }
1189
1190         j = 0;
1191         for (i = 0; i < 60; i++)
1192                 I915_WRITE(TV_H_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1193         for (i = 0; i < 60; i++)
1194                 I915_WRITE(TV_H_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1195         for (i = 0; i < 43; i++)
1196                 I915_WRITE(TV_V_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1197         for (i = 0; i < 43; i++)
1198                 I915_WRITE(TV_V_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1199         I915_WRITE(TV_DAC, 0);
1200         I915_WRITE(TV_CTL, tv_ctl);
1201 }
1202
1203 static const struct drm_display_mode reported_modes[] = {
1204         {
1205                 .name = "NTSC 480i",
1206                 .clock = 107520,
1207                 .hdisplay = 1280,
1208                 .hsync_start = 1368,
1209                 .hsync_end = 1496,
1210                 .htotal = 1712,
1211
1212                 .vdisplay = 1024,
1213                 .vsync_start = 1027,
1214                 .vsync_end = 1034,
1215                 .vtotal = 1104,
1216                 .type = DRM_MODE_TYPE_DRIVER,
1217         },
1218 };
1219
1220 /**
1221  * Detects TV presence by checking for load.
1222  *
1223  * Requires that the current pipe's DPLL is active.
1224
1225  * \return true if TV is connected.
1226  * \return false if TV is disconnected.
1227  */
1228 static int
1229 intel_tv_detect_type (struct intel_tv *intel_tv)
1230 {
1231         struct drm_encoder *encoder = &intel_tv->base.enc;
1232         struct drm_device *dev = encoder->dev;
1233         struct drm_i915_private *dev_priv = dev->dev_private;
1234         unsigned long irqflags;
1235         u32 tv_ctl, save_tv_ctl;
1236         u32 tv_dac, save_tv_dac;
1237         int type = DRM_MODE_CONNECTOR_Unknown;
1238
1239         tv_dac = I915_READ(TV_DAC);
1240
1241         /* Disable TV interrupts around load detect or we'll recurse */
1242         spin_lock_irqsave(&dev_priv->user_irq_lock, irqflags);
1243         i915_disable_pipestat(dev_priv, 0, PIPE_HOTPLUG_INTERRUPT_ENABLE |
1244                               PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1245         spin_unlock_irqrestore(&dev_priv->user_irq_lock, irqflags);
1246
1247         /*
1248          * Detect TV by polling)
1249          */
1250         save_tv_dac = tv_dac;
1251         tv_ctl = I915_READ(TV_CTL);
1252         save_tv_ctl = tv_ctl;
1253         tv_ctl &= ~TV_ENC_ENABLE;
1254         tv_ctl &= ~TV_TEST_MODE_MASK;
1255         tv_ctl |= TV_TEST_MODE_MONITOR_DETECT;
1256         tv_dac &= ~TVDAC_SENSE_MASK;
1257         tv_dac &= ~DAC_A_MASK;
1258         tv_dac &= ~DAC_B_MASK;
1259         tv_dac &= ~DAC_C_MASK;
1260         tv_dac |= (TVDAC_STATE_CHG_EN |
1261                    TVDAC_A_SENSE_CTL |
1262                    TVDAC_B_SENSE_CTL |
1263                    TVDAC_C_SENSE_CTL |
1264                    DAC_CTL_OVERRIDE |
1265                    DAC_A_0_7_V |
1266                    DAC_B_0_7_V |
1267                    DAC_C_0_7_V);
1268         I915_WRITE(TV_CTL, tv_ctl);
1269         I915_WRITE(TV_DAC, tv_dac);
1270         POSTING_READ(TV_DAC);
1271         msleep(20);
1272
1273         tv_dac = I915_READ(TV_DAC);
1274         I915_WRITE(TV_DAC, save_tv_dac);
1275         I915_WRITE(TV_CTL, save_tv_ctl);
1276         POSTING_READ(TV_CTL);
1277         msleep(20);
1278
1279         /*
1280          *  A B C
1281          *  0 1 1 Composite
1282          *  1 0 X svideo
1283          *  0 0 0 Component
1284          */
1285         if ((tv_dac & TVDAC_SENSE_MASK) == (TVDAC_B_SENSE | TVDAC_C_SENSE)) {
1286                 DRM_DEBUG_KMS("Detected Composite TV connection\n");
1287                 type = DRM_MODE_CONNECTOR_Composite;
1288         } else if ((tv_dac & (TVDAC_A_SENSE|TVDAC_B_SENSE)) == TVDAC_A_SENSE) {
1289                 DRM_DEBUG_KMS("Detected S-Video TV connection\n");
1290                 type = DRM_MODE_CONNECTOR_SVIDEO;
1291         } else if ((tv_dac & TVDAC_SENSE_MASK) == 0) {
1292                 DRM_DEBUG_KMS("Detected Component TV connection\n");
1293                 type = DRM_MODE_CONNECTOR_Component;
1294         } else {
1295                 DRM_DEBUG_KMS("No TV connection detected\n");
1296                 type = -1;
1297         }
1298
1299         /* Restore interrupt config */
1300         spin_lock_irqsave(&dev_priv->user_irq_lock, irqflags);
1301         i915_enable_pipestat(dev_priv, 0, PIPE_HOTPLUG_INTERRUPT_ENABLE |
1302                              PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1303         spin_unlock_irqrestore(&dev_priv->user_irq_lock, irqflags);
1304
1305         return type;
1306 }
1307
1308 /*
1309  * Here we set accurate tv format according to connector type
1310  * i.e Component TV should not be assigned by NTSC or PAL
1311  */
1312 static void intel_tv_find_better_format(struct drm_connector *connector)
1313 {
1314         struct drm_encoder *encoder = intel_attached_encoder(connector);
1315         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1316         const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1317         int i;
1318
1319         if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
1320                 tv_mode->component_only)
1321                 return;
1322
1323
1324         for (i = 0; i < sizeof(tv_modes) / sizeof(*tv_modes); i++) {
1325                 tv_mode = tv_modes + i;
1326
1327                 if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
1328                         tv_mode->component_only)
1329                         break;
1330         }
1331
1332         intel_tv->tv_format = tv_mode->name;
1333         drm_connector_property_set_value(connector,
1334                 connector->dev->mode_config.tv_mode_property, i);
1335 }
1336
1337 /**
1338  * Detect the TV connection.
1339  *
1340  * Currently this always returns CONNECTOR_STATUS_UNKNOWN, as we need to be sure
1341  * we have a pipe programmed in order to probe the TV.
1342  */
1343 static enum drm_connector_status
1344 intel_tv_detect(struct drm_connector *connector, bool force)
1345 {
1346         struct drm_display_mode mode;
1347         struct drm_encoder *encoder = intel_attached_encoder(connector);
1348         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1349         int type;
1350
1351         mode = reported_modes[0];
1352         drm_mode_set_crtcinfo(&mode, CRTC_INTERLACE_HALVE_V);
1353
1354         if (encoder->crtc && encoder->crtc->enabled) {
1355                 type = intel_tv_detect_type(intel_tv);
1356         } else if (force) {
1357                 struct drm_crtc *crtc;
1358                 int dpms_mode;
1359
1360                 crtc = intel_get_load_detect_pipe(&intel_tv->base, connector,
1361                                                   &mode, &dpms_mode);
1362                 if (crtc) {
1363                         type = intel_tv_detect_type(intel_tv);
1364                         intel_release_load_detect_pipe(&intel_tv->base, connector,
1365                                                        dpms_mode);
1366                 } else
1367                         return connector_status_unknown;
1368         } else
1369                 return connector->status;
1370
1371         if (type < 0)
1372                 return connector_status_disconnected;
1373
1374         intel_tv_find_better_format(connector);
1375         return connector_status_connected;
1376 }
1377
1378 static struct input_res {
1379         char *name;
1380         int w, h;
1381 } input_res_table[] =
1382 {
1383         {"640x480", 640, 480},
1384         {"800x600", 800, 600},
1385         {"1024x768", 1024, 768},
1386         {"1280x1024", 1280, 1024},
1387         {"848x480", 848, 480},
1388         {"1280x720", 1280, 720},
1389         {"1920x1080", 1920, 1080},
1390 };
1391
1392 /*
1393  * Chose preferred mode  according to line number of TV format
1394  */
1395 static void
1396 intel_tv_chose_preferred_modes(struct drm_connector *connector,
1397                                struct drm_display_mode *mode_ptr)
1398 {
1399         struct drm_encoder *encoder = intel_attached_encoder(connector);
1400         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1401         const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1402
1403         if (tv_mode->nbr_end < 480 && mode_ptr->vdisplay == 480)
1404                 mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1405         else if (tv_mode->nbr_end > 480) {
1406                 if (tv_mode->progressive == true && tv_mode->nbr_end < 720) {
1407                         if (mode_ptr->vdisplay == 720)
1408                                 mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1409                 } else if (mode_ptr->vdisplay == 1080)
1410                                 mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1411         }
1412 }
1413
1414 /**
1415  * Stub get_modes function.
1416  *
1417  * This should probably return a set of fixed modes, unless we can figure out
1418  * how to probe modes off of TV connections.
1419  */
1420
1421 static int
1422 intel_tv_get_modes(struct drm_connector *connector)
1423 {
1424         struct drm_display_mode *mode_ptr;
1425         struct drm_encoder *encoder = intel_attached_encoder(connector);
1426         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1427         const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1428         int j, count = 0;
1429         u64 tmp;
1430
1431         for (j = 0; j < ARRAY_SIZE(input_res_table);
1432              j++) {
1433                 struct input_res *input = &input_res_table[j];
1434                 unsigned int hactive_s = input->w;
1435                 unsigned int vactive_s = input->h;
1436
1437                 if (tv_mode->max_srcw && input->w > tv_mode->max_srcw)
1438                         continue;
1439
1440                 if (input->w > 1024 && (!tv_mode->progressive
1441                                         && !tv_mode->component_only))
1442                         continue;
1443
1444                 mode_ptr = drm_mode_create(connector->dev);
1445                 if (!mode_ptr)
1446                         continue;
1447                 strncpy(mode_ptr->name, input->name, DRM_DISPLAY_MODE_LEN);
1448
1449                 mode_ptr->hdisplay = hactive_s;
1450                 mode_ptr->hsync_start = hactive_s + 1;
1451                 mode_ptr->hsync_end = hactive_s + 64;
1452                 if (mode_ptr->hsync_end <= mode_ptr->hsync_start)
1453                         mode_ptr->hsync_end = mode_ptr->hsync_start + 1;
1454                 mode_ptr->htotal = hactive_s + 96;
1455
1456                 mode_ptr->vdisplay = vactive_s;
1457                 mode_ptr->vsync_start = vactive_s + 1;
1458                 mode_ptr->vsync_end = vactive_s + 32;
1459                 if (mode_ptr->vsync_end <= mode_ptr->vsync_start)
1460                         mode_ptr->vsync_end = mode_ptr->vsync_start  + 1;
1461                 mode_ptr->vtotal = vactive_s + 33;
1462
1463                 tmp = (u64) tv_mode->refresh * mode_ptr->vtotal;
1464                 tmp *= mode_ptr->htotal;
1465                 tmp = div_u64(tmp, 1000000);
1466                 mode_ptr->clock = (int) tmp;
1467
1468                 mode_ptr->type = DRM_MODE_TYPE_DRIVER;
1469                 intel_tv_chose_preferred_modes(connector, mode_ptr);
1470                 drm_mode_probed_add(connector, mode_ptr);
1471                 count++;
1472         }
1473
1474         return count;
1475 }
1476
1477 static void
1478 intel_tv_destroy (struct drm_connector *connector)
1479 {
1480         drm_sysfs_connector_remove(connector);
1481         drm_connector_cleanup(connector);
1482         kfree(connector);
1483 }
1484
1485
1486 static int
1487 intel_tv_set_property(struct drm_connector *connector, struct drm_property *property,
1488                       uint64_t val)
1489 {
1490         struct drm_device *dev = connector->dev;
1491         struct drm_encoder *encoder = intel_attached_encoder(connector);
1492         struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1493         struct drm_crtc *crtc = encoder->crtc;
1494         int ret = 0;
1495         bool changed = false;
1496
1497         ret = drm_connector_property_set_value(connector, property, val);
1498         if (ret < 0)
1499                 goto out;
1500
1501         if (property == dev->mode_config.tv_left_margin_property &&
1502                 intel_tv->margin[TV_MARGIN_LEFT] != val) {
1503                 intel_tv->margin[TV_MARGIN_LEFT] = val;
1504                 changed = true;
1505         } else if (property == dev->mode_config.tv_right_margin_property &&
1506                 intel_tv->margin[TV_MARGIN_RIGHT] != val) {
1507                 intel_tv->margin[TV_MARGIN_RIGHT] = val;
1508                 changed = true;
1509         } else if (property == dev->mode_config.tv_top_margin_property &&
1510                 intel_tv->margin[TV_MARGIN_TOP] != val) {
1511                 intel_tv->margin[TV_MARGIN_TOP] = val;
1512                 changed = true;
1513         } else if (property == dev->mode_config.tv_bottom_margin_property &&
1514                 intel_tv->margin[TV_MARGIN_BOTTOM] != val) {
1515                 intel_tv->margin[TV_MARGIN_BOTTOM] = val;
1516                 changed = true;
1517         } else if (property == dev->mode_config.tv_mode_property) {
1518                 if (val >= ARRAY_SIZE(tv_modes)) {
1519                         ret = -EINVAL;
1520                         goto out;
1521                 }
1522                 if (!strcmp(intel_tv->tv_format, tv_modes[val].name))
1523                         goto out;
1524
1525                 intel_tv->tv_format = tv_modes[val].name;
1526                 changed = true;
1527         } else {
1528                 ret = -EINVAL;
1529                 goto out;
1530         }
1531
1532         if (changed && crtc)
1533                 drm_crtc_helper_set_mode(crtc, &crtc->mode, crtc->x,
1534                                 crtc->y, crtc->fb);
1535 out:
1536         return ret;
1537 }
1538
1539 static const struct drm_encoder_helper_funcs intel_tv_helper_funcs = {
1540         .dpms = intel_tv_dpms,
1541         .mode_fixup = intel_tv_mode_fixup,
1542         .prepare = intel_encoder_prepare,
1543         .mode_set = intel_tv_mode_set,
1544         .commit = intel_encoder_commit,
1545 };
1546
1547 static const struct drm_connector_funcs intel_tv_connector_funcs = {
1548         .dpms = drm_helper_connector_dpms,
1549         .detect = intel_tv_detect,
1550         .destroy = intel_tv_destroy,
1551         .set_property = intel_tv_set_property,
1552         .fill_modes = drm_helper_probe_single_connector_modes,
1553 };
1554
1555 static const struct drm_connector_helper_funcs intel_tv_connector_helper_funcs = {
1556         .mode_valid = intel_tv_mode_valid,
1557         .get_modes = intel_tv_get_modes,
1558         .best_encoder = intel_attached_encoder,
1559 };
1560
1561 static const struct drm_encoder_funcs intel_tv_enc_funcs = {
1562         .destroy = intel_encoder_destroy,
1563 };
1564
1565 /*
1566  * Enumerate the child dev array parsed from VBT to check whether
1567  * the integrated TV is present.
1568  * If it is present, return 1.
1569  * If it is not present, return false.
1570  * If no child dev is parsed from VBT, it assumes that the TV is present.
1571  */
1572 static int tv_is_present_in_vbt(struct drm_device *dev)
1573 {
1574         struct drm_i915_private *dev_priv = dev->dev_private;
1575         struct child_device_config *p_child;
1576         int i, ret;
1577
1578         if (!dev_priv->child_dev_num)
1579                 return 1;
1580
1581         ret = 0;
1582         for (i = 0; i < dev_priv->child_dev_num; i++) {
1583                 p_child = dev_priv->child_dev + i;
1584                 /*
1585                  * If the device type is not TV, continue.
1586                  */
1587                 if (p_child->device_type != DEVICE_TYPE_INT_TV &&
1588                         p_child->device_type != DEVICE_TYPE_TV)
1589                         continue;
1590                 /* Only when the addin_offset is non-zero, it is regarded
1591                  * as present.
1592                  */
1593                 if (p_child->addin_offset) {
1594                         ret = 1;
1595                         break;
1596                 }
1597         }
1598         return ret;
1599 }
1600
1601 void
1602 intel_tv_init(struct drm_device *dev)
1603 {
1604         struct drm_i915_private *dev_priv = dev->dev_private;
1605         struct drm_connector *connector;
1606         struct intel_tv *intel_tv;
1607         struct intel_encoder *intel_encoder;
1608         struct intel_connector *intel_connector;
1609         u32 tv_dac_on, tv_dac_off, save_tv_dac;
1610         char **tv_format_names;
1611         int i, initial_mode = 0;
1612
1613         if ((I915_READ(TV_CTL) & TV_FUSE_STATE_MASK) == TV_FUSE_STATE_DISABLED)
1614                 return;
1615
1616         if (!tv_is_present_in_vbt(dev)) {
1617                 DRM_DEBUG_KMS("Integrated TV is not present.\n");
1618                 return;
1619         }
1620         /* Even if we have an encoder we may not have a connector */
1621         if (!dev_priv->int_tv_support)
1622                 return;
1623
1624         /*
1625          * Sanity check the TV output by checking to see if the
1626          * DAC register holds a value
1627          */
1628         save_tv_dac = I915_READ(TV_DAC);
1629
1630         I915_WRITE(TV_DAC, save_tv_dac | TVDAC_STATE_CHG_EN);
1631         tv_dac_on = I915_READ(TV_DAC);
1632
1633         I915_WRITE(TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1634         tv_dac_off = I915_READ(TV_DAC);
1635
1636         I915_WRITE(TV_DAC, save_tv_dac);
1637
1638         /*
1639          * If the register does not hold the state change enable
1640          * bit, (either as a 0 or a 1), assume it doesn't really
1641          * exist
1642          */
1643         if ((tv_dac_on & TVDAC_STATE_CHG_EN) == 0 ||
1644             (tv_dac_off & TVDAC_STATE_CHG_EN) != 0)
1645                 return;
1646
1647         intel_tv = kzalloc(sizeof(struct intel_tv), GFP_KERNEL);
1648         if (!intel_tv) {
1649                 return;
1650         }
1651
1652         intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
1653         if (!intel_connector) {
1654                 kfree(intel_tv);
1655                 return;
1656         }
1657
1658         intel_encoder = &intel_tv->base;
1659         connector = &intel_connector->base;
1660
1661         drm_connector_init(dev, connector, &intel_tv_connector_funcs,
1662                            DRM_MODE_CONNECTOR_SVIDEO);
1663
1664         drm_encoder_init(dev, &intel_encoder->enc, &intel_tv_enc_funcs,
1665                          DRM_MODE_ENCODER_TVDAC);
1666
1667         drm_mode_connector_attach_encoder(&intel_connector->base, &intel_encoder->enc);
1668         intel_encoder->type = INTEL_OUTPUT_TVOUT;
1669         intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
1670         intel_encoder->clone_mask = (1 << INTEL_TV_CLONE_BIT);
1671         intel_encoder->enc.possible_crtcs = ((1 << 0) | (1 << 1));
1672         intel_encoder->enc.possible_clones = (1 << INTEL_OUTPUT_TVOUT);
1673         intel_tv->type = DRM_MODE_CONNECTOR_Unknown;
1674
1675         /* BIOS margin values */
1676         intel_tv->margin[TV_MARGIN_LEFT] = 54;
1677         intel_tv->margin[TV_MARGIN_TOP] = 36;
1678         intel_tv->margin[TV_MARGIN_RIGHT] = 46;
1679         intel_tv->margin[TV_MARGIN_BOTTOM] = 37;
1680
1681         intel_tv->tv_format = kstrdup(tv_modes[initial_mode].name, GFP_KERNEL);
1682
1683         drm_encoder_helper_add(&intel_encoder->enc, &intel_tv_helper_funcs);
1684         drm_connector_helper_add(connector, &intel_tv_connector_helper_funcs);
1685         connector->interlace_allowed = false;
1686         connector->doublescan_allowed = false;
1687
1688         /* Create TV properties then attach current values */
1689         tv_format_names = kmalloc(sizeof(char *) * ARRAY_SIZE(tv_modes),
1690                                   GFP_KERNEL);
1691         if (!tv_format_names)
1692                 goto out;
1693         for (i = 0; i < ARRAY_SIZE(tv_modes); i++)
1694                 tv_format_names[i] = tv_modes[i].name;
1695         drm_mode_create_tv_properties(dev, ARRAY_SIZE(tv_modes), tv_format_names);
1696
1697         drm_connector_attach_property(connector, dev->mode_config.tv_mode_property,
1698                                    initial_mode);
1699         drm_connector_attach_property(connector,
1700                                    dev->mode_config.tv_left_margin_property,
1701                                    intel_tv->margin[TV_MARGIN_LEFT]);
1702         drm_connector_attach_property(connector,
1703                                    dev->mode_config.tv_top_margin_property,
1704                                    intel_tv->margin[TV_MARGIN_TOP]);
1705         drm_connector_attach_property(connector,
1706                                    dev->mode_config.tv_right_margin_property,
1707                                    intel_tv->margin[TV_MARGIN_RIGHT]);
1708         drm_connector_attach_property(connector,
1709                                    dev->mode_config.tv_bottom_margin_property,
1710                                    intel_tv->margin[TV_MARGIN_BOTTOM]);
1711 out:
1712         drm_sysfs_connector_add(connector);
1713 }