Linux Audio

Check our new training course

Open-source upstreaming

Need help get the support for your hardware in upstream Linux?
Loading...
v3.1
   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
  41enum 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 */
  47struct intel_tv {
  48	struct intel_encoder base;
  49
  50	int type;
  51	const 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
  88struct video_levels {
  89	int blank, black, burst;
  90};
  91
  92struct color_conversion {
  93	u16 ry, gy, by, ay;
  94	u16 ru, gu, bu, au;
  95	u16 rv, gv, bv, av;
  96};
  97
  98static 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 */
 220static 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
 226static const struct video_levels ntsc_m_levels_composite = {
 227	.blank = 225, .black = 267, .burst = 113,
 228};
 229
 230static 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
 236static const struct video_levels ntsc_m_levels_svideo = {
 237	.blank = 266, .black = 316, .burst = 133,
 238};
 239
 240static 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
 246static const struct video_levels ntsc_j_levels_composite = {
 247	.blank = 225, .black = 225, .burst = 113,
 248};
 249
 250static 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
 256static const struct video_levels ntsc_j_levels_svideo = {
 257	.blank = 266, .black = 266, .burst = 133,
 258};
 259
 260static 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
 266static const struct video_levels pal_levels_composite = {
 267	.blank = 237, .black = 237, .burst = 118,
 268};
 269
 270static 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
 276static const struct video_levels pal_levels_svideo = {
 277	.blank = 280, .black = 280, .burst = 139,
 278};
 279
 280static 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
 286static const struct video_levels pal_m_levels_composite = {
 287	.blank = 225, .black = 267, .burst = 113,
 288};
 289
 290static 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
 296static const struct video_levels pal_m_levels_svideo = {
 297	.blank = 266, .black = 316, .burst = 133,
 298};
 299
 300static 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
 306static const struct video_levels pal_n_levels_composite = {
 307	.blank = 225, .black = 267, .burst = 118,
 308};
 309
 310static 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
 316static const struct video_levels pal_n_levels_svideo = {
 317	.blank = 266, .black = 316, .burst = 139,
 318};
 319
 320/*
 321 * Component connections
 322 */
 323static 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
 329static 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
 335static 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
 341static 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
 347static const struct video_levels component_levels = {
 348	.blank = 279, .black = 279, .burst = 0,
 349};
 350
 351
 352struct tv_mode {
 353	const 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
 416static 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
 901static struct intel_tv *enc_to_intel_tv(struct drm_encoder *encoder)
 902{
 903	return container_of(encoder, struct intel_tv, base.base);
 904}
 905
 906static struct intel_tv *intel_attached_tv(struct drm_connector *connector)
 907{
 908	return container_of(intel_attached_encoder(connector),
 909			    struct intel_tv,
 910			    base);
 911}
 912
 913static void
 914intel_tv_dpms(struct drm_encoder *encoder, int mode)
 915{
 916	struct drm_device *dev = encoder->dev;
 917	struct drm_i915_private *dev_priv = dev->dev_private;
 918
 919	switch(mode) {
 920	case DRM_MODE_DPMS_ON:
 921		I915_WRITE(TV_CTL, I915_READ(TV_CTL) | TV_ENC_ENABLE);
 922		break;
 923	case DRM_MODE_DPMS_STANDBY:
 924	case DRM_MODE_DPMS_SUSPEND:
 925	case DRM_MODE_DPMS_OFF:
 926		I915_WRITE(TV_CTL, I915_READ(TV_CTL) & ~TV_ENC_ENABLE);
 927		break;
 928	}
 929}
 930
 931static const struct tv_mode *
 932intel_tv_mode_lookup(const char *tv_format)
 933{
 934	int i;
 935
 936	for (i = 0; i < sizeof(tv_modes) / sizeof (tv_modes[0]); i++) {
 937		const struct tv_mode *tv_mode = &tv_modes[i];
 938
 939		if (!strcmp(tv_format, tv_mode->name))
 940			return tv_mode;
 941	}
 942	return NULL;
 943}
 944
 945static const struct tv_mode *
 946intel_tv_mode_find(struct intel_tv *intel_tv)
 947{
 948	return intel_tv_mode_lookup(intel_tv->tv_format);
 949}
 950
 951static enum drm_mode_status
 952intel_tv_mode_valid(struct drm_connector *connector,
 953		    struct drm_display_mode *mode)
 954{
 955	struct intel_tv *intel_tv = intel_attached_tv(connector);
 956	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 957
 958	/* Ensure TV refresh is close to desired refresh */
 959	if (tv_mode && abs(tv_mode->refresh - drm_mode_vrefresh(mode) * 1000)
 960				< 1000)
 961		return MODE_OK;
 962
 963	return MODE_CLOCK_RANGE;
 964}
 965
 966
 967static bool
 968intel_tv_mode_fixup(struct drm_encoder *encoder, struct drm_display_mode *mode,
 969		    struct drm_display_mode *adjusted_mode)
 970{
 971	struct drm_device *dev = encoder->dev;
 972	struct drm_mode_config *drm_config = &dev->mode_config;
 973	struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
 974	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 975	struct drm_encoder *other_encoder;
 976
 977	if (!tv_mode)
 978		return false;
 979
 980	/* FIXME: lock encoder list */
 981	list_for_each_entry(other_encoder, &drm_config->encoder_list, head) {
 982		if (other_encoder != encoder &&
 983		    other_encoder->crtc == encoder->crtc)
 984			return false;
 985	}
 986
 987	adjusted_mode->clock = tv_mode->clock;
 988	return true;
 989}
 990
 991static void
 992intel_tv_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
 993		  struct drm_display_mode *adjusted_mode)
 994{
 995	struct drm_device *dev = encoder->dev;
 996	struct drm_i915_private *dev_priv = dev->dev_private;
 997	struct drm_crtc *crtc = encoder->crtc;
 998	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
 999	struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1000	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1001	u32 tv_ctl;
1002	u32 hctl1, hctl2, hctl3;
1003	u32 vctl1, vctl2, vctl3, vctl4, vctl5, vctl6, vctl7;
1004	u32 scctl1, scctl2, scctl3;
1005	int i, j;
1006	const struct video_levels *video_levels;
1007	const struct color_conversion *color_conversion;
1008	bool burst_ena;
1009	int pipe = intel_crtc->pipe;
1010
1011	if (!tv_mode)
1012		return;	/* can't happen (mode_prepare prevents this) */
1013
1014	tv_ctl = I915_READ(TV_CTL);
1015	tv_ctl &= TV_CTL_SAVE;
1016
1017	switch (intel_tv->type) {
1018	default:
1019	case DRM_MODE_CONNECTOR_Unknown:
1020	case DRM_MODE_CONNECTOR_Composite:
1021		tv_ctl |= TV_ENC_OUTPUT_COMPOSITE;
1022		video_levels = tv_mode->composite_levels;
1023		color_conversion = tv_mode->composite_color;
1024		burst_ena = tv_mode->burst_ena;
1025		break;
1026	case DRM_MODE_CONNECTOR_Component:
1027		tv_ctl |= TV_ENC_OUTPUT_COMPONENT;
1028		video_levels = &component_levels;
1029		if (tv_mode->burst_ena)
1030			color_conversion = &sdtv_csc_yprpb;
1031		else
1032			color_conversion = &hdtv_csc_yprpb;
1033		burst_ena = false;
1034		break;
1035	case DRM_MODE_CONNECTOR_SVIDEO:
1036		tv_ctl |= TV_ENC_OUTPUT_SVIDEO;
1037		video_levels = tv_mode->svideo_levels;
1038		color_conversion = tv_mode->svideo_color;
1039		burst_ena = tv_mode->burst_ena;
1040		break;
1041	}
1042	hctl1 = (tv_mode->hsync_end << TV_HSYNC_END_SHIFT) |
1043		(tv_mode->htotal << TV_HTOTAL_SHIFT);
1044
1045	hctl2 = (tv_mode->hburst_start << 16) |
1046		(tv_mode->hburst_len << TV_HBURST_LEN_SHIFT);
1047
1048	if (burst_ena)
1049		hctl2 |= TV_BURST_ENA;
1050
1051	hctl3 = (tv_mode->hblank_start << TV_HBLANK_START_SHIFT) |
1052		(tv_mode->hblank_end << TV_HBLANK_END_SHIFT);
1053
1054	vctl1 = (tv_mode->nbr_end << TV_NBR_END_SHIFT) |
1055		(tv_mode->vi_end_f1 << TV_VI_END_F1_SHIFT) |
1056		(tv_mode->vi_end_f2 << TV_VI_END_F2_SHIFT);
1057
1058	vctl2 = (tv_mode->vsync_len << TV_VSYNC_LEN_SHIFT) |
1059		(tv_mode->vsync_start_f1 << TV_VSYNC_START_F1_SHIFT) |
1060		(tv_mode->vsync_start_f2 << TV_VSYNC_START_F2_SHIFT);
1061
1062	vctl3 = (tv_mode->veq_len << TV_VEQ_LEN_SHIFT) |
1063		(tv_mode->veq_start_f1 << TV_VEQ_START_F1_SHIFT) |
1064		(tv_mode->veq_start_f2 << TV_VEQ_START_F2_SHIFT);
1065
1066	if (tv_mode->veq_ena)
1067		vctl3 |= TV_EQUAL_ENA;
1068
1069	vctl4 = (tv_mode->vburst_start_f1 << TV_VBURST_START_F1_SHIFT) |
1070		(tv_mode->vburst_end_f1 << TV_VBURST_END_F1_SHIFT);
1071
1072	vctl5 = (tv_mode->vburst_start_f2 << TV_VBURST_START_F2_SHIFT) |
1073		(tv_mode->vburst_end_f2 << TV_VBURST_END_F2_SHIFT);
1074
1075	vctl6 = (tv_mode->vburst_start_f3 << TV_VBURST_START_F3_SHIFT) |
1076		(tv_mode->vburst_end_f3 << TV_VBURST_END_F3_SHIFT);
1077
1078	vctl7 = (tv_mode->vburst_start_f4 << TV_VBURST_START_F4_SHIFT) |
1079		(tv_mode->vburst_end_f4 << TV_VBURST_END_F4_SHIFT);
1080
1081	if (intel_crtc->pipe == 1)
1082		tv_ctl |= TV_ENC_PIPEB_SELECT;
1083	tv_ctl |= tv_mode->oversample;
1084
1085	if (tv_mode->progressive)
1086		tv_ctl |= TV_PROGRESSIVE;
1087	if (tv_mode->trilevel_sync)
1088		tv_ctl |= TV_TRILEVEL_SYNC;
1089	if (tv_mode->pal_burst)
1090		tv_ctl |= TV_PAL_BURST;
1091
1092	scctl1 = 0;
1093	if (tv_mode->dda1_inc)
1094		scctl1 |= TV_SC_DDA1_EN;
1095	if (tv_mode->dda2_inc)
1096		scctl1 |= TV_SC_DDA2_EN;
1097	if (tv_mode->dda3_inc)
1098		scctl1 |= TV_SC_DDA3_EN;
1099	scctl1 |= tv_mode->sc_reset;
1100	if (video_levels)
1101		scctl1 |= video_levels->burst << TV_BURST_LEVEL_SHIFT;
1102	scctl1 |= tv_mode->dda1_inc << TV_SCDDA1_INC_SHIFT;
1103
1104	scctl2 = tv_mode->dda2_size << TV_SCDDA2_SIZE_SHIFT |
1105		tv_mode->dda2_inc << TV_SCDDA2_INC_SHIFT;
1106
1107	scctl3 = tv_mode->dda3_size << TV_SCDDA3_SIZE_SHIFT |
1108		tv_mode->dda3_inc << TV_SCDDA3_INC_SHIFT;
1109
1110	/* Enable two fixes for the chips that need them. */
1111	if (dev->pci_device < 0x2772)
1112		tv_ctl |= TV_ENC_C0_FIX | TV_ENC_SDP_FIX;
1113
1114	I915_WRITE(TV_H_CTL_1, hctl1);
1115	I915_WRITE(TV_H_CTL_2, hctl2);
1116	I915_WRITE(TV_H_CTL_3, hctl3);
1117	I915_WRITE(TV_V_CTL_1, vctl1);
1118	I915_WRITE(TV_V_CTL_2, vctl2);
1119	I915_WRITE(TV_V_CTL_3, vctl3);
1120	I915_WRITE(TV_V_CTL_4, vctl4);
1121	I915_WRITE(TV_V_CTL_5, vctl5);
1122	I915_WRITE(TV_V_CTL_6, vctl6);
1123	I915_WRITE(TV_V_CTL_7, vctl7);
1124	I915_WRITE(TV_SC_CTL_1, scctl1);
1125	I915_WRITE(TV_SC_CTL_2, scctl2);
1126	I915_WRITE(TV_SC_CTL_3, scctl3);
1127
1128	if (color_conversion) {
1129		I915_WRITE(TV_CSC_Y, (color_conversion->ry << 16) |
1130			   color_conversion->gy);
1131		I915_WRITE(TV_CSC_Y2,(color_conversion->by << 16) |
1132			   color_conversion->ay);
1133		I915_WRITE(TV_CSC_U, (color_conversion->ru << 16) |
1134			   color_conversion->gu);
1135		I915_WRITE(TV_CSC_U2, (color_conversion->bu << 16) |
1136			   color_conversion->au);
1137		I915_WRITE(TV_CSC_V, (color_conversion->rv << 16) |
1138			   color_conversion->gv);
1139		I915_WRITE(TV_CSC_V2, (color_conversion->bv << 16) |
1140			   color_conversion->av);
1141	}
1142
1143	if (INTEL_INFO(dev)->gen >= 4)
1144		I915_WRITE(TV_CLR_KNOBS, 0x00404000);
1145	else
1146		I915_WRITE(TV_CLR_KNOBS, 0x00606000);
1147
1148	if (video_levels)
1149		I915_WRITE(TV_CLR_LEVEL,
1150			   ((video_levels->black << TV_BLACK_LEVEL_SHIFT) |
1151			    (video_levels->blank << TV_BLANK_LEVEL_SHIFT)));
1152	{
1153		int pipeconf_reg = PIPECONF(pipe);
1154		int dspcntr_reg = DSPCNTR(intel_crtc->plane);
1155		int pipeconf = I915_READ(pipeconf_reg);
1156		int dspcntr = I915_READ(dspcntr_reg);
1157		int dspbase_reg = DSPADDR(intel_crtc->plane);
1158		int xpos = 0x0, ypos = 0x0;
1159		unsigned int xsize, ysize;
1160		/* Pipe must be off here */
1161		I915_WRITE(dspcntr_reg, dspcntr & ~DISPLAY_PLANE_ENABLE);
1162		/* Flush the plane changes */
1163		I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1164
1165		/* Wait for vblank for the disable to take effect */
1166		if (IS_GEN2(dev))
1167			intel_wait_for_vblank(dev, intel_crtc->pipe);
1168
1169		I915_WRITE(pipeconf_reg, pipeconf & ~PIPECONF_ENABLE);
1170		/* Wait for vblank for the disable to take effect. */
1171		intel_wait_for_pipe_off(dev, intel_crtc->pipe);
1172
1173		/* Filter ctl must be set before TV_WIN_SIZE */
1174		I915_WRITE(TV_FILTER_CTL_1, TV_AUTO_SCALE);
1175		xsize = tv_mode->hblank_start - tv_mode->hblank_end;
1176		if (tv_mode->progressive)
1177			ysize = tv_mode->nbr_end + 1;
1178		else
1179			ysize = 2*tv_mode->nbr_end + 1;
1180
1181		xpos += intel_tv->margin[TV_MARGIN_LEFT];
1182		ypos += intel_tv->margin[TV_MARGIN_TOP];
1183		xsize -= (intel_tv->margin[TV_MARGIN_LEFT] +
1184			  intel_tv->margin[TV_MARGIN_RIGHT]);
1185		ysize -= (intel_tv->margin[TV_MARGIN_TOP] +
1186			  intel_tv->margin[TV_MARGIN_BOTTOM]);
1187		I915_WRITE(TV_WIN_POS, (xpos<<16)|ypos);
1188		I915_WRITE(TV_WIN_SIZE, (xsize<<16)|ysize);
1189
1190		I915_WRITE(pipeconf_reg, pipeconf);
1191		I915_WRITE(dspcntr_reg, dspcntr);
1192		/* Flush the plane changes */
1193		I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1194	}
1195
1196	j = 0;
1197	for (i = 0; i < 60; i++)
1198		I915_WRITE(TV_H_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1199	for (i = 0; i < 60; i++)
1200		I915_WRITE(TV_H_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1201	for (i = 0; i < 43; i++)
1202		I915_WRITE(TV_V_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1203	for (i = 0; i < 43; i++)
1204		I915_WRITE(TV_V_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1205	I915_WRITE(TV_DAC, I915_READ(TV_DAC) & TV_DAC_SAVE);
1206	I915_WRITE(TV_CTL, tv_ctl);
1207}
1208
1209static const struct drm_display_mode reported_modes[] = {
1210	{
1211		.name = "NTSC 480i",
1212		.clock = 107520,
1213		.hdisplay = 1280,
1214		.hsync_start = 1368,
1215		.hsync_end = 1496,
1216		.htotal = 1712,
1217
1218		.vdisplay = 1024,
1219		.vsync_start = 1027,
1220		.vsync_end = 1034,
1221		.vtotal = 1104,
1222		.type = DRM_MODE_TYPE_DRIVER,
1223	},
1224};
1225
1226/**
1227 * Detects TV presence by checking for load.
1228 *
1229 * Requires that the current pipe's DPLL is active.
1230
1231 * \return true if TV is connected.
1232 * \return false if TV is disconnected.
1233 */
1234static int
1235intel_tv_detect_type (struct intel_tv *intel_tv,
1236		      struct drm_connector *connector)
1237{
1238	struct drm_encoder *encoder = &intel_tv->base.base;
1239	struct drm_crtc *crtc = encoder->crtc;
1240	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
1241	struct drm_device *dev = encoder->dev;
1242	struct drm_i915_private *dev_priv = dev->dev_private;
1243	unsigned long irqflags;
1244	u32 tv_ctl, save_tv_ctl;
1245	u32 tv_dac, save_tv_dac;
1246	int type;
1247
1248	/* Disable TV interrupts around load detect or we'll recurse */
1249	if (connector->polled & DRM_CONNECTOR_POLL_HPD) {
1250		spin_lock_irqsave(&dev_priv->irq_lock, irqflags);
1251		i915_disable_pipestat(dev_priv, 0,
1252				      PIPE_HOTPLUG_INTERRUPT_ENABLE |
1253				      PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1254		spin_unlock_irqrestore(&dev_priv->irq_lock, irqflags);
1255	}
1256
1257	save_tv_dac = tv_dac = I915_READ(TV_DAC);
1258	save_tv_ctl = tv_ctl = I915_READ(TV_CTL);
1259
1260	/* Poll for TV detection */
1261	tv_ctl &= ~(TV_ENC_ENABLE | TV_TEST_MODE_MASK);
1262	tv_ctl |= TV_TEST_MODE_MONITOR_DETECT;
1263	if (intel_crtc->pipe == 1)
1264		tv_ctl |= TV_ENC_PIPEB_SELECT;
1265	else
1266		tv_ctl &= ~TV_ENC_PIPEB_SELECT;
1267
1268	tv_dac &= ~(TVDAC_SENSE_MASK | DAC_A_MASK | DAC_B_MASK | DAC_C_MASK);
1269	tv_dac |= (TVDAC_STATE_CHG_EN |
1270		   TVDAC_A_SENSE_CTL |
1271		   TVDAC_B_SENSE_CTL |
1272		   TVDAC_C_SENSE_CTL |
1273		   DAC_CTL_OVERRIDE |
1274		   DAC_A_0_7_V |
1275		   DAC_B_0_7_V |
1276		   DAC_C_0_7_V);
1277
 
 
 
 
 
 
 
 
 
1278	I915_WRITE(TV_CTL, tv_ctl);
1279	I915_WRITE(TV_DAC, tv_dac);
1280	POSTING_READ(TV_DAC);
1281
1282	intel_wait_for_vblank(intel_tv->base.base.dev,
1283			      to_intel_crtc(intel_tv->base.base.crtc)->pipe);
1284
1285	type = -1;
1286	tv_dac = I915_READ(TV_DAC);
1287	DRM_DEBUG_KMS("TV detected: %x, %x\n", tv_ctl, tv_dac);
1288	/*
1289	 *  A B C
1290	 *  0 1 1 Composite
1291	 *  1 0 X svideo
1292	 *  0 0 0 Component
1293	 */
1294	if ((tv_dac & TVDAC_SENSE_MASK) == (TVDAC_B_SENSE | TVDAC_C_SENSE)) {
1295		DRM_DEBUG_KMS("Detected Composite TV connection\n");
1296		type = DRM_MODE_CONNECTOR_Composite;
1297	} else if ((tv_dac & (TVDAC_A_SENSE|TVDAC_B_SENSE)) == TVDAC_A_SENSE) {
1298		DRM_DEBUG_KMS("Detected S-Video TV connection\n");
1299		type = DRM_MODE_CONNECTOR_SVIDEO;
1300	} else if ((tv_dac & TVDAC_SENSE_MASK) == 0) {
1301		DRM_DEBUG_KMS("Detected Component TV connection\n");
1302		type = DRM_MODE_CONNECTOR_Component;
1303	} else {
1304		DRM_DEBUG_KMS("Unrecognised TV connection\n");
1305		type = -1;
1306	}
1307
1308	I915_WRITE(TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1309	I915_WRITE(TV_CTL, save_tv_ctl);
 
 
 
 
 
1310
1311	/* Restore interrupt config */
1312	if (connector->polled & DRM_CONNECTOR_POLL_HPD) {
1313		spin_lock_irqsave(&dev_priv->irq_lock, irqflags);
1314		i915_enable_pipestat(dev_priv, 0,
1315				     PIPE_HOTPLUG_INTERRUPT_ENABLE |
1316				     PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1317		spin_unlock_irqrestore(&dev_priv->irq_lock, irqflags);
1318	}
1319
1320	return type;
1321}
1322
1323/*
1324 * Here we set accurate tv format according to connector type
1325 * i.e Component TV should not be assigned by NTSC or PAL
1326 */
1327static void intel_tv_find_better_format(struct drm_connector *connector)
1328{
1329	struct intel_tv *intel_tv = intel_attached_tv(connector);
1330	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1331	int i;
1332
1333	if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
1334		tv_mode->component_only)
1335		return;
1336
1337
1338	for (i = 0; i < sizeof(tv_modes) / sizeof(*tv_modes); i++) {
1339		tv_mode = tv_modes + i;
1340
1341		if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
1342			tv_mode->component_only)
1343			break;
1344	}
1345
1346	intel_tv->tv_format = tv_mode->name;
1347	drm_connector_property_set_value(connector,
1348		connector->dev->mode_config.tv_mode_property, i);
1349}
1350
1351/**
1352 * Detect the TV connection.
1353 *
1354 * Currently this always returns CONNECTOR_STATUS_UNKNOWN, as we need to be sure
1355 * we have a pipe programmed in order to probe the TV.
1356 */
1357static enum drm_connector_status
1358intel_tv_detect(struct drm_connector *connector, bool force)
1359{
1360	struct drm_display_mode mode;
1361	struct intel_tv *intel_tv = intel_attached_tv(connector);
1362	int type;
1363
1364	mode = reported_modes[0];
1365	drm_mode_set_crtcinfo(&mode, CRTC_INTERLACE_HALVE_V);
1366
1367	if (intel_tv->base.base.crtc && intel_tv->base.base.crtc->enabled) {
1368		type = intel_tv_detect_type(intel_tv, connector);
1369	} else if (force) {
1370		struct intel_load_detect_pipe tmp;
1371
1372		if (intel_get_load_detect_pipe(&intel_tv->base, connector,
1373					       &mode, &tmp)) {
1374			type = intel_tv_detect_type(intel_tv, connector);
1375			intel_release_load_detect_pipe(&intel_tv->base,
1376						       connector,
1377						       &tmp);
1378		} else
1379			return connector_status_unknown;
1380	} else
1381		return connector->status;
1382
1383	if (type < 0)
1384		return connector_status_disconnected;
1385
1386	intel_tv->type = type;
1387	intel_tv_find_better_format(connector);
1388
1389	return connector_status_connected;
1390}
1391
1392static const struct input_res {
1393	const char *name;
1394	int w, h;
1395} input_res_table[] = {
1396	{"640x480", 640, 480},
1397	{"800x600", 800, 600},
1398	{"1024x768", 1024, 768},
1399	{"1280x1024", 1280, 1024},
1400	{"848x480", 848, 480},
1401	{"1280x720", 1280, 720},
1402	{"1920x1080", 1920, 1080},
1403};
1404
1405/*
1406 * Chose preferred mode  according to line number of TV format
1407 */
1408static void
1409intel_tv_chose_preferred_modes(struct drm_connector *connector,
1410			       struct drm_display_mode *mode_ptr)
1411{
1412	struct intel_tv *intel_tv = intel_attached_tv(connector);
1413	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1414
1415	if (tv_mode->nbr_end < 480 && mode_ptr->vdisplay == 480)
1416		mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1417	else if (tv_mode->nbr_end > 480) {
1418		if (tv_mode->progressive == true && tv_mode->nbr_end < 720) {
1419			if (mode_ptr->vdisplay == 720)
1420				mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1421		} else if (mode_ptr->vdisplay == 1080)
1422				mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1423	}
1424}
1425
1426/**
1427 * Stub get_modes function.
1428 *
1429 * This should probably return a set of fixed modes, unless we can figure out
1430 * how to probe modes off of TV connections.
1431 */
1432
1433static int
1434intel_tv_get_modes(struct drm_connector *connector)
1435{
1436	struct drm_display_mode *mode_ptr;
1437	struct intel_tv *intel_tv = intel_attached_tv(connector);
1438	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1439	int j, count = 0;
1440	u64 tmp;
1441
1442	for (j = 0; j < ARRAY_SIZE(input_res_table);
1443	     j++) {
1444		const struct input_res *input = &input_res_table[j];
1445		unsigned int hactive_s = input->w;
1446		unsigned int vactive_s = input->h;
1447
1448		if (tv_mode->max_srcw && input->w > tv_mode->max_srcw)
1449			continue;
1450
1451		if (input->w > 1024 && (!tv_mode->progressive
1452					&& !tv_mode->component_only))
1453			continue;
1454
1455		mode_ptr = drm_mode_create(connector->dev);
1456		if (!mode_ptr)
1457			continue;
1458		strncpy(mode_ptr->name, input->name, DRM_DISPLAY_MODE_LEN);
1459
1460		mode_ptr->hdisplay = hactive_s;
1461		mode_ptr->hsync_start = hactive_s + 1;
1462		mode_ptr->hsync_end = hactive_s + 64;
1463		if (mode_ptr->hsync_end <= mode_ptr->hsync_start)
1464			mode_ptr->hsync_end = mode_ptr->hsync_start + 1;
1465		mode_ptr->htotal = hactive_s + 96;
1466
1467		mode_ptr->vdisplay = vactive_s;
1468		mode_ptr->vsync_start = vactive_s + 1;
1469		mode_ptr->vsync_end = vactive_s + 32;
1470		if (mode_ptr->vsync_end <= mode_ptr->vsync_start)
1471			mode_ptr->vsync_end = mode_ptr->vsync_start  + 1;
1472		mode_ptr->vtotal = vactive_s + 33;
1473
1474		tmp = (u64) tv_mode->refresh * mode_ptr->vtotal;
1475		tmp *= mode_ptr->htotal;
1476		tmp = div_u64(tmp, 1000000);
1477		mode_ptr->clock = (int) tmp;
1478
1479		mode_ptr->type = DRM_MODE_TYPE_DRIVER;
1480		intel_tv_chose_preferred_modes(connector, mode_ptr);
1481		drm_mode_probed_add(connector, mode_ptr);
1482		count++;
1483	}
1484
1485	return count;
1486}
1487
1488static void
1489intel_tv_destroy (struct drm_connector *connector)
1490{
1491	drm_sysfs_connector_remove(connector);
1492	drm_connector_cleanup(connector);
1493	kfree(connector);
1494}
1495
1496
1497static int
1498intel_tv_set_property(struct drm_connector *connector, struct drm_property *property,
1499		      uint64_t val)
1500{
1501	struct drm_device *dev = connector->dev;
1502	struct intel_tv *intel_tv = intel_attached_tv(connector);
1503	struct drm_crtc *crtc = intel_tv->base.base.crtc;
1504	int ret = 0;
1505	bool changed = false;
1506
1507	ret = drm_connector_property_set_value(connector, property, val);
1508	if (ret < 0)
1509		goto out;
1510
1511	if (property == dev->mode_config.tv_left_margin_property &&
1512		intel_tv->margin[TV_MARGIN_LEFT] != val) {
1513		intel_tv->margin[TV_MARGIN_LEFT] = val;
1514		changed = true;
1515	} else if (property == dev->mode_config.tv_right_margin_property &&
1516		intel_tv->margin[TV_MARGIN_RIGHT] != val) {
1517		intel_tv->margin[TV_MARGIN_RIGHT] = val;
1518		changed = true;
1519	} else if (property == dev->mode_config.tv_top_margin_property &&
1520		intel_tv->margin[TV_MARGIN_TOP] != val) {
1521		intel_tv->margin[TV_MARGIN_TOP] = val;
1522		changed = true;
1523	} else if (property == dev->mode_config.tv_bottom_margin_property &&
1524		intel_tv->margin[TV_MARGIN_BOTTOM] != val) {
1525		intel_tv->margin[TV_MARGIN_BOTTOM] = val;
1526		changed = true;
1527	} else if (property == dev->mode_config.tv_mode_property) {
1528		if (val >= ARRAY_SIZE(tv_modes)) {
1529			ret = -EINVAL;
1530			goto out;
1531		}
1532		if (!strcmp(intel_tv->tv_format, tv_modes[val].name))
1533			goto out;
1534
1535		intel_tv->tv_format = tv_modes[val].name;
1536		changed = true;
1537	} else {
1538		ret = -EINVAL;
1539		goto out;
1540	}
1541
1542	if (changed && crtc)
1543		drm_crtc_helper_set_mode(crtc, &crtc->mode, crtc->x,
1544				crtc->y, crtc->fb);
1545out:
1546	return ret;
1547}
1548
1549static const struct drm_encoder_helper_funcs intel_tv_helper_funcs = {
1550	.dpms = intel_tv_dpms,
1551	.mode_fixup = intel_tv_mode_fixup,
1552	.prepare = intel_encoder_prepare,
1553	.mode_set = intel_tv_mode_set,
1554	.commit = intel_encoder_commit,
1555};
1556
1557static const struct drm_connector_funcs intel_tv_connector_funcs = {
1558	.dpms = drm_helper_connector_dpms,
1559	.detect = intel_tv_detect,
1560	.destroy = intel_tv_destroy,
1561	.set_property = intel_tv_set_property,
1562	.fill_modes = drm_helper_probe_single_connector_modes,
1563};
1564
1565static const struct drm_connector_helper_funcs intel_tv_connector_helper_funcs = {
1566	.mode_valid = intel_tv_mode_valid,
1567	.get_modes = intel_tv_get_modes,
1568	.best_encoder = intel_best_encoder,
1569};
1570
1571static const struct drm_encoder_funcs intel_tv_enc_funcs = {
1572	.destroy = intel_encoder_destroy,
1573};
1574
1575/*
1576 * Enumerate the child dev array parsed from VBT to check whether
1577 * the integrated TV is present.
1578 * If it is present, return 1.
1579 * If it is not present, return false.
1580 * If no child dev is parsed from VBT, it assumes that the TV is present.
1581 */
1582static int tv_is_present_in_vbt(struct drm_device *dev)
1583{
1584	struct drm_i915_private *dev_priv = dev->dev_private;
1585	struct child_device_config *p_child;
1586	int i, ret;
1587
1588	if (!dev_priv->child_dev_num)
1589		return 1;
1590
1591	ret = 0;
1592	for (i = 0; i < dev_priv->child_dev_num; i++) {
1593		p_child = dev_priv->child_dev + i;
1594		/*
1595		 * If the device type is not TV, continue.
1596		 */
1597		if (p_child->device_type != DEVICE_TYPE_INT_TV &&
1598			p_child->device_type != DEVICE_TYPE_TV)
1599			continue;
1600		/* Only when the addin_offset is non-zero, it is regarded
1601		 * as present.
1602		 */
1603		if (p_child->addin_offset) {
1604			ret = 1;
1605			break;
1606		}
1607	}
1608	return ret;
1609}
1610
1611void
1612intel_tv_init(struct drm_device *dev)
1613{
1614	struct drm_i915_private *dev_priv = dev->dev_private;
1615	struct drm_connector *connector;
1616	struct intel_tv *intel_tv;
1617	struct intel_encoder *intel_encoder;
1618	struct intel_connector *intel_connector;
1619	u32 tv_dac_on, tv_dac_off, save_tv_dac;
1620	char *tv_format_names[ARRAY_SIZE(tv_modes)];
1621	int i, initial_mode = 0;
1622
1623	if ((I915_READ(TV_CTL) & TV_FUSE_STATE_MASK) == TV_FUSE_STATE_DISABLED)
1624		return;
1625
1626	if (!tv_is_present_in_vbt(dev)) {
1627		DRM_DEBUG_KMS("Integrated TV is not present.\n");
1628		return;
1629	}
1630	/* Even if we have an encoder we may not have a connector */
1631	if (!dev_priv->int_tv_support)
1632		return;
1633
1634	/*
1635	 * Sanity check the TV output by checking to see if the
1636	 * DAC register holds a value
1637	 */
1638	save_tv_dac = I915_READ(TV_DAC);
1639
1640	I915_WRITE(TV_DAC, save_tv_dac | TVDAC_STATE_CHG_EN);
1641	tv_dac_on = I915_READ(TV_DAC);
1642
1643	I915_WRITE(TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1644	tv_dac_off = I915_READ(TV_DAC);
1645
1646	I915_WRITE(TV_DAC, save_tv_dac);
1647
1648	/*
1649	 * If the register does not hold the state change enable
1650	 * bit, (either as a 0 or a 1), assume it doesn't really
1651	 * exist
1652	 */
1653	if ((tv_dac_on & TVDAC_STATE_CHG_EN) == 0 ||
1654	    (tv_dac_off & TVDAC_STATE_CHG_EN) != 0)
1655		return;
1656
1657	intel_tv = kzalloc(sizeof(struct intel_tv), GFP_KERNEL);
1658	if (!intel_tv) {
1659		return;
1660	}
1661
1662	intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
1663	if (!intel_connector) {
1664		kfree(intel_tv);
1665		return;
1666	}
1667
1668	intel_encoder = &intel_tv->base;
1669	connector = &intel_connector->base;
1670
1671	/* The documentation, for the older chipsets at least, recommend
1672	 * using a polling method rather than hotplug detection for TVs.
1673	 * This is because in order to perform the hotplug detection, the PLLs
1674	 * for the TV must be kept alive increasing power drain and starving
1675	 * bandwidth from other encoders. Notably for instance, it causes
1676	 * pipe underruns on Crestline when this encoder is supposedly idle.
1677	 *
1678	 * More recent chipsets favour HDMI rather than integrated S-Video.
1679	 */
1680	connector->polled = DRM_CONNECTOR_POLL_CONNECT;
1681
1682	drm_connector_init(dev, connector, &intel_tv_connector_funcs,
1683			   DRM_MODE_CONNECTOR_SVIDEO);
1684
1685	drm_encoder_init(dev, &intel_encoder->base, &intel_tv_enc_funcs,
1686			 DRM_MODE_ENCODER_TVDAC);
1687
1688	intel_connector_attach_encoder(intel_connector, intel_encoder);
1689	intel_encoder->type = INTEL_OUTPUT_TVOUT;
1690	intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
1691	intel_encoder->clone_mask = (1 << INTEL_TV_CLONE_BIT);
1692	intel_encoder->base.possible_crtcs = ((1 << 0) | (1 << 1));
1693	intel_encoder->base.possible_clones = (1 << INTEL_OUTPUT_TVOUT);
1694	intel_tv->type = DRM_MODE_CONNECTOR_Unknown;
1695
1696	/* BIOS margin values */
1697	intel_tv->margin[TV_MARGIN_LEFT] = 54;
1698	intel_tv->margin[TV_MARGIN_TOP] = 36;
1699	intel_tv->margin[TV_MARGIN_RIGHT] = 46;
1700	intel_tv->margin[TV_MARGIN_BOTTOM] = 37;
1701
1702	intel_tv->tv_format = tv_modes[initial_mode].name;
1703
1704	drm_encoder_helper_add(&intel_encoder->base, &intel_tv_helper_funcs);
1705	drm_connector_helper_add(connector, &intel_tv_connector_helper_funcs);
1706	connector->interlace_allowed = false;
1707	connector->doublescan_allowed = false;
1708
1709	/* Create TV properties then attach current values */
1710	for (i = 0; i < ARRAY_SIZE(tv_modes); i++)
1711		tv_format_names[i] = (char *)tv_modes[i].name;
1712	drm_mode_create_tv_properties(dev,
1713				      ARRAY_SIZE(tv_modes),
1714				      tv_format_names);
1715
1716	drm_connector_attach_property(connector, dev->mode_config.tv_mode_property,
1717				   initial_mode);
1718	drm_connector_attach_property(connector,
1719				   dev->mode_config.tv_left_margin_property,
1720				   intel_tv->margin[TV_MARGIN_LEFT]);
1721	drm_connector_attach_property(connector,
1722				   dev->mode_config.tv_top_margin_property,
1723				   intel_tv->margin[TV_MARGIN_TOP]);
1724	drm_connector_attach_property(connector,
1725				   dev->mode_config.tv_right_margin_property,
1726				   intel_tv->margin[TV_MARGIN_RIGHT]);
1727	drm_connector_attach_property(connector,
1728				   dev->mode_config.tv_bottom_margin_property,
1729				   intel_tv->margin[TV_MARGIN_BOTTOM]);
1730	drm_sysfs_connector_add(connector);
1731}
v3.5.6
   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
  41enum 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 */
  47struct intel_tv {
  48	struct intel_encoder base;
  49
  50	int type;
  51	const 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
  88struct video_levels {
  89	int blank, black, burst;
  90};
  91
  92struct color_conversion {
  93	u16 ry, gy, by, ay;
  94	u16 ru, gu, bu, au;
  95	u16 rv, gv, bv, av;
  96};
  97
  98static 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 */
 220static 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
 226static const struct video_levels ntsc_m_levels_composite = {
 227	.blank = 225, .black = 267, .burst = 113,
 228};
 229
 230static 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
 236static const struct video_levels ntsc_m_levels_svideo = {
 237	.blank = 266, .black = 316, .burst = 133,
 238};
 239
 240static 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
 246static const struct video_levels ntsc_j_levels_composite = {
 247	.blank = 225, .black = 225, .burst = 113,
 248};
 249
 250static 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
 256static const struct video_levels ntsc_j_levels_svideo = {
 257	.blank = 266, .black = 266, .burst = 133,
 258};
 259
 260static 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
 266static const struct video_levels pal_levels_composite = {
 267	.blank = 237, .black = 237, .burst = 118,
 268};
 269
 270static 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
 276static const struct video_levels pal_levels_svideo = {
 277	.blank = 280, .black = 280, .burst = 139,
 278};
 279
 280static 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
 286static const struct video_levels pal_m_levels_composite = {
 287	.blank = 225, .black = 267, .burst = 113,
 288};
 289
 290static 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
 296static const struct video_levels pal_m_levels_svideo = {
 297	.blank = 266, .black = 316, .burst = 133,
 298};
 299
 300static 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
 306static const struct video_levels pal_n_levels_composite = {
 307	.blank = 225, .black = 267, .burst = 118,
 308};
 309
 310static 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
 316static const struct video_levels pal_n_levels_svideo = {
 317	.blank = 266, .black = 316, .burst = 139,
 318};
 319
 320/*
 321 * Component connections
 322 */
 323static 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
 329static 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
 335static 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
 341static 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
 347static const struct video_levels component_levels = {
 348	.blank = 279, .black = 279, .burst = 0,
 349};
 350
 351
 352struct tv_mode {
 353	const 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
 416static const struct tv_mode tv_modes[] = {
 417	{
 418		.name		= "NTSC-M",
 419		.clock		= 108000,
 420		.refresh	= 59940,
 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	= 59940,
 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	= 59940,
 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	= 59940,
 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	= 50000,
 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	= 50000,
 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",
 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       = "576p",
 702		.clock		= 107520,
 703		.refresh	= 50000,
 704		.oversample     = TV_OVERSAMPLE_4X,
 705		.component_only = 1,
 706
 707		.hsync_end      = 64,               .hblank_end         = 139,
 708		.hblank_start   = 859,              .htotal             = 863,
 709
 710		.progressive    = true,		    .trilevel_sync = false,
 711
 712		.vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 713		.vsync_len      = 10,
 714
 715		.veq_ena        = false,
 716
 717		.vi_end_f1      = 48,               .vi_end_f2          = 48,
 718		.nbr_end        = 575,
 719
 720		.burst_ena      = false,
 721
 722		.filter_table = filter_table,
 723	},
 724	{
 725		.name       = "720p@60Hz",
 726		.clock		= 148800,
 727		.refresh	= 60000,
 728		.oversample     = TV_OVERSAMPLE_2X,
 729		.component_only = 1,
 730
 731		.hsync_end      = 80,               .hblank_end         = 300,
 732		.hblank_start   = 1580,             .htotal             = 1649,
 733
 734		.progressive	= true,		    .trilevel_sync = true,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 735
 736		.vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 737		.vsync_len      = 10,
 738
 739		.veq_ena        = false,
 740
 741		.vi_end_f1      = 29,               .vi_end_f2          = 29,
 742		.nbr_end        = 719,
 743
 744		.burst_ena      = false,
 745
 746		.filter_table = filter_table,
 747	},
 748	{
 749		.name       = "720p@50Hz",
 750		.clock		= 148800,
 751		.refresh	= 50000,
 752		.oversample     = TV_OVERSAMPLE_2X,
 753		.component_only = 1,
 754
 755		.hsync_end      = 80,               .hblank_end         = 300,
 756		.hblank_start   = 1580,             .htotal             = 1979,
 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		.max_srcw = 800
 772	},
 773	{
 774		.name       = "1080i@50Hz",
 775		.clock		= 148800,
 776		.refresh	= 50000,
 777		.oversample     = TV_OVERSAMPLE_2X,
 778		.component_only = 1,
 779
 780		.hsync_end      = 88,               .hblank_end         = 235,
 781		.hblank_start   = 2155,             .htotal             = 2639,
 782
 783		.progressive	= false,	  .trilevel_sync = true,
 784
 785		.vsync_start_f1 = 4,              .vsync_start_f2     = 5,
 786		.vsync_len      = 10,
 787
 788		.veq_ena	= true,	    .veq_start_f1	= 4,
 789		.veq_start_f2   = 4,	    .veq_len		= 10,
 790
 791
 792		.vi_end_f1      = 21,           .vi_end_f2          = 22,
 793		.nbr_end        = 539,
 794
 795		.burst_ena      = false,
 796
 797		.filter_table = filter_table,
 798	},
 799	{
 800		.name       = "1080i@60Hz",
 801		.clock		= 148800,
 802		.refresh	= 60000,
 803		.oversample     = TV_OVERSAMPLE_2X,
 804		.component_only = 1,
 805
 806		.hsync_end      = 88,               .hblank_end         = 235,
 807		.hblank_start   = 2155,             .htotal             = 2199,
 808
 809		.progressive	= false,	    .trilevel_sync = true,
 810
 811		.vsync_start_f1 = 4,               .vsync_start_f2     = 5,
 812		.vsync_len      = 10,
 813
 814		.veq_ena	= true,		    .veq_start_f1	= 4,
 815		.veq_start_f2	= 4,		    .veq_len		= 10,
 816
 817
 818		.vi_end_f1      = 21,               .vi_end_f2          = 22,
 819		.nbr_end        = 539,
 820
 821		.burst_ena      = false,
 822
 823		.filter_table = filter_table,
 824	},
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 825};
 826
 827static struct intel_tv *enc_to_intel_tv(struct drm_encoder *encoder)
 828{
 829	return container_of(encoder, struct intel_tv, base.base);
 830}
 831
 832static struct intel_tv *intel_attached_tv(struct drm_connector *connector)
 833{
 834	return container_of(intel_attached_encoder(connector),
 835			    struct intel_tv,
 836			    base);
 837}
 838
 839static void
 840intel_tv_dpms(struct drm_encoder *encoder, int mode)
 841{
 842	struct drm_device *dev = encoder->dev;
 843	struct drm_i915_private *dev_priv = dev->dev_private;
 844
 845	switch (mode) {
 846	case DRM_MODE_DPMS_ON:
 847		I915_WRITE(TV_CTL, I915_READ(TV_CTL) | TV_ENC_ENABLE);
 848		break;
 849	case DRM_MODE_DPMS_STANDBY:
 850	case DRM_MODE_DPMS_SUSPEND:
 851	case DRM_MODE_DPMS_OFF:
 852		I915_WRITE(TV_CTL, I915_READ(TV_CTL) & ~TV_ENC_ENABLE);
 853		break;
 854	}
 855}
 856
 857static const struct tv_mode *
 858intel_tv_mode_lookup(const char *tv_format)
 859{
 860	int i;
 861
 862	for (i = 0; i < ARRAY_SIZE(tv_modes); i++) {
 863		const struct tv_mode *tv_mode = &tv_modes[i];
 864
 865		if (!strcmp(tv_format, tv_mode->name))
 866			return tv_mode;
 867	}
 868	return NULL;
 869}
 870
 871static const struct tv_mode *
 872intel_tv_mode_find(struct intel_tv *intel_tv)
 873{
 874	return intel_tv_mode_lookup(intel_tv->tv_format);
 875}
 876
 877static enum drm_mode_status
 878intel_tv_mode_valid(struct drm_connector *connector,
 879		    struct drm_display_mode *mode)
 880{
 881	struct intel_tv *intel_tv = intel_attached_tv(connector);
 882	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 883
 884	/* Ensure TV refresh is close to desired refresh */
 885	if (tv_mode && abs(tv_mode->refresh - drm_mode_vrefresh(mode) * 1000)
 886				< 1000)
 887		return MODE_OK;
 888
 889	return MODE_CLOCK_RANGE;
 890}
 891
 892
 893static bool
 894intel_tv_mode_fixup(struct drm_encoder *encoder, struct drm_display_mode *mode,
 895		    struct drm_display_mode *adjusted_mode)
 896{
 897	struct drm_device *dev = encoder->dev;
 898	struct drm_mode_config *drm_config = &dev->mode_config;
 899	struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
 900	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 901	struct drm_encoder *other_encoder;
 902
 903	if (!tv_mode)
 904		return false;
 905
 906	/* FIXME: lock encoder list */
 907	list_for_each_entry(other_encoder, &drm_config->encoder_list, head) {
 908		if (other_encoder != encoder &&
 909		    other_encoder->crtc == encoder->crtc)
 910			return false;
 911	}
 912
 913	adjusted_mode->clock = tv_mode->clock;
 914	return true;
 915}
 916
 917static void
 918intel_tv_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
 919		  struct drm_display_mode *adjusted_mode)
 920{
 921	struct drm_device *dev = encoder->dev;
 922	struct drm_i915_private *dev_priv = dev->dev_private;
 923	struct drm_crtc *crtc = encoder->crtc;
 924	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
 925	struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
 926	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
 927	u32 tv_ctl;
 928	u32 hctl1, hctl2, hctl3;
 929	u32 vctl1, vctl2, vctl3, vctl4, vctl5, vctl6, vctl7;
 930	u32 scctl1, scctl2, scctl3;
 931	int i, j;
 932	const struct video_levels *video_levels;
 933	const struct color_conversion *color_conversion;
 934	bool burst_ena;
 935	int pipe = intel_crtc->pipe;
 936
 937	if (!tv_mode)
 938		return;	/* can't happen (mode_prepare prevents this) */
 939
 940	tv_ctl = I915_READ(TV_CTL);
 941	tv_ctl &= TV_CTL_SAVE;
 942
 943	switch (intel_tv->type) {
 944	default:
 945	case DRM_MODE_CONNECTOR_Unknown:
 946	case DRM_MODE_CONNECTOR_Composite:
 947		tv_ctl |= TV_ENC_OUTPUT_COMPOSITE;
 948		video_levels = tv_mode->composite_levels;
 949		color_conversion = tv_mode->composite_color;
 950		burst_ena = tv_mode->burst_ena;
 951		break;
 952	case DRM_MODE_CONNECTOR_Component:
 953		tv_ctl |= TV_ENC_OUTPUT_COMPONENT;
 954		video_levels = &component_levels;
 955		if (tv_mode->burst_ena)
 956			color_conversion = &sdtv_csc_yprpb;
 957		else
 958			color_conversion = &hdtv_csc_yprpb;
 959		burst_ena = false;
 960		break;
 961	case DRM_MODE_CONNECTOR_SVIDEO:
 962		tv_ctl |= TV_ENC_OUTPUT_SVIDEO;
 963		video_levels = tv_mode->svideo_levels;
 964		color_conversion = tv_mode->svideo_color;
 965		burst_ena = tv_mode->burst_ena;
 966		break;
 967	}
 968	hctl1 = (tv_mode->hsync_end << TV_HSYNC_END_SHIFT) |
 969		(tv_mode->htotal << TV_HTOTAL_SHIFT);
 970
 971	hctl2 = (tv_mode->hburst_start << 16) |
 972		(tv_mode->hburst_len << TV_HBURST_LEN_SHIFT);
 973
 974	if (burst_ena)
 975		hctl2 |= TV_BURST_ENA;
 976
 977	hctl3 = (tv_mode->hblank_start << TV_HBLANK_START_SHIFT) |
 978		(tv_mode->hblank_end << TV_HBLANK_END_SHIFT);
 979
 980	vctl1 = (tv_mode->nbr_end << TV_NBR_END_SHIFT) |
 981		(tv_mode->vi_end_f1 << TV_VI_END_F1_SHIFT) |
 982		(tv_mode->vi_end_f2 << TV_VI_END_F2_SHIFT);
 983
 984	vctl2 = (tv_mode->vsync_len << TV_VSYNC_LEN_SHIFT) |
 985		(tv_mode->vsync_start_f1 << TV_VSYNC_START_F1_SHIFT) |
 986		(tv_mode->vsync_start_f2 << TV_VSYNC_START_F2_SHIFT);
 987
 988	vctl3 = (tv_mode->veq_len << TV_VEQ_LEN_SHIFT) |
 989		(tv_mode->veq_start_f1 << TV_VEQ_START_F1_SHIFT) |
 990		(tv_mode->veq_start_f2 << TV_VEQ_START_F2_SHIFT);
 991
 992	if (tv_mode->veq_ena)
 993		vctl3 |= TV_EQUAL_ENA;
 994
 995	vctl4 = (tv_mode->vburst_start_f1 << TV_VBURST_START_F1_SHIFT) |
 996		(tv_mode->vburst_end_f1 << TV_VBURST_END_F1_SHIFT);
 997
 998	vctl5 = (tv_mode->vburst_start_f2 << TV_VBURST_START_F2_SHIFT) |
 999		(tv_mode->vburst_end_f2 << TV_VBURST_END_F2_SHIFT);
1000
1001	vctl6 = (tv_mode->vburst_start_f3 << TV_VBURST_START_F3_SHIFT) |
1002		(tv_mode->vburst_end_f3 << TV_VBURST_END_F3_SHIFT);
1003
1004	vctl7 = (tv_mode->vburst_start_f4 << TV_VBURST_START_F4_SHIFT) |
1005		(tv_mode->vburst_end_f4 << TV_VBURST_END_F4_SHIFT);
1006
1007	if (intel_crtc->pipe == 1)
1008		tv_ctl |= TV_ENC_PIPEB_SELECT;
1009	tv_ctl |= tv_mode->oversample;
1010
1011	if (tv_mode->progressive)
1012		tv_ctl |= TV_PROGRESSIVE;
1013	if (tv_mode->trilevel_sync)
1014		tv_ctl |= TV_TRILEVEL_SYNC;
1015	if (tv_mode->pal_burst)
1016		tv_ctl |= TV_PAL_BURST;
1017
1018	scctl1 = 0;
1019	if (tv_mode->dda1_inc)
1020		scctl1 |= TV_SC_DDA1_EN;
1021	if (tv_mode->dda2_inc)
1022		scctl1 |= TV_SC_DDA2_EN;
1023	if (tv_mode->dda3_inc)
1024		scctl1 |= TV_SC_DDA3_EN;
1025	scctl1 |= tv_mode->sc_reset;
1026	if (video_levels)
1027		scctl1 |= video_levels->burst << TV_BURST_LEVEL_SHIFT;
1028	scctl1 |= tv_mode->dda1_inc << TV_SCDDA1_INC_SHIFT;
1029
1030	scctl2 = tv_mode->dda2_size << TV_SCDDA2_SIZE_SHIFT |
1031		tv_mode->dda2_inc << TV_SCDDA2_INC_SHIFT;
1032
1033	scctl3 = tv_mode->dda3_size << TV_SCDDA3_SIZE_SHIFT |
1034		tv_mode->dda3_inc << TV_SCDDA3_INC_SHIFT;
1035
1036	/* Enable two fixes for the chips that need them. */
1037	if (dev->pci_device < 0x2772)
1038		tv_ctl |= TV_ENC_C0_FIX | TV_ENC_SDP_FIX;
1039
1040	I915_WRITE(TV_H_CTL_1, hctl1);
1041	I915_WRITE(TV_H_CTL_2, hctl2);
1042	I915_WRITE(TV_H_CTL_3, hctl3);
1043	I915_WRITE(TV_V_CTL_1, vctl1);
1044	I915_WRITE(TV_V_CTL_2, vctl2);
1045	I915_WRITE(TV_V_CTL_3, vctl3);
1046	I915_WRITE(TV_V_CTL_4, vctl4);
1047	I915_WRITE(TV_V_CTL_5, vctl5);
1048	I915_WRITE(TV_V_CTL_6, vctl6);
1049	I915_WRITE(TV_V_CTL_7, vctl7);
1050	I915_WRITE(TV_SC_CTL_1, scctl1);
1051	I915_WRITE(TV_SC_CTL_2, scctl2);
1052	I915_WRITE(TV_SC_CTL_3, scctl3);
1053
1054	if (color_conversion) {
1055		I915_WRITE(TV_CSC_Y, (color_conversion->ry << 16) |
1056			   color_conversion->gy);
1057		I915_WRITE(TV_CSC_Y2, (color_conversion->by << 16) |
1058			   color_conversion->ay);
1059		I915_WRITE(TV_CSC_U, (color_conversion->ru << 16) |
1060			   color_conversion->gu);
1061		I915_WRITE(TV_CSC_U2, (color_conversion->bu << 16) |
1062			   color_conversion->au);
1063		I915_WRITE(TV_CSC_V, (color_conversion->rv << 16) |
1064			   color_conversion->gv);
1065		I915_WRITE(TV_CSC_V2, (color_conversion->bv << 16) |
1066			   color_conversion->av);
1067	}
1068
1069	if (INTEL_INFO(dev)->gen >= 4)
1070		I915_WRITE(TV_CLR_KNOBS, 0x00404000);
1071	else
1072		I915_WRITE(TV_CLR_KNOBS, 0x00606000);
1073
1074	if (video_levels)
1075		I915_WRITE(TV_CLR_LEVEL,
1076			   ((video_levels->black << TV_BLACK_LEVEL_SHIFT) |
1077			    (video_levels->blank << TV_BLANK_LEVEL_SHIFT)));
1078	{
1079		int pipeconf_reg = PIPECONF(pipe);
1080		int dspcntr_reg = DSPCNTR(intel_crtc->plane);
1081		int pipeconf = I915_READ(pipeconf_reg);
1082		int dspcntr = I915_READ(dspcntr_reg);
1083		int dspbase_reg = DSPADDR(intel_crtc->plane);
1084		int xpos = 0x0, ypos = 0x0;
1085		unsigned int xsize, ysize;
1086		/* Pipe must be off here */
1087		I915_WRITE(dspcntr_reg, dspcntr & ~DISPLAY_PLANE_ENABLE);
1088		/* Flush the plane changes */
1089		I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1090
1091		/* Wait for vblank for the disable to take effect */
1092		if (IS_GEN2(dev))
1093			intel_wait_for_vblank(dev, intel_crtc->pipe);
1094
1095		I915_WRITE(pipeconf_reg, pipeconf & ~PIPECONF_ENABLE);
1096		/* Wait for vblank for the disable to take effect. */
1097		intel_wait_for_pipe_off(dev, intel_crtc->pipe);
1098
1099		/* Filter ctl must be set before TV_WIN_SIZE */
1100		I915_WRITE(TV_FILTER_CTL_1, TV_AUTO_SCALE);
1101		xsize = tv_mode->hblank_start - tv_mode->hblank_end;
1102		if (tv_mode->progressive)
1103			ysize = tv_mode->nbr_end + 1;
1104		else
1105			ysize = 2*tv_mode->nbr_end + 1;
1106
1107		xpos += intel_tv->margin[TV_MARGIN_LEFT];
1108		ypos += intel_tv->margin[TV_MARGIN_TOP];
1109		xsize -= (intel_tv->margin[TV_MARGIN_LEFT] +
1110			  intel_tv->margin[TV_MARGIN_RIGHT]);
1111		ysize -= (intel_tv->margin[TV_MARGIN_TOP] +
1112			  intel_tv->margin[TV_MARGIN_BOTTOM]);
1113		I915_WRITE(TV_WIN_POS, (xpos<<16)|ypos);
1114		I915_WRITE(TV_WIN_SIZE, (xsize<<16)|ysize);
1115
1116		I915_WRITE(pipeconf_reg, pipeconf);
1117		I915_WRITE(dspcntr_reg, dspcntr);
1118		/* Flush the plane changes */
1119		I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1120	}
1121
1122	j = 0;
1123	for (i = 0; i < 60; i++)
1124		I915_WRITE(TV_H_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1125	for (i = 0; i < 60; i++)
1126		I915_WRITE(TV_H_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1127	for (i = 0; i < 43; i++)
1128		I915_WRITE(TV_V_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1129	for (i = 0; i < 43; i++)
1130		I915_WRITE(TV_V_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1131	I915_WRITE(TV_DAC, I915_READ(TV_DAC) & TV_DAC_SAVE);
1132	I915_WRITE(TV_CTL, tv_ctl);
1133}
1134
1135static const struct drm_display_mode reported_modes[] = {
1136	{
1137		.name = "NTSC 480i",
1138		.clock = 107520,
1139		.hdisplay = 1280,
1140		.hsync_start = 1368,
1141		.hsync_end = 1496,
1142		.htotal = 1712,
1143
1144		.vdisplay = 1024,
1145		.vsync_start = 1027,
1146		.vsync_end = 1034,
1147		.vtotal = 1104,
1148		.type = DRM_MODE_TYPE_DRIVER,
1149	},
1150};
1151
1152/**
1153 * Detects TV presence by checking for load.
1154 *
1155 * Requires that the current pipe's DPLL is active.
1156
1157 * \return true if TV is connected.
1158 * \return false if TV is disconnected.
1159 */
1160static int
1161intel_tv_detect_type(struct intel_tv *intel_tv,
1162		      struct drm_connector *connector)
1163{
1164	struct drm_encoder *encoder = &intel_tv->base.base;
1165	struct drm_crtc *crtc = encoder->crtc;
1166	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
1167	struct drm_device *dev = encoder->dev;
1168	struct drm_i915_private *dev_priv = dev->dev_private;
1169	unsigned long irqflags;
1170	u32 tv_ctl, save_tv_ctl;
1171	u32 tv_dac, save_tv_dac;
1172	int type;
1173
1174	/* Disable TV interrupts around load detect or we'll recurse */
1175	if (connector->polled & DRM_CONNECTOR_POLL_HPD) {
1176		spin_lock_irqsave(&dev_priv->irq_lock, irqflags);
1177		i915_disable_pipestat(dev_priv, 0,
1178				      PIPE_HOTPLUG_INTERRUPT_ENABLE |
1179				      PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1180		spin_unlock_irqrestore(&dev_priv->irq_lock, irqflags);
1181	}
1182
1183	save_tv_dac = tv_dac = I915_READ(TV_DAC);
1184	save_tv_ctl = tv_ctl = I915_READ(TV_CTL);
1185
1186	/* Poll for TV detection */
1187	tv_ctl &= ~(TV_ENC_ENABLE | TV_TEST_MODE_MASK);
1188	tv_ctl |= TV_TEST_MODE_MONITOR_DETECT;
1189	if (intel_crtc->pipe == 1)
1190		tv_ctl |= TV_ENC_PIPEB_SELECT;
1191	else
1192		tv_ctl &= ~TV_ENC_PIPEB_SELECT;
1193
1194	tv_dac &= ~(TVDAC_SENSE_MASK | DAC_A_MASK | DAC_B_MASK | DAC_C_MASK);
1195	tv_dac |= (TVDAC_STATE_CHG_EN |
1196		   TVDAC_A_SENSE_CTL |
1197		   TVDAC_B_SENSE_CTL |
1198		   TVDAC_C_SENSE_CTL |
1199		   DAC_CTL_OVERRIDE |
1200		   DAC_A_0_7_V |
1201		   DAC_B_0_7_V |
1202		   DAC_C_0_7_V);
1203
1204
1205	/*
1206	 * The TV sense state should be cleared to zero on cantiga platform. Otherwise
1207	 * the TV is misdetected. This is hardware requirement.
1208	 */
1209	if (IS_GM45(dev))
1210		tv_dac &= ~(TVDAC_STATE_CHG_EN | TVDAC_A_SENSE_CTL |
1211			    TVDAC_B_SENSE_CTL | TVDAC_C_SENSE_CTL);
1212
1213	I915_WRITE(TV_CTL, tv_ctl);
1214	I915_WRITE(TV_DAC, tv_dac);
1215	POSTING_READ(TV_DAC);
1216
1217	intel_wait_for_vblank(intel_tv->base.base.dev,
1218			      to_intel_crtc(intel_tv->base.base.crtc)->pipe);
1219
1220	type = -1;
1221	tv_dac = I915_READ(TV_DAC);
1222	DRM_DEBUG_KMS("TV detected: %x, %x\n", tv_ctl, tv_dac);
1223	/*
1224	 *  A B C
1225	 *  0 1 1 Composite
1226	 *  1 0 X svideo
1227	 *  0 0 0 Component
1228	 */
1229	if ((tv_dac & TVDAC_SENSE_MASK) == (TVDAC_B_SENSE | TVDAC_C_SENSE)) {
1230		DRM_DEBUG_KMS("Detected Composite TV connection\n");
1231		type = DRM_MODE_CONNECTOR_Composite;
1232	} else if ((tv_dac & (TVDAC_A_SENSE|TVDAC_B_SENSE)) == TVDAC_A_SENSE) {
1233		DRM_DEBUG_KMS("Detected S-Video TV connection\n");
1234		type = DRM_MODE_CONNECTOR_SVIDEO;
1235	} else if ((tv_dac & TVDAC_SENSE_MASK) == 0) {
1236		DRM_DEBUG_KMS("Detected Component TV connection\n");
1237		type = DRM_MODE_CONNECTOR_Component;
1238	} else {
1239		DRM_DEBUG_KMS("Unrecognised TV connection\n");
1240		type = -1;
1241	}
1242
1243	I915_WRITE(TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1244	I915_WRITE(TV_CTL, save_tv_ctl);
1245	POSTING_READ(TV_CTL);
1246
1247	/* For unknown reasons the hw barfs if we don't do this vblank wait. */
1248	intel_wait_for_vblank(intel_tv->base.base.dev,
1249			      to_intel_crtc(intel_tv->base.base.crtc)->pipe);
1250
1251	/* Restore interrupt config */
1252	if (connector->polled & DRM_CONNECTOR_POLL_HPD) {
1253		spin_lock_irqsave(&dev_priv->irq_lock, irqflags);
1254		i915_enable_pipestat(dev_priv, 0,
1255				     PIPE_HOTPLUG_INTERRUPT_ENABLE |
1256				     PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1257		spin_unlock_irqrestore(&dev_priv->irq_lock, irqflags);
1258	}
1259
1260	return type;
1261}
1262
1263/*
1264 * Here we set accurate tv format according to connector type
1265 * i.e Component TV should not be assigned by NTSC or PAL
1266 */
1267static void intel_tv_find_better_format(struct drm_connector *connector)
1268{
1269	struct intel_tv *intel_tv = intel_attached_tv(connector);
1270	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1271	int i;
1272
1273	if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
1274		tv_mode->component_only)
1275		return;
1276
1277
1278	for (i = 0; i < sizeof(tv_modes) / sizeof(*tv_modes); i++) {
1279		tv_mode = tv_modes + i;
1280
1281		if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
1282			tv_mode->component_only)
1283			break;
1284	}
1285
1286	intel_tv->tv_format = tv_mode->name;
1287	drm_connector_property_set_value(connector,
1288		connector->dev->mode_config.tv_mode_property, i);
1289}
1290
1291/**
1292 * Detect the TV connection.
1293 *
1294 * Currently this always returns CONNECTOR_STATUS_UNKNOWN, as we need to be sure
1295 * we have a pipe programmed in order to probe the TV.
1296 */
1297static enum drm_connector_status
1298intel_tv_detect(struct drm_connector *connector, bool force)
1299{
1300	struct drm_display_mode mode;
1301	struct intel_tv *intel_tv = intel_attached_tv(connector);
1302	int type;
1303
1304	mode = reported_modes[0];
 
1305
1306	if (force) {
 
 
1307		struct intel_load_detect_pipe tmp;
1308
1309		if (intel_get_load_detect_pipe(&intel_tv->base, connector,
1310					       &mode, &tmp)) {
1311			type = intel_tv_detect_type(intel_tv, connector);
1312			intel_release_load_detect_pipe(&intel_tv->base,
1313						       connector,
1314						       &tmp);
1315		} else
1316			return connector_status_unknown;
1317	} else
1318		return connector->status;
1319
1320	if (type < 0)
1321		return connector_status_disconnected;
1322
1323	intel_tv->type = type;
1324	intel_tv_find_better_format(connector);
1325
1326	return connector_status_connected;
1327}
1328
1329static const struct input_res {
1330	const char *name;
1331	int w, h;
1332} input_res_table[] = {
1333	{"640x480", 640, 480},
1334	{"800x600", 800, 600},
1335	{"1024x768", 1024, 768},
1336	{"1280x1024", 1280, 1024},
1337	{"848x480", 848, 480},
1338	{"1280x720", 1280, 720},
1339	{"1920x1080", 1920, 1080},
1340};
1341
1342/*
1343 * Chose preferred mode  according to line number of TV format
1344 */
1345static void
1346intel_tv_chose_preferred_modes(struct drm_connector *connector,
1347			       struct drm_display_mode *mode_ptr)
1348{
1349	struct intel_tv *intel_tv = intel_attached_tv(connector);
1350	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1351
1352	if (tv_mode->nbr_end < 480 && mode_ptr->vdisplay == 480)
1353		mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1354	else if (tv_mode->nbr_end > 480) {
1355		if (tv_mode->progressive == true && tv_mode->nbr_end < 720) {
1356			if (mode_ptr->vdisplay == 720)
1357				mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1358		} else if (mode_ptr->vdisplay == 1080)
1359				mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1360	}
1361}
1362
1363/**
1364 * Stub get_modes function.
1365 *
1366 * This should probably return a set of fixed modes, unless we can figure out
1367 * how to probe modes off of TV connections.
1368 */
1369
1370static int
1371intel_tv_get_modes(struct drm_connector *connector)
1372{
1373	struct drm_display_mode *mode_ptr;
1374	struct intel_tv *intel_tv = intel_attached_tv(connector);
1375	const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
1376	int j, count = 0;
1377	u64 tmp;
1378
1379	for (j = 0; j < ARRAY_SIZE(input_res_table);
1380	     j++) {
1381		const struct input_res *input = &input_res_table[j];
1382		unsigned int hactive_s = input->w;
1383		unsigned int vactive_s = input->h;
1384
1385		if (tv_mode->max_srcw && input->w > tv_mode->max_srcw)
1386			continue;
1387
1388		if (input->w > 1024 && (!tv_mode->progressive
1389					&& !tv_mode->component_only))
1390			continue;
1391
1392		mode_ptr = drm_mode_create(connector->dev);
1393		if (!mode_ptr)
1394			continue;
1395		strncpy(mode_ptr->name, input->name, DRM_DISPLAY_MODE_LEN);
1396
1397		mode_ptr->hdisplay = hactive_s;
1398		mode_ptr->hsync_start = hactive_s + 1;
1399		mode_ptr->hsync_end = hactive_s + 64;
1400		if (mode_ptr->hsync_end <= mode_ptr->hsync_start)
1401			mode_ptr->hsync_end = mode_ptr->hsync_start + 1;
1402		mode_ptr->htotal = hactive_s + 96;
1403
1404		mode_ptr->vdisplay = vactive_s;
1405		mode_ptr->vsync_start = vactive_s + 1;
1406		mode_ptr->vsync_end = vactive_s + 32;
1407		if (mode_ptr->vsync_end <= mode_ptr->vsync_start)
1408			mode_ptr->vsync_end = mode_ptr->vsync_start  + 1;
1409		mode_ptr->vtotal = vactive_s + 33;
1410
1411		tmp = (u64) tv_mode->refresh * mode_ptr->vtotal;
1412		tmp *= mode_ptr->htotal;
1413		tmp = div_u64(tmp, 1000000);
1414		mode_ptr->clock = (int) tmp;
1415
1416		mode_ptr->type = DRM_MODE_TYPE_DRIVER;
1417		intel_tv_chose_preferred_modes(connector, mode_ptr);
1418		drm_mode_probed_add(connector, mode_ptr);
1419		count++;
1420	}
1421
1422	return count;
1423}
1424
1425static void
1426intel_tv_destroy(struct drm_connector *connector)
1427{
1428	drm_sysfs_connector_remove(connector);
1429	drm_connector_cleanup(connector);
1430	kfree(connector);
1431}
1432
1433
1434static int
1435intel_tv_set_property(struct drm_connector *connector, struct drm_property *property,
1436		      uint64_t val)
1437{
1438	struct drm_device *dev = connector->dev;
1439	struct intel_tv *intel_tv = intel_attached_tv(connector);
1440	struct drm_crtc *crtc = intel_tv->base.base.crtc;
1441	int ret = 0;
1442	bool changed = false;
1443
1444	ret = drm_connector_property_set_value(connector, property, val);
1445	if (ret < 0)
1446		goto out;
1447
1448	if (property == dev->mode_config.tv_left_margin_property &&
1449		intel_tv->margin[TV_MARGIN_LEFT] != val) {
1450		intel_tv->margin[TV_MARGIN_LEFT] = val;
1451		changed = true;
1452	} else if (property == dev->mode_config.tv_right_margin_property &&
1453		intel_tv->margin[TV_MARGIN_RIGHT] != val) {
1454		intel_tv->margin[TV_MARGIN_RIGHT] = val;
1455		changed = true;
1456	} else if (property == dev->mode_config.tv_top_margin_property &&
1457		intel_tv->margin[TV_MARGIN_TOP] != val) {
1458		intel_tv->margin[TV_MARGIN_TOP] = val;
1459		changed = true;
1460	} else if (property == dev->mode_config.tv_bottom_margin_property &&
1461		intel_tv->margin[TV_MARGIN_BOTTOM] != val) {
1462		intel_tv->margin[TV_MARGIN_BOTTOM] = val;
1463		changed = true;
1464	} else if (property == dev->mode_config.tv_mode_property) {
1465		if (val >= ARRAY_SIZE(tv_modes)) {
1466			ret = -EINVAL;
1467			goto out;
1468		}
1469		if (!strcmp(intel_tv->tv_format, tv_modes[val].name))
1470			goto out;
1471
1472		intel_tv->tv_format = tv_modes[val].name;
1473		changed = true;
1474	} else {
1475		ret = -EINVAL;
1476		goto out;
1477	}
1478
1479	if (changed && crtc)
1480		drm_crtc_helper_set_mode(crtc, &crtc->mode, crtc->x,
1481				crtc->y, crtc->fb);
1482out:
1483	return ret;
1484}
1485
1486static const struct drm_encoder_helper_funcs intel_tv_helper_funcs = {
1487	.dpms = intel_tv_dpms,
1488	.mode_fixup = intel_tv_mode_fixup,
1489	.prepare = intel_encoder_prepare,
1490	.mode_set = intel_tv_mode_set,
1491	.commit = intel_encoder_commit,
1492};
1493
1494static const struct drm_connector_funcs intel_tv_connector_funcs = {
1495	.dpms = drm_helper_connector_dpms,
1496	.detect = intel_tv_detect,
1497	.destroy = intel_tv_destroy,
1498	.set_property = intel_tv_set_property,
1499	.fill_modes = drm_helper_probe_single_connector_modes,
1500};
1501
1502static const struct drm_connector_helper_funcs intel_tv_connector_helper_funcs = {
1503	.mode_valid = intel_tv_mode_valid,
1504	.get_modes = intel_tv_get_modes,
1505	.best_encoder = intel_best_encoder,
1506};
1507
1508static const struct drm_encoder_funcs intel_tv_enc_funcs = {
1509	.destroy = intel_encoder_destroy,
1510};
1511
1512/*
1513 * Enumerate the child dev array parsed from VBT to check whether
1514 * the integrated TV is present.
1515 * If it is present, return 1.
1516 * If it is not present, return false.
1517 * If no child dev is parsed from VBT, it assumes that the TV is present.
1518 */
1519static int tv_is_present_in_vbt(struct drm_device *dev)
1520{
1521	struct drm_i915_private *dev_priv = dev->dev_private;
1522	struct child_device_config *p_child;
1523	int i, ret;
1524
1525	if (!dev_priv->child_dev_num)
1526		return 1;
1527
1528	ret = 0;
1529	for (i = 0; i < dev_priv->child_dev_num; i++) {
1530		p_child = dev_priv->child_dev + i;
1531		/*
1532		 * If the device type is not TV, continue.
1533		 */
1534		if (p_child->device_type != DEVICE_TYPE_INT_TV &&
1535			p_child->device_type != DEVICE_TYPE_TV)
1536			continue;
1537		/* Only when the addin_offset is non-zero, it is regarded
1538		 * as present.
1539		 */
1540		if (p_child->addin_offset) {
1541			ret = 1;
1542			break;
1543		}
1544	}
1545	return ret;
1546}
1547
1548void
1549intel_tv_init(struct drm_device *dev)
1550{
1551	struct drm_i915_private *dev_priv = dev->dev_private;
1552	struct drm_connector *connector;
1553	struct intel_tv *intel_tv;
1554	struct intel_encoder *intel_encoder;
1555	struct intel_connector *intel_connector;
1556	u32 tv_dac_on, tv_dac_off, save_tv_dac;
1557	char *tv_format_names[ARRAY_SIZE(tv_modes)];
1558	int i, initial_mode = 0;
1559
1560	if ((I915_READ(TV_CTL) & TV_FUSE_STATE_MASK) == TV_FUSE_STATE_DISABLED)
1561		return;
1562
1563	if (!tv_is_present_in_vbt(dev)) {
1564		DRM_DEBUG_KMS("Integrated TV is not present.\n");
1565		return;
1566	}
1567	/* Even if we have an encoder we may not have a connector */
1568	if (!dev_priv->int_tv_support)
1569		return;
1570
1571	/*
1572	 * Sanity check the TV output by checking to see if the
1573	 * DAC register holds a value
1574	 */
1575	save_tv_dac = I915_READ(TV_DAC);
1576
1577	I915_WRITE(TV_DAC, save_tv_dac | TVDAC_STATE_CHG_EN);
1578	tv_dac_on = I915_READ(TV_DAC);
1579
1580	I915_WRITE(TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1581	tv_dac_off = I915_READ(TV_DAC);
1582
1583	I915_WRITE(TV_DAC, save_tv_dac);
1584
1585	/*
1586	 * If the register does not hold the state change enable
1587	 * bit, (either as a 0 or a 1), assume it doesn't really
1588	 * exist
1589	 */
1590	if ((tv_dac_on & TVDAC_STATE_CHG_EN) == 0 ||
1591	    (tv_dac_off & TVDAC_STATE_CHG_EN) != 0)
1592		return;
1593
1594	intel_tv = kzalloc(sizeof(struct intel_tv), GFP_KERNEL);
1595	if (!intel_tv) {
1596		return;
1597	}
1598
1599	intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
1600	if (!intel_connector) {
1601		kfree(intel_tv);
1602		return;
1603	}
1604
1605	intel_encoder = &intel_tv->base;
1606	connector = &intel_connector->base;
1607
1608	/* The documentation, for the older chipsets at least, recommend
1609	 * using a polling method rather than hotplug detection for TVs.
1610	 * This is because in order to perform the hotplug detection, the PLLs
1611	 * for the TV must be kept alive increasing power drain and starving
1612	 * bandwidth from other encoders. Notably for instance, it causes
1613	 * pipe underruns on Crestline when this encoder is supposedly idle.
1614	 *
1615	 * More recent chipsets favour HDMI rather than integrated S-Video.
1616	 */
1617	connector->polled = DRM_CONNECTOR_POLL_CONNECT;
1618
1619	drm_connector_init(dev, connector, &intel_tv_connector_funcs,
1620			   DRM_MODE_CONNECTOR_SVIDEO);
1621
1622	drm_encoder_init(dev, &intel_encoder->base, &intel_tv_enc_funcs,
1623			 DRM_MODE_ENCODER_TVDAC);
1624
1625	intel_connector_attach_encoder(intel_connector, intel_encoder);
1626	intel_encoder->type = INTEL_OUTPUT_TVOUT;
1627	intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
1628	intel_encoder->clone_mask = (1 << INTEL_TV_CLONE_BIT);
1629	intel_encoder->base.possible_crtcs = ((1 << 0) | (1 << 1));
1630	intel_encoder->base.possible_clones = (1 << INTEL_OUTPUT_TVOUT);
1631	intel_tv->type = DRM_MODE_CONNECTOR_Unknown;
1632
1633	/* BIOS margin values */
1634	intel_tv->margin[TV_MARGIN_LEFT] = 54;
1635	intel_tv->margin[TV_MARGIN_TOP] = 36;
1636	intel_tv->margin[TV_MARGIN_RIGHT] = 46;
1637	intel_tv->margin[TV_MARGIN_BOTTOM] = 37;
1638
1639	intel_tv->tv_format = tv_modes[initial_mode].name;
1640
1641	drm_encoder_helper_add(&intel_encoder->base, &intel_tv_helper_funcs);
1642	drm_connector_helper_add(connector, &intel_tv_connector_helper_funcs);
1643	connector->interlace_allowed = false;
1644	connector->doublescan_allowed = false;
1645
1646	/* Create TV properties then attach current values */
1647	for (i = 0; i < ARRAY_SIZE(tv_modes); i++)
1648		tv_format_names[i] = (char *)tv_modes[i].name;
1649	drm_mode_create_tv_properties(dev,
1650				      ARRAY_SIZE(tv_modes),
1651				      tv_format_names);
1652
1653	drm_connector_attach_property(connector, dev->mode_config.tv_mode_property,
1654				   initial_mode);
1655	drm_connector_attach_property(connector,
1656				   dev->mode_config.tv_left_margin_property,
1657				   intel_tv->margin[TV_MARGIN_LEFT]);
1658	drm_connector_attach_property(connector,
1659				   dev->mode_config.tv_top_margin_property,
1660				   intel_tv->margin[TV_MARGIN_TOP]);
1661	drm_connector_attach_property(connector,
1662				   dev->mode_config.tv_right_margin_property,
1663				   intel_tv->margin[TV_MARGIN_RIGHT]);
1664	drm_connector_attach_property(connector,
1665				   dev->mode_config.tv_bottom_margin_property,
1666				   intel_tv->margin[TV_MARGIN_BOTTOM]);
1667	drm_sysfs_connector_add(connector);
1668}