Linux Audio

Check our new training course

Loading...
Note: File does not exist in v4.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 <drm/drm_atomic_helper.h>
  34#include <drm/drm_crtc.h>
  35#include <drm/drm_edid.h>
  36
  37#include "i915_drv.h"
  38#include "intel_connector.h"
  39#include "intel_display_types.h"
  40#include "intel_hotplug.h"
  41#include "intel_tv.h"
  42
  43enum tv_margin {
  44	TV_MARGIN_LEFT, TV_MARGIN_TOP,
  45	TV_MARGIN_RIGHT, TV_MARGIN_BOTTOM
  46};
  47
  48struct intel_tv {
  49	struct intel_encoder base;
  50
  51	int type;
  52};
  53
  54struct video_levels {
  55	u16 blank, black;
  56	u8 burst;
  57};
  58
  59struct color_conversion {
  60	u16 ry, gy, by, ay;
  61	u16 ru, gu, bu, au;
  62	u16 rv, gv, bv, av;
  63};
  64
  65static const u32 filter_table[] = {
  66	0xB1403000, 0x2E203500, 0x35002E20, 0x3000B140,
  67	0x35A0B160, 0x2DC02E80, 0xB1403480, 0xB1603000,
  68	0x2EA03640, 0x34002D80, 0x3000B120, 0x36E0B160,
  69	0x2D202EF0, 0xB1203380, 0xB1603000, 0x2F303780,
  70	0x33002CC0, 0x3000B100, 0x3820B160, 0x2C802F50,
  71	0xB10032A0, 0xB1603000, 0x2F9038C0, 0x32202C20,
  72	0x3000B0E0, 0x3980B160, 0x2BC02FC0, 0xB0E031C0,
  73	0xB1603000, 0x2FF03A20, 0x31602B60, 0xB020B0C0,
  74	0x3AE0B160, 0x2B001810, 0xB0C03120, 0xB140B020,
  75	0x18283BA0, 0x30C02A80, 0xB020B0A0, 0x3C60B140,
  76	0x2A201838, 0xB0A03080, 0xB120B020, 0x18383D20,
  77	0x304029C0, 0xB040B080, 0x3DE0B100, 0x29601848,
  78	0xB0803000, 0xB100B040, 0x18483EC0, 0xB0402900,
  79	0xB040B060, 0x3F80B0C0, 0x28801858, 0xB060B080,
  80	0xB0A0B060, 0x18602820, 0xB0A02820, 0x0000B060,
  81	0xB1403000, 0x2E203500, 0x35002E20, 0x3000B140,
  82	0x35A0B160, 0x2DC02E80, 0xB1403480, 0xB1603000,
  83	0x2EA03640, 0x34002D80, 0x3000B120, 0x36E0B160,
  84	0x2D202EF0, 0xB1203380, 0xB1603000, 0x2F303780,
  85	0x33002CC0, 0x3000B100, 0x3820B160, 0x2C802F50,
  86	0xB10032A0, 0xB1603000, 0x2F9038C0, 0x32202C20,
  87	0x3000B0E0, 0x3980B160, 0x2BC02FC0, 0xB0E031C0,
  88	0xB1603000, 0x2FF03A20, 0x31602B60, 0xB020B0C0,
  89	0x3AE0B160, 0x2B001810, 0xB0C03120, 0xB140B020,
  90	0x18283BA0, 0x30C02A80, 0xB020B0A0, 0x3C60B140,
  91	0x2A201838, 0xB0A03080, 0xB120B020, 0x18383D20,
  92	0x304029C0, 0xB040B080, 0x3DE0B100, 0x29601848,
  93	0xB0803000, 0xB100B040, 0x18483EC0, 0xB0402900,
  94	0xB040B060, 0x3F80B0C0, 0x28801858, 0xB060B080,
  95	0xB0A0B060, 0x18602820, 0xB0A02820, 0x0000B060,
  96	0x36403000, 0x2D002CC0, 0x30003640, 0x2D0036C0,
  97	0x35C02CC0, 0x37403000, 0x2C802D40, 0x30003540,
  98	0x2D8037C0, 0x34C02C40, 0x38403000, 0x2BC02E00,
  99	0x30003440, 0x2E2038C0, 0x34002B80, 0x39803000,
 100	0x2B402E40, 0x30003380, 0x2E603A00, 0x33402B00,
 101	0x3A803040, 0x2A802EA0, 0x30403300, 0x2EC03B40,
 102	0x32802A40, 0x3C003040, 0x2A002EC0, 0x30803240,
 103	0x2EC03C80, 0x320029C0, 0x3D403080, 0x29402F00,
 104	0x308031C0, 0x2F203DC0, 0x31802900, 0x3E8030C0,
 105	0x28802F40, 0x30C03140, 0x2F203F40, 0x31402840,
 106	0x28003100, 0x28002F00, 0x00003100, 0x36403000,
 107	0x2D002CC0, 0x30003640, 0x2D0036C0,
 108	0x35C02CC0, 0x37403000, 0x2C802D40, 0x30003540,
 109	0x2D8037C0, 0x34C02C40, 0x38403000, 0x2BC02E00,
 110	0x30003440, 0x2E2038C0, 0x34002B80, 0x39803000,
 111	0x2B402E40, 0x30003380, 0x2E603A00, 0x33402B00,
 112	0x3A803040, 0x2A802EA0, 0x30403300, 0x2EC03B40,
 113	0x32802A40, 0x3C003040, 0x2A002EC0, 0x30803240,
 114	0x2EC03C80, 0x320029C0, 0x3D403080, 0x29402F00,
 115	0x308031C0, 0x2F203DC0, 0x31802900, 0x3E8030C0,
 116	0x28802F40, 0x30C03140, 0x2F203F40, 0x31402840,
 117	0x28003100, 0x28002F00, 0x00003100,
 118};
 119
 120/*
 121 * Color conversion values have 3 separate fixed point formats:
 122 *
 123 * 10 bit fields (ay, au)
 124 *   1.9 fixed point (b.bbbbbbbbb)
 125 * 11 bit fields (ry, by, ru, gu, gv)
 126 *   exp.mantissa (ee.mmmmmmmmm)
 127 *   ee = 00 = 10^-1 (0.mmmmmmmmm)
 128 *   ee = 01 = 10^-2 (0.0mmmmmmmmm)
 129 *   ee = 10 = 10^-3 (0.00mmmmmmmmm)
 130 *   ee = 11 = 10^-4 (0.000mmmmmmmmm)
 131 * 12 bit fields (gy, rv, bu)
 132 *   exp.mantissa (eee.mmmmmmmmm)
 133 *   eee = 000 = 10^-1 (0.mmmmmmmmm)
 134 *   eee = 001 = 10^-2 (0.0mmmmmmmmm)
 135 *   eee = 010 = 10^-3 (0.00mmmmmmmmm)
 136 *   eee = 011 = 10^-4 (0.000mmmmmmmmm)
 137 *   eee = 100 = reserved
 138 *   eee = 101 = reserved
 139 *   eee = 110 = reserved
 140 *   eee = 111 = 10^0 (m.mmmmmmmm) (only usable for 1.0 representation)
 141 *
 142 * Saturation and contrast are 8 bits, with their own representation:
 143 * 8 bit field (saturation, contrast)
 144 *   exp.mantissa (ee.mmmmmm)
 145 *   ee = 00 = 10^-1 (0.mmmmmm)
 146 *   ee = 01 = 10^0 (m.mmmmm)
 147 *   ee = 10 = 10^1 (mm.mmmm)
 148 *   ee = 11 = 10^2 (mmm.mmm)
 149 *
 150 * Simple conversion function:
 151 *
 152 * static u32
 153 * float_to_csc_11(float f)
 154 * {
 155 *     u32 exp;
 156 *     u32 mant;
 157 *     u32 ret;
 158 *
 159 *     if (f < 0)
 160 *         f = -f;
 161 *
 162 *     if (f >= 1) {
 163 *         exp = 0x7;
 164 *	   mant = 1 << 8;
 165 *     } else {
 166 *         for (exp = 0; exp < 3 && f < 0.5; exp++)
 167 *	   f *= 2.0;
 168 *         mant = (f * (1 << 9) + 0.5);
 169 *         if (mant >= (1 << 9))
 170 *             mant = (1 << 9) - 1;
 171 *     }
 172 *     ret = (exp << 9) | mant;
 173 *     return ret;
 174 * }
 175 */
 176
 177/*
 178 * Behold, magic numbers!  If we plant them they might grow a big
 179 * s-video cable to the sky... or something.
 180 *
 181 * Pre-converted to appropriate hex value.
 182 */
 183
 184/*
 185 * PAL & NTSC values for composite & s-video connections
 186 */
 187static const struct color_conversion ntsc_m_csc_composite = {
 188	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0104,
 189	.ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
 190	.rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
 191};
 192
 193static const struct video_levels ntsc_m_levels_composite = {
 194	.blank = 225, .black = 267, .burst = 113,
 195};
 196
 197static const struct color_conversion ntsc_m_csc_svideo = {
 198	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0133,
 199	.ru = 0x076a, .gu = 0x0564, .bu = 0x030d, .au = 0x0200,
 200	.rv = 0x037a, .gv = 0x033d, .bv = 0x06f6, .av = 0x0200,
 201};
 202
 203static const struct video_levels ntsc_m_levels_svideo = {
 204	.blank = 266, .black = 316, .burst = 133,
 205};
 206
 207static const struct color_conversion ntsc_j_csc_composite = {
 208	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0119,
 209	.ru = 0x074c, .gu = 0x0546, .bu = 0x05ec, .au = 0x0200,
 210	.rv = 0x035a, .gv = 0x0322, .bv = 0x06e1, .av = 0x0200,
 211};
 212
 213static const struct video_levels ntsc_j_levels_composite = {
 214	.blank = 225, .black = 225, .burst = 113,
 215};
 216
 217static const struct color_conversion ntsc_j_csc_svideo = {
 218	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x014c,
 219	.ru = 0x0788, .gu = 0x0581, .bu = 0x0322, .au = 0x0200,
 220	.rv = 0x0399, .gv = 0x0356, .bv = 0x070a, .av = 0x0200,
 221};
 222
 223static const struct video_levels ntsc_j_levels_svideo = {
 224	.blank = 266, .black = 266, .burst = 133,
 225};
 226
 227static const struct color_conversion pal_csc_composite = {
 228	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0113,
 229	.ru = 0x0745, .gu = 0x053f, .bu = 0x05e1, .au = 0x0200,
 230	.rv = 0x0353, .gv = 0x031c, .bv = 0x06dc, .av = 0x0200,
 231};
 232
 233static const struct video_levels pal_levels_composite = {
 234	.blank = 237, .black = 237, .burst = 118,
 235};
 236
 237static const struct color_conversion pal_csc_svideo = {
 238	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0145,
 239	.ru = 0x0780, .gu = 0x0579, .bu = 0x031c, .au = 0x0200,
 240	.rv = 0x0390, .gv = 0x034f, .bv = 0x0705, .av = 0x0200,
 241};
 242
 243static const struct video_levels pal_levels_svideo = {
 244	.blank = 280, .black = 280, .burst = 139,
 245};
 246
 247static const struct color_conversion pal_m_csc_composite = {
 248	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0104,
 249	.ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
 250	.rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
 251};
 252
 253static const struct video_levels pal_m_levels_composite = {
 254	.blank = 225, .black = 267, .burst = 113,
 255};
 256
 257static const struct color_conversion pal_m_csc_svideo = {
 258	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0133,
 259	.ru = 0x076a, .gu = 0x0564, .bu = 0x030d, .au = 0x0200,
 260	.rv = 0x037a, .gv = 0x033d, .bv = 0x06f6, .av = 0x0200,
 261};
 262
 263static const struct video_levels pal_m_levels_svideo = {
 264	.blank = 266, .black = 316, .burst = 133,
 265};
 266
 267static const struct color_conversion pal_n_csc_composite = {
 268	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0104,
 269	.ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
 270	.rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
 271};
 272
 273static const struct video_levels pal_n_levels_composite = {
 274	.blank = 225, .black = 267, .burst = 118,
 275};
 276
 277static const struct color_conversion pal_n_csc_svideo = {
 278	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0133,
 279	.ru = 0x076a, .gu = 0x0564, .bu = 0x030d, .au = 0x0200,
 280	.rv = 0x037a, .gv = 0x033d, .bv = 0x06f6, .av = 0x0200,
 281};
 282
 283static const struct video_levels pal_n_levels_svideo = {
 284	.blank = 266, .black = 316, .burst = 139,
 285};
 286
 287/*
 288 * Component connections
 289 */
 290static const struct color_conversion sdtv_csc_yprpb = {
 291	.ry = 0x0332, .gy = 0x012d, .by = 0x07d3, .ay = 0x0145,
 292	.ru = 0x0559, .gu = 0x0353, .bu = 0x0100, .au = 0x0200,
 293	.rv = 0x0100, .gv = 0x03ad, .bv = 0x074d, .av = 0x0200,
 294};
 295
 296static const struct color_conversion hdtv_csc_yprpb = {
 297	.ry = 0x05b3, .gy = 0x016e, .by = 0x0728, .ay = 0x0145,
 298	.ru = 0x07d5, .gu = 0x038b, .bu = 0x0100, .au = 0x0200,
 299	.rv = 0x0100, .gv = 0x03d1, .bv = 0x06bc, .av = 0x0200,
 300};
 301
 302static const struct video_levels component_levels = {
 303	.blank = 279, .black = 279, .burst = 0,
 304};
 305
 306
 307struct tv_mode {
 308	const char *name;
 309
 310	u32 clock;
 311	u16 refresh; /* in millihertz (for precision) */
 312	u8 oversample;
 313	u8 hsync_end;
 314	u16 hblank_start, hblank_end, htotal;
 315	bool progressive : 1, trilevel_sync : 1, component_only : 1;
 316	u8 vsync_start_f1, vsync_start_f2, vsync_len;
 317	bool veq_ena : 1;
 318	u8 veq_start_f1, veq_start_f2, veq_len;
 319	u8 vi_end_f1, vi_end_f2;
 320	u16 nbr_end;
 321	bool burst_ena : 1;
 322	u8 hburst_start, hburst_len;
 323	u8 vburst_start_f1;
 324	u16 vburst_end_f1;
 325	u8 vburst_start_f2;
 326	u16 vburst_end_f2;
 327	u8 vburst_start_f3;
 328	u16 vburst_end_f3;
 329	u8 vburst_start_f4;
 330	u16 vburst_end_f4;
 331	/*
 332	 * subcarrier programming
 333	 */
 334	u16 dda2_size, dda3_size;
 335	u8 dda1_inc;
 336	u16 dda2_inc, dda3_inc;
 337	u32 sc_reset;
 338	bool pal_burst : 1;
 339	/*
 340	 * blank/black levels
 341	 */
 342	const struct video_levels *composite_levels, *svideo_levels;
 343	const struct color_conversion *composite_color, *svideo_color;
 344	const u32 *filter_table;
 345};
 346
 347
 348/*
 349 * Sub carrier DDA
 350 *
 351 *  I think this works as follows:
 352 *
 353 *  subcarrier freq = pixel_clock * (dda1_inc + dda2_inc / dda2_size) / 4096
 354 *
 355 * Presumably, when dda3 is added in, it gets to adjust the dda2_inc value
 356 *
 357 * So,
 358 *  dda1_ideal = subcarrier/pixel * 4096
 359 *  dda1_inc = floor (dda1_ideal)
 360 *  dda2 = dda1_ideal - dda1_inc
 361 *
 362 *  then pick a ratio for dda2 that gives the closest approximation. If
 363 *  you can't get close enough, you can play with dda3 as well. This
 364 *  seems likely to happen when dda2 is small as the jumps would be larger
 365 *
 366 * To invert this,
 367 *
 368 *  pixel_clock = subcarrier * 4096 / (dda1_inc + dda2_inc / dda2_size)
 369 *
 370 * The constants below were all computed using a 107.520MHz clock
 371 */
 372
 373/*
 374 * Register programming values for TV modes.
 375 *
 376 * These values account for -1s required.
 377 */
 378static const struct tv_mode tv_modes[] = {
 379	{
 380		.name		= "NTSC-M",
 381		.clock		= 108000,
 382		.refresh	= 59940,
 383		.oversample	= 8,
 384		.component_only = false,
 385		/* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 3.580MHz */
 386
 387		.hsync_end	= 64,		    .hblank_end		= 124,
 388		.hblank_start	= 836,		    .htotal		= 857,
 389
 390		.progressive	= false,	    .trilevel_sync = false,
 391
 392		.vsync_start_f1	= 6,		    .vsync_start_f2	= 7,
 393		.vsync_len	= 6,
 394
 395		.veq_ena	= true,		    .veq_start_f1	= 0,
 396		.veq_start_f2	= 1,		    .veq_len		= 18,
 397
 398		.vi_end_f1	= 20,		    .vi_end_f2		= 21,
 399		.nbr_end	= 240,
 400
 401		.burst_ena	= true,
 402		.hburst_start	= 72,		    .hburst_len		= 34,
 403		.vburst_start_f1 = 9,		    .vburst_end_f1	= 240,
 404		.vburst_start_f2 = 10,		    .vburst_end_f2	= 240,
 405		.vburst_start_f3 = 9,		    .vburst_end_f3	= 240,
 406		.vburst_start_f4 = 10,		    .vburst_end_f4	= 240,
 407
 408		/* desired 3.5800000 actual 3.5800000 clock 107.52 */
 409		.dda1_inc	=    135,
 410		.dda2_inc	=  20800,	    .dda2_size		=  27456,
 411		.dda3_inc	=      0,	    .dda3_size		=      0,
 412		.sc_reset	= TV_SC_RESET_EVERY_4,
 413		.pal_burst	= false,
 414
 415		.composite_levels = &ntsc_m_levels_composite,
 416		.composite_color = &ntsc_m_csc_composite,
 417		.svideo_levels  = &ntsc_m_levels_svideo,
 418		.svideo_color = &ntsc_m_csc_svideo,
 419
 420		.filter_table = filter_table,
 421	},
 422	{
 423		.name		= "NTSC-443",
 424		.clock		= 108000,
 425		.refresh	= 59940,
 426		.oversample	= 8,
 427		.component_only = false,
 428		/* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 4.43MHz */
 429		.hsync_end	= 64,		    .hblank_end		= 124,
 430		.hblank_start	= 836,		    .htotal		= 857,
 431
 432		.progressive	= false,	    .trilevel_sync = false,
 433
 434		.vsync_start_f1 = 6,		    .vsync_start_f2	= 7,
 435		.vsync_len	= 6,
 436
 437		.veq_ena	= true,		    .veq_start_f1	= 0,
 438		.veq_start_f2	= 1,		    .veq_len		= 18,
 439
 440		.vi_end_f1	= 20,		    .vi_end_f2		= 21,
 441		.nbr_end	= 240,
 442
 443		.burst_ena	= true,
 444		.hburst_start	= 72,		    .hburst_len		= 34,
 445		.vburst_start_f1 = 9,		    .vburst_end_f1	= 240,
 446		.vburst_start_f2 = 10,		    .vburst_end_f2	= 240,
 447		.vburst_start_f3 = 9,		    .vburst_end_f3	= 240,
 448		.vburst_start_f4 = 10,		    .vburst_end_f4	= 240,
 449
 450		/* desired 4.4336180 actual 4.4336180 clock 107.52 */
 451		.dda1_inc       =    168,
 452		.dda2_inc       =   4093,       .dda2_size      =  27456,
 453		.dda3_inc       =    310,       .dda3_size      =    525,
 454		.sc_reset   = TV_SC_RESET_NEVER,
 455		.pal_burst  = false,
 456
 457		.composite_levels = &ntsc_m_levels_composite,
 458		.composite_color = &ntsc_m_csc_composite,
 459		.svideo_levels  = &ntsc_m_levels_svideo,
 460		.svideo_color = &ntsc_m_csc_svideo,
 461
 462		.filter_table = filter_table,
 463	},
 464	{
 465		.name		= "NTSC-J",
 466		.clock		= 108000,
 467		.refresh	= 59940,
 468		.oversample	= 8,
 469		.component_only = false,
 470
 471		/* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 3.580MHz */
 472		.hsync_end	= 64,		    .hblank_end		= 124,
 473		.hblank_start = 836,	    .htotal		= 857,
 474
 475		.progressive	= false,    .trilevel_sync = false,
 476
 477		.vsync_start_f1	= 6,	    .vsync_start_f2	= 7,
 478		.vsync_len	= 6,
 479
 480		.veq_ena      = true,	    .veq_start_f1	= 0,
 481		.veq_start_f2 = 1,	    .veq_len		= 18,
 482
 483		.vi_end_f1	= 20,		    .vi_end_f2		= 21,
 484		.nbr_end	= 240,
 485
 486		.burst_ena	= true,
 487		.hburst_start	= 72,		    .hburst_len		= 34,
 488		.vburst_start_f1 = 9,		    .vburst_end_f1	= 240,
 489		.vburst_start_f2 = 10,		    .vburst_end_f2	= 240,
 490		.vburst_start_f3 = 9,		    .vburst_end_f3	= 240,
 491		.vburst_start_f4 = 10,		    .vburst_end_f4	= 240,
 492
 493		/* desired 3.5800000 actual 3.5800000 clock 107.52 */
 494		.dda1_inc	=    135,
 495		.dda2_inc	=  20800,	    .dda2_size		=  27456,
 496		.dda3_inc	=      0,	    .dda3_size		=      0,
 497		.sc_reset	= TV_SC_RESET_EVERY_4,
 498		.pal_burst	= false,
 499
 500		.composite_levels = &ntsc_j_levels_composite,
 501		.composite_color = &ntsc_j_csc_composite,
 502		.svideo_levels  = &ntsc_j_levels_svideo,
 503		.svideo_color = &ntsc_j_csc_svideo,
 504
 505		.filter_table = filter_table,
 506	},
 507	{
 508		.name		= "PAL-M",
 509		.clock		= 108000,
 510		.refresh	= 59940,
 511		.oversample	= 8,
 512		.component_only = false,
 513
 514		/* 525 Lines, 60 Fields, 15.734KHz line, Sub-Carrier 3.580MHz */
 515		.hsync_end	= 64,		  .hblank_end		= 124,
 516		.hblank_start = 836,	  .htotal		= 857,
 517
 518		.progressive	= false,	    .trilevel_sync = false,
 519
 520		.vsync_start_f1	= 6,		    .vsync_start_f2	= 7,
 521		.vsync_len	= 6,
 522
 523		.veq_ena	= true,		    .veq_start_f1	= 0,
 524		.veq_start_f2	= 1,		    .veq_len		= 18,
 525
 526		.vi_end_f1	= 20,		    .vi_end_f2		= 21,
 527		.nbr_end	= 240,
 528
 529		.burst_ena	= true,
 530		.hburst_start	= 72,		    .hburst_len		= 34,
 531		.vburst_start_f1 = 9,		    .vburst_end_f1	= 240,
 532		.vburst_start_f2 = 10,		    .vburst_end_f2	= 240,
 533		.vburst_start_f3 = 9,		    .vburst_end_f3	= 240,
 534		.vburst_start_f4 = 10,		    .vburst_end_f4	= 240,
 535
 536		/* desired 3.5800000 actual 3.5800000 clock 107.52 */
 537		.dda1_inc	=    135,
 538		.dda2_inc	=  16704,	    .dda2_size		=  27456,
 539		.dda3_inc	=      0,	    .dda3_size		=      0,
 540		.sc_reset	= TV_SC_RESET_EVERY_8,
 541		.pal_burst  = true,
 542
 543		.composite_levels = &pal_m_levels_composite,
 544		.composite_color = &pal_m_csc_composite,
 545		.svideo_levels  = &pal_m_levels_svideo,
 546		.svideo_color = &pal_m_csc_svideo,
 547
 548		.filter_table = filter_table,
 549	},
 550	{
 551		/* 625 Lines, 50 Fields, 15.625KHz line, Sub-Carrier 4.434MHz */
 552		.name	    = "PAL-N",
 553		.clock		= 108000,
 554		.refresh	= 50000,
 555		.oversample	= 8,
 556		.component_only = false,
 557
 558		.hsync_end	= 64,		    .hblank_end		= 128,
 559		.hblank_start = 844,	    .htotal		= 863,
 560
 561		.progressive  = false,    .trilevel_sync = false,
 562
 563
 564		.vsync_start_f1	= 6,	   .vsync_start_f2	= 7,
 565		.vsync_len	= 6,
 566
 567		.veq_ena	= true,		    .veq_start_f1	= 0,
 568		.veq_start_f2	= 1,		    .veq_len		= 18,
 569
 570		.vi_end_f1	= 24,		    .vi_end_f2		= 25,
 571		.nbr_end	= 286,
 572
 573		.burst_ena	= true,
 574		.hburst_start = 73,	    .hburst_len		= 34,
 575		.vburst_start_f1 = 8,	    .vburst_end_f1	= 285,
 576		.vburst_start_f2 = 8,	    .vburst_end_f2	= 286,
 577		.vburst_start_f3 = 9,	    .vburst_end_f3	= 286,
 578		.vburst_start_f4 = 9,	    .vburst_end_f4	= 285,
 579
 580
 581		/* desired 4.4336180 actual 4.4336180 clock 107.52 */
 582		.dda1_inc       =    135,
 583		.dda2_inc       =  23578,       .dda2_size      =  27648,
 584		.dda3_inc       =    134,       .dda3_size      =    625,
 585		.sc_reset   = TV_SC_RESET_EVERY_8,
 586		.pal_burst  = true,
 587
 588		.composite_levels = &pal_n_levels_composite,
 589		.composite_color = &pal_n_csc_composite,
 590		.svideo_levels  = &pal_n_levels_svideo,
 591		.svideo_color = &pal_n_csc_svideo,
 592
 593		.filter_table = filter_table,
 594	},
 595	{
 596		/* 625 Lines, 50 Fields, 15.625KHz line, Sub-Carrier 4.434MHz */
 597		.name	    = "PAL",
 598		.clock		= 108000,
 599		.refresh	= 50000,
 600		.oversample	= 8,
 601		.component_only = false,
 602
 603		.hsync_end	= 64,		    .hblank_end		= 142,
 604		.hblank_start	= 844,	    .htotal		= 863,
 605
 606		.progressive	= false,    .trilevel_sync = false,
 607
 608		.vsync_start_f1	= 5,	    .vsync_start_f2	= 6,
 609		.vsync_len	= 5,
 610
 611		.veq_ena	= true,	    .veq_start_f1	= 0,
 612		.veq_start_f2	= 1,	    .veq_len		= 15,
 613
 614		.vi_end_f1	= 24,		    .vi_end_f2		= 25,
 615		.nbr_end	= 286,
 616
 617		.burst_ena	= true,
 618		.hburst_start	= 73,		    .hburst_len		= 32,
 619		.vburst_start_f1 = 8,		    .vburst_end_f1	= 285,
 620		.vburst_start_f2 = 8,		    .vburst_end_f2	= 286,
 621		.vburst_start_f3 = 9,		    .vburst_end_f3	= 286,
 622		.vburst_start_f4 = 9,		    .vburst_end_f4	= 285,
 623
 624		/* desired 4.4336180 actual 4.4336180 clock 107.52 */
 625		.dda1_inc       =    168,
 626		.dda2_inc       =   4122,       .dda2_size      =  27648,
 627		.dda3_inc       =     67,       .dda3_size      =    625,
 628		.sc_reset   = TV_SC_RESET_EVERY_8,
 629		.pal_burst  = true,
 630
 631		.composite_levels = &pal_levels_composite,
 632		.composite_color = &pal_csc_composite,
 633		.svideo_levels  = &pal_levels_svideo,
 634		.svideo_color = &pal_csc_svideo,
 635
 636		.filter_table = filter_table,
 637	},
 638	{
 639		.name       = "480p",
 640		.clock		= 108000,
 641		.refresh	= 59940,
 642		.oversample     = 4,
 643		.component_only = true,
 644
 645		.hsync_end      = 64,               .hblank_end         = 122,
 646		.hblank_start   = 842,              .htotal             = 857,
 647
 648		.progressive    = true,		    .trilevel_sync = false,
 649
 650		.vsync_start_f1 = 12,               .vsync_start_f2     = 12,
 651		.vsync_len      = 12,
 652
 653		.veq_ena        = false,
 654
 655		.vi_end_f1      = 44,               .vi_end_f2          = 44,
 656		.nbr_end        = 479,
 657
 658		.burst_ena      = false,
 659
 660		.filter_table = filter_table,
 661	},
 662	{
 663		.name       = "576p",
 664		.clock		= 108000,
 665		.refresh	= 50000,
 666		.oversample     = 4,
 667		.component_only = true,
 668
 669		.hsync_end      = 64,               .hblank_end         = 139,
 670		.hblank_start   = 859,              .htotal             = 863,
 671
 672		.progressive    = true,		    .trilevel_sync = false,
 673
 674		.vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 675		.vsync_len      = 10,
 676
 677		.veq_ena        = false,
 678
 679		.vi_end_f1      = 48,               .vi_end_f2          = 48,
 680		.nbr_end        = 575,
 681
 682		.burst_ena      = false,
 683
 684		.filter_table = filter_table,
 685	},
 686	{
 687		.name       = "720p@60Hz",
 688		.clock		= 148500,
 689		.refresh	= 60000,
 690		.oversample     = 2,
 691		.component_only = true,
 692
 693		.hsync_end      = 80,               .hblank_end         = 300,
 694		.hblank_start   = 1580,             .htotal             = 1649,
 695
 696		.progressive	= true,		    .trilevel_sync = true,
 697
 698		.vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 699		.vsync_len      = 10,
 700
 701		.veq_ena        = false,
 702
 703		.vi_end_f1      = 29,               .vi_end_f2          = 29,
 704		.nbr_end        = 719,
 705
 706		.burst_ena      = false,
 707
 708		.filter_table = filter_table,
 709	},
 710	{
 711		.name       = "720p@50Hz",
 712		.clock		= 148500,
 713		.refresh	= 50000,
 714		.oversample     = 2,
 715		.component_only = true,
 716
 717		.hsync_end      = 80,               .hblank_end         = 300,
 718		.hblank_start   = 1580,             .htotal             = 1979,
 719
 720		.progressive	= true,		    .trilevel_sync = true,
 721
 722		.vsync_start_f1 = 10,               .vsync_start_f2     = 10,
 723		.vsync_len      = 10,
 724
 725		.veq_ena        = false,
 726
 727		.vi_end_f1      = 29,               .vi_end_f2          = 29,
 728		.nbr_end        = 719,
 729
 730		.burst_ena      = false,
 731
 732		.filter_table = filter_table,
 733	},
 734	{
 735		.name       = "1080i@50Hz",
 736		.clock		= 148500,
 737		.refresh	= 50000,
 738		.oversample     = 2,
 739		.component_only = true,
 740
 741		.hsync_end      = 88,               .hblank_end         = 235,
 742		.hblank_start   = 2155,             .htotal             = 2639,
 743
 744		.progressive	= false,	  .trilevel_sync = true,
 745
 746		.vsync_start_f1 = 4,              .vsync_start_f2     = 5,
 747		.vsync_len      = 10,
 748
 749		.veq_ena	= true,	    .veq_start_f1	= 4,
 750		.veq_start_f2   = 4,	    .veq_len		= 10,
 751
 752
 753		.vi_end_f1      = 21,           .vi_end_f2          = 22,
 754		.nbr_end        = 539,
 755
 756		.burst_ena      = false,
 757
 758		.filter_table = filter_table,
 759	},
 760	{
 761		.name       = "1080i@60Hz",
 762		.clock		= 148500,
 763		.refresh	= 60000,
 764		.oversample     = 2,
 765		.component_only = true,
 766
 767		.hsync_end      = 88,               .hblank_end         = 235,
 768		.hblank_start   = 2155,             .htotal             = 2199,
 769
 770		.progressive	= false,	    .trilevel_sync = true,
 771
 772		.vsync_start_f1 = 4,               .vsync_start_f2     = 5,
 773		.vsync_len      = 10,
 774
 775		.veq_ena	= true,		    .veq_start_f1	= 4,
 776		.veq_start_f2	= 4,		    .veq_len		= 10,
 777
 778
 779		.vi_end_f1      = 21,               .vi_end_f2          = 22,
 780		.nbr_end        = 539,
 781
 782		.burst_ena      = false,
 783
 784		.filter_table = filter_table,
 785	},
 786
 787	{
 788		.name       = "1080p@30Hz",
 789		.clock		= 148500,
 790		.refresh	= 30000,
 791		.oversample     = 2,
 792		.component_only = true,
 793
 794		.hsync_end      = 88,               .hblank_end         = 235,
 795		.hblank_start   = 2155,             .htotal             = 2199,
 796
 797		.progressive	= true,		    .trilevel_sync = true,
 798
 799		.vsync_start_f1 = 8,               .vsync_start_f2     = 8,
 800		.vsync_len      = 10,
 801
 802		.veq_ena	= false,	.veq_start_f1	= 0,
 803		.veq_start_f2	= 0,		    .veq_len		= 0,
 804
 805		.vi_end_f1      = 44,               .vi_end_f2          = 44,
 806		.nbr_end        = 1079,
 807
 808		.burst_ena      = false,
 809
 810		.filter_table = filter_table,
 811	},
 812
 813	{
 814		.name       = "1080p@50Hz",
 815		.clock		= 148500,
 816		.refresh	= 50000,
 817		.oversample     = 1,
 818		.component_only = true,
 819
 820		.hsync_end      = 88,               .hblank_end         = 235,
 821		.hblank_start   = 2155,             .htotal             = 2639,
 822
 823		.progressive	= true,		    .trilevel_sync = true,
 824
 825		.vsync_start_f1 = 8,               .vsync_start_f2     = 8,
 826		.vsync_len      = 10,
 827
 828		.veq_ena	= false,	.veq_start_f1	= 0,
 829		.veq_start_f2	= 0,		    .veq_len		= 0,
 830
 831		.vi_end_f1      = 44,               .vi_end_f2          = 44,
 832		.nbr_end        = 1079,
 833
 834		.burst_ena      = false,
 835
 836		.filter_table = filter_table,
 837	},
 838
 839	{
 840		.name       = "1080p@60Hz",
 841		.clock		= 148500,
 842		.refresh	= 60000,
 843		.oversample     = 1,
 844		.component_only = true,
 845
 846		.hsync_end      = 88,               .hblank_end         = 235,
 847		.hblank_start   = 2155,             .htotal             = 2199,
 848
 849		.progressive	= true,		    .trilevel_sync = true,
 850
 851		.vsync_start_f1 = 8,               .vsync_start_f2     = 8,
 852		.vsync_len      = 10,
 853
 854		.veq_ena	= false,		    .veq_start_f1	= 0,
 855		.veq_start_f2	= 0,		    .veq_len		= 0,
 856
 857		.vi_end_f1      = 44,               .vi_end_f2          = 44,
 858		.nbr_end        = 1079,
 859
 860		.burst_ena      = false,
 861
 862		.filter_table = filter_table,
 863	},
 864};
 865
 866struct intel_tv_connector_state {
 867	struct drm_connector_state base;
 868
 869	/*
 870	 * May need to override the user margins for
 871	 * gen3 >1024 wide source vertical centering.
 872	 */
 873	struct {
 874		u16 top, bottom;
 875	} margins;
 876
 877	bool bypass_vfilter;
 878};
 879
 880#define to_intel_tv_connector_state(x) container_of(x, struct intel_tv_connector_state, base)
 881
 882static struct drm_connector_state *
 883intel_tv_connector_duplicate_state(struct drm_connector *connector)
 884{
 885	struct intel_tv_connector_state *state;
 886
 887	state = kmemdup(connector->state, sizeof(*state), GFP_KERNEL);
 888	if (!state)
 889		return NULL;
 890
 891	__drm_atomic_helper_connector_duplicate_state(connector, &state->base);
 892	return &state->base;
 893}
 894
 895static struct intel_tv *enc_to_tv(struct intel_encoder *encoder)
 896{
 897	return container_of(encoder, struct intel_tv, base);
 898}
 899
 900static struct intel_tv *intel_attached_tv(struct intel_connector *connector)
 901{
 902	return enc_to_tv(intel_attached_encoder(connector));
 903}
 904
 905static bool
 906intel_tv_get_hw_state(struct intel_encoder *encoder, enum pipe *pipe)
 907{
 908	struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
 909	u32 tmp = intel_de_read(dev_priv, TV_CTL);
 910
 911	*pipe = (tmp & TV_ENC_PIPE_SEL_MASK) >> TV_ENC_PIPE_SEL_SHIFT;
 912
 913	return tmp & TV_ENC_ENABLE;
 914}
 915
 916static void
 917intel_enable_tv(struct intel_atomic_state *state,
 918		struct intel_encoder *encoder,
 919		const struct intel_crtc_state *pipe_config,
 920		const struct drm_connector_state *conn_state)
 921{
 922	struct drm_device *dev = encoder->base.dev;
 923	struct drm_i915_private *dev_priv = to_i915(dev);
 924
 925	/* Prevents vblank waits from timing out in intel_tv_detect_type() */
 926	intel_wait_for_vblank(dev_priv,
 927			      to_intel_crtc(pipe_config->uapi.crtc)->pipe);
 928
 929	intel_de_write(dev_priv, TV_CTL,
 930		       intel_de_read(dev_priv, TV_CTL) | TV_ENC_ENABLE);
 931}
 932
 933static void
 934intel_disable_tv(struct intel_atomic_state *state,
 935		 struct intel_encoder *encoder,
 936		 const struct intel_crtc_state *old_crtc_state,
 937		 const struct drm_connector_state *old_conn_state)
 938{
 939	struct drm_device *dev = encoder->base.dev;
 940	struct drm_i915_private *dev_priv = to_i915(dev);
 941
 942	intel_de_write(dev_priv, TV_CTL,
 943		       intel_de_read(dev_priv, TV_CTL) & ~TV_ENC_ENABLE);
 944}
 945
 946static const struct tv_mode *intel_tv_mode_find(const struct drm_connector_state *conn_state)
 947{
 948	int format = conn_state->tv.mode;
 949
 950	return &tv_modes[format];
 951}
 952
 953static enum drm_mode_status
 954intel_tv_mode_valid(struct drm_connector *connector,
 955		    struct drm_display_mode *mode)
 956{
 957	const struct tv_mode *tv_mode = intel_tv_mode_find(connector->state);
 958	int max_dotclk = to_i915(connector->dev)->max_dotclk_freq;
 959
 960	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
 961		return MODE_NO_DBLESCAN;
 962
 963	if (mode->clock > max_dotclk)
 964		return MODE_CLOCK_HIGH;
 965
 966	/* Ensure TV refresh is close to desired refresh */
 967	if (abs(tv_mode->refresh - drm_mode_vrefresh(mode) * 1000) >= 1000)
 968		return MODE_CLOCK_RANGE;
 969
 970	return MODE_OK;
 971}
 972
 973static int
 974intel_tv_mode_vdisplay(const struct tv_mode *tv_mode)
 975{
 976	if (tv_mode->progressive)
 977		return tv_mode->nbr_end + 1;
 978	else
 979		return 2 * (tv_mode->nbr_end + 1);
 980}
 981
 982static void
 983intel_tv_mode_to_mode(struct drm_display_mode *mode,
 984		      const struct tv_mode *tv_mode)
 985{
 986	mode->clock = tv_mode->clock /
 987		(tv_mode->oversample >> !tv_mode->progressive);
 988
 989	/*
 990	 * tv_mode horizontal timings:
 991	 *
 992	 * hsync_end
 993	 *    | hblank_end
 994	 *    |    | hblank_start
 995	 *    |    |       | htotal
 996	 *    |     _______    |
 997	 *     ____/       \___
 998	 * \__/                \
 999	 */
1000	mode->hdisplay =
1001		tv_mode->hblank_start - tv_mode->hblank_end;
1002	mode->hsync_start = mode->hdisplay +
1003		tv_mode->htotal - tv_mode->hblank_start;
1004	mode->hsync_end = mode->hsync_start +
1005		tv_mode->hsync_end;
1006	mode->htotal = tv_mode->htotal + 1;
1007
1008	/*
1009	 * tv_mode vertical timings:
1010	 *
1011	 * vsync_start
1012	 *    | vsync_end
1013	 *    |  | vi_end nbr_end
1014	 *    |  |    |       |
1015	 *    |  |     _______
1016	 * \__    ____/       \
1017	 *    \__/
1018	 */
1019	mode->vdisplay = intel_tv_mode_vdisplay(tv_mode);
1020	if (tv_mode->progressive) {
1021		mode->vsync_start = mode->vdisplay +
1022			tv_mode->vsync_start_f1 + 1;
1023		mode->vsync_end = mode->vsync_start +
1024			tv_mode->vsync_len;
1025		mode->vtotal = mode->vdisplay +
1026			tv_mode->vi_end_f1 + 1;
1027	} else {
1028		mode->vsync_start = mode->vdisplay +
1029			tv_mode->vsync_start_f1 + 1 +
1030			tv_mode->vsync_start_f2 + 1;
1031		mode->vsync_end = mode->vsync_start +
1032			2 * tv_mode->vsync_len;
1033		mode->vtotal = mode->vdisplay +
1034			tv_mode->vi_end_f1 + 1 +
1035			tv_mode->vi_end_f2 + 1;
1036	}
1037
1038	/* TV has it's own notion of sync and other mode flags, so clear them. */
1039	mode->flags = 0;
1040
1041	snprintf(mode->name, sizeof(mode->name),
1042		 "%dx%d%c (%s)",
1043		 mode->hdisplay, mode->vdisplay,
1044		 tv_mode->progressive ? 'p' : 'i',
1045		 tv_mode->name);
1046}
1047
1048static void intel_tv_scale_mode_horiz(struct drm_display_mode *mode,
1049				      int hdisplay, int left_margin,
1050				      int right_margin)
1051{
1052	int hsync_start = mode->hsync_start - mode->hdisplay + right_margin;
1053	int hsync_end = mode->hsync_end - mode->hdisplay + right_margin;
1054	int new_htotal = mode->htotal * hdisplay /
1055		(mode->hdisplay - left_margin - right_margin);
1056
1057	mode->clock = mode->clock * new_htotal / mode->htotal;
1058
1059	mode->hdisplay = hdisplay;
1060	mode->hsync_start = hdisplay + hsync_start * new_htotal / mode->htotal;
1061	mode->hsync_end = hdisplay + hsync_end * new_htotal / mode->htotal;
1062	mode->htotal = new_htotal;
1063}
1064
1065static void intel_tv_scale_mode_vert(struct drm_display_mode *mode,
1066				     int vdisplay, int top_margin,
1067				     int bottom_margin)
1068{
1069	int vsync_start = mode->vsync_start - mode->vdisplay + bottom_margin;
1070	int vsync_end = mode->vsync_end - mode->vdisplay + bottom_margin;
1071	int new_vtotal = mode->vtotal * vdisplay /
1072		(mode->vdisplay - top_margin - bottom_margin);
1073
1074	mode->clock = mode->clock * new_vtotal / mode->vtotal;
1075
1076	mode->vdisplay = vdisplay;
1077	mode->vsync_start = vdisplay + vsync_start * new_vtotal / mode->vtotal;
1078	mode->vsync_end = vdisplay + vsync_end * new_vtotal / mode->vtotal;
1079	mode->vtotal = new_vtotal;
1080}
1081
1082static void
1083intel_tv_get_config(struct intel_encoder *encoder,
1084		    struct intel_crtc_state *pipe_config)
1085{
1086	struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
1087	struct drm_display_mode *adjusted_mode =
1088		&pipe_config->hw.adjusted_mode;
1089	struct drm_display_mode mode = {};
1090	u32 tv_ctl, hctl1, hctl3, vctl1, vctl2, tmp;
1091	struct tv_mode tv_mode = {};
1092	int hdisplay = adjusted_mode->crtc_hdisplay;
1093	int vdisplay = adjusted_mode->crtc_vdisplay;
1094	int xsize, ysize, xpos, ypos;
1095
1096	pipe_config->output_types |= BIT(INTEL_OUTPUT_TVOUT);
1097
1098	tv_ctl = intel_de_read(dev_priv, TV_CTL);
1099	hctl1 = intel_de_read(dev_priv, TV_H_CTL_1);
1100	hctl3 = intel_de_read(dev_priv, TV_H_CTL_3);
1101	vctl1 = intel_de_read(dev_priv, TV_V_CTL_1);
1102	vctl2 = intel_de_read(dev_priv, TV_V_CTL_2);
1103
1104	tv_mode.htotal = (hctl1 & TV_HTOTAL_MASK) >> TV_HTOTAL_SHIFT;
1105	tv_mode.hsync_end = (hctl1 & TV_HSYNC_END_MASK) >> TV_HSYNC_END_SHIFT;
1106
1107	tv_mode.hblank_start = (hctl3 & TV_HBLANK_START_MASK) >> TV_HBLANK_START_SHIFT;
1108	tv_mode.hblank_end = (hctl3 & TV_HSYNC_END_MASK) >> TV_HBLANK_END_SHIFT;
1109
1110	tv_mode.nbr_end = (vctl1 & TV_NBR_END_MASK) >> TV_NBR_END_SHIFT;
1111	tv_mode.vi_end_f1 = (vctl1 & TV_VI_END_F1_MASK) >> TV_VI_END_F1_SHIFT;
1112	tv_mode.vi_end_f2 = (vctl1 & TV_VI_END_F2_MASK) >> TV_VI_END_F2_SHIFT;
1113
1114	tv_mode.vsync_len = (vctl2 & TV_VSYNC_LEN_MASK) >> TV_VSYNC_LEN_SHIFT;
1115	tv_mode.vsync_start_f1 = (vctl2 & TV_VSYNC_START_F1_MASK) >> TV_VSYNC_START_F1_SHIFT;
1116	tv_mode.vsync_start_f2 = (vctl2 & TV_VSYNC_START_F2_MASK) >> TV_VSYNC_START_F2_SHIFT;
1117
1118	tv_mode.clock = pipe_config->port_clock;
1119
1120	tv_mode.progressive = tv_ctl & TV_PROGRESSIVE;
1121
1122	switch (tv_ctl & TV_OVERSAMPLE_MASK) {
1123	case TV_OVERSAMPLE_8X:
1124		tv_mode.oversample = 8;
1125		break;
1126	case TV_OVERSAMPLE_4X:
1127		tv_mode.oversample = 4;
1128		break;
1129	case TV_OVERSAMPLE_2X:
1130		tv_mode.oversample = 2;
1131		break;
1132	default:
1133		tv_mode.oversample = 1;
1134		break;
1135	}
1136
1137	tmp = intel_de_read(dev_priv, TV_WIN_POS);
1138	xpos = tmp >> 16;
1139	ypos = tmp & 0xffff;
1140
1141	tmp = intel_de_read(dev_priv, TV_WIN_SIZE);
1142	xsize = tmp >> 16;
1143	ysize = tmp & 0xffff;
1144
1145	intel_tv_mode_to_mode(&mode, &tv_mode);
1146
1147	drm_dbg_kms(&dev_priv->drm, "TV mode:\n");
1148	drm_mode_debug_printmodeline(&mode);
1149
1150	intel_tv_scale_mode_horiz(&mode, hdisplay,
1151				  xpos, mode.hdisplay - xsize - xpos);
1152	intel_tv_scale_mode_vert(&mode, vdisplay,
1153				 ypos, mode.vdisplay - ysize - ypos);
1154
1155	adjusted_mode->crtc_clock = mode.clock;
1156	if (adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE)
1157		adjusted_mode->crtc_clock /= 2;
1158
1159	/* pixel counter doesn't work on i965gm TV output */
1160	if (IS_I965GM(dev_priv))
1161		pipe_config->mode_flags |=
1162			I915_MODE_FLAG_USE_SCANLINE_COUNTER;
1163}
1164
1165static bool intel_tv_source_too_wide(struct drm_i915_private *dev_priv,
1166				     int hdisplay)
1167{
1168	return IS_GEN(dev_priv, 3) && hdisplay > 1024;
1169}
1170
1171static bool intel_tv_vert_scaling(const struct drm_display_mode *tv_mode,
1172				  const struct drm_connector_state *conn_state,
1173				  int vdisplay)
1174{
1175	return tv_mode->crtc_vdisplay -
1176		conn_state->tv.margins.top -
1177		conn_state->tv.margins.bottom !=
1178		vdisplay;
1179}
1180
1181static int
1182intel_tv_compute_config(struct intel_encoder *encoder,
1183			struct intel_crtc_state *pipe_config,
1184			struct drm_connector_state *conn_state)
1185{
1186	struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
1187	struct intel_tv_connector_state *tv_conn_state =
1188		to_intel_tv_connector_state(conn_state);
1189	const struct tv_mode *tv_mode = intel_tv_mode_find(conn_state);
1190	struct drm_display_mode *adjusted_mode =
1191		&pipe_config->hw.adjusted_mode;
1192	int hdisplay = adjusted_mode->crtc_hdisplay;
1193	int vdisplay = adjusted_mode->crtc_vdisplay;
1194
1195	if (!tv_mode)
1196		return -EINVAL;
1197
1198	if (adjusted_mode->flags & DRM_MODE_FLAG_DBLSCAN)
1199		return -EINVAL;
1200
1201	pipe_config->output_format = INTEL_OUTPUT_FORMAT_RGB;
1202
1203	drm_dbg_kms(&dev_priv->drm, "forcing bpc to 8 for TV\n");
1204	pipe_config->pipe_bpp = 8*3;
1205
1206	pipe_config->port_clock = tv_mode->clock;
1207
1208	intel_tv_mode_to_mode(adjusted_mode, tv_mode);
1209	drm_mode_set_crtcinfo(adjusted_mode, 0);
1210
1211	if (intel_tv_source_too_wide(dev_priv, hdisplay) ||
1212	    !intel_tv_vert_scaling(adjusted_mode, conn_state, vdisplay)) {
1213		int extra, top, bottom;
1214
1215		extra = adjusted_mode->crtc_vdisplay - vdisplay;
1216
1217		if (extra < 0) {
1218			drm_dbg_kms(&dev_priv->drm,
1219				    "No vertical scaling for >1024 pixel wide modes\n");
1220			return -EINVAL;
1221		}
1222
1223		/* Need to turn off the vertical filter and center the image */
1224
1225		/* Attempt to maintain the relative sizes of the margins */
1226		top = conn_state->tv.margins.top;
1227		bottom = conn_state->tv.margins.bottom;
1228
1229		if (top + bottom)
1230			top = extra * top / (top + bottom);
1231		else
1232			top = extra / 2;
1233		bottom = extra - top;
1234
1235		tv_conn_state->margins.top = top;
1236		tv_conn_state->margins.bottom = bottom;
1237
1238		tv_conn_state->bypass_vfilter = true;
1239
1240		if (!tv_mode->progressive) {
1241			adjusted_mode->clock /= 2;
1242			adjusted_mode->crtc_clock /= 2;
1243			adjusted_mode->flags |= DRM_MODE_FLAG_INTERLACE;
1244		}
1245	} else {
1246		tv_conn_state->margins.top = conn_state->tv.margins.top;
1247		tv_conn_state->margins.bottom = conn_state->tv.margins.bottom;
1248
1249		tv_conn_state->bypass_vfilter = false;
1250	}
1251
1252	drm_dbg_kms(&dev_priv->drm, "TV mode:\n");
1253	drm_mode_debug_printmodeline(adjusted_mode);
1254
1255	/*
1256	 * The pipe scanline counter behaviour looks as follows when
1257	 * using the TV encoder:
1258	 *
1259	 * time ->
1260	 *
1261	 * dsl=vtotal-1       |             |
1262	 *                   ||            ||
1263	 *               ___| |        ___| |
1264	 *              /     |       /     |
1265	 *             /      |      /      |
1266	 * dsl=0   ___/       |_____/       |
1267	 *        | | |  |  | |
1268	 *         ^ ^ ^   ^ ^
1269	 *         | | |   | pipe vblank/first part of tv vblank
1270	 *         | | |   bottom margin
1271	 *         | | active
1272	 *         | top margin
1273	 *         remainder of tv vblank
1274	 *
1275	 * When the TV encoder is used the pipe wants to run faster
1276	 * than expected rate. During the active portion the TV
1277	 * encoder stalls the pipe every few lines to keep it in
1278	 * check. When the TV encoder reaches the bottom margin the
1279	 * pipe simply stops. Once we reach the TV vblank the pipe is
1280	 * no longer stalled and it runs at the max rate (apparently
1281	 * oversample clock on gen3, cdclk on gen4). Once the pipe
1282	 * reaches the pipe vtotal the pipe stops for the remainder
1283	 * of the TV vblank/top margin. The pipe starts up again when
1284	 * the TV encoder exits the top margin.
1285	 *
1286	 * To avoid huge hassles for vblank timestamping we scale
1287	 * the pipe timings as if the pipe always runs at the average
1288	 * rate it maintains during the active period. This also
1289	 * gives us a reasonable guesstimate as to the pixel rate.
1290	 * Due to the variation in the actual pipe speed the scanline
1291	 * counter will give us slightly erroneous results during the
1292	 * TV vblank/margins. But since vtotal was selected such that
1293	 * it matches the average rate of the pipe during the active
1294	 * portion the error shouldn't cause any serious grief to
1295	 * vblank timestamps.
1296	 *
1297	 * For posterity here is the empirically derived formula
1298	 * that gives us the maximum length of the pipe vblank
1299	 * we can use without causing display corruption. Following
1300	 * this would allow us to have a ticking scanline counter
1301	 * everywhere except during the bottom margin (there the
1302	 * pipe always stops). Ie. this would eliminate the second
1303	 * flat portion of the above graph. However this would also
1304	 * complicate vblank timestamping as the pipe vtotal would
1305	 * no longer match the average rate the pipe runs at during
1306	 * the active portion. Hence following this formula seems
1307	 * more trouble that it's worth.
1308	 *
1309	 * if (IS_GEN(dev_priv, 4)) {
1310	 *	num = cdclk * (tv_mode->oversample >> !tv_mode->progressive);
1311	 *	den = tv_mode->clock;
1312	 * } else {
1313	 *	num = tv_mode->oversample >> !tv_mode->progressive;
1314	 *	den = 1;
1315	 * }
1316	 * max_pipe_vblank_len ~=
1317	 *	(num * tv_htotal * (tv_vblank_len + top_margin)) /
1318	 *	(den * pipe_htotal);
1319	 */
1320	intel_tv_scale_mode_horiz(adjusted_mode, hdisplay,
1321				  conn_state->tv.margins.left,
1322				  conn_state->tv.margins.right);
1323	intel_tv_scale_mode_vert(adjusted_mode, vdisplay,
1324				 tv_conn_state->margins.top,
1325				 tv_conn_state->margins.bottom);
1326	drm_mode_set_crtcinfo(adjusted_mode, 0);
1327	adjusted_mode->name[0] = '\0';
1328
1329	/* pixel counter doesn't work on i965gm TV output */
1330	if (IS_I965GM(dev_priv))
1331		pipe_config->mode_flags |=
1332			I915_MODE_FLAG_USE_SCANLINE_COUNTER;
1333
1334	return 0;
1335}
1336
1337static void
1338set_tv_mode_timings(struct drm_i915_private *dev_priv,
1339		    const struct tv_mode *tv_mode,
1340		    bool burst_ena)
1341{
1342	u32 hctl1, hctl2, hctl3;
1343	u32 vctl1, vctl2, vctl3, vctl4, vctl5, vctl6, vctl7;
1344
1345	hctl1 = (tv_mode->hsync_end << TV_HSYNC_END_SHIFT) |
1346		(tv_mode->htotal << TV_HTOTAL_SHIFT);
1347
1348	hctl2 = (tv_mode->hburst_start << 16) |
1349		(tv_mode->hburst_len << TV_HBURST_LEN_SHIFT);
1350
1351	if (burst_ena)
1352		hctl2 |= TV_BURST_ENA;
1353
1354	hctl3 = (tv_mode->hblank_start << TV_HBLANK_START_SHIFT) |
1355		(tv_mode->hblank_end << TV_HBLANK_END_SHIFT);
1356
1357	vctl1 = (tv_mode->nbr_end << TV_NBR_END_SHIFT) |
1358		(tv_mode->vi_end_f1 << TV_VI_END_F1_SHIFT) |
1359		(tv_mode->vi_end_f2 << TV_VI_END_F2_SHIFT);
1360
1361	vctl2 = (tv_mode->vsync_len << TV_VSYNC_LEN_SHIFT) |
1362		(tv_mode->vsync_start_f1 << TV_VSYNC_START_F1_SHIFT) |
1363		(tv_mode->vsync_start_f2 << TV_VSYNC_START_F2_SHIFT);
1364
1365	vctl3 = (tv_mode->veq_len << TV_VEQ_LEN_SHIFT) |
1366		(tv_mode->veq_start_f1 << TV_VEQ_START_F1_SHIFT) |
1367		(tv_mode->veq_start_f2 << TV_VEQ_START_F2_SHIFT);
1368
1369	if (tv_mode->veq_ena)
1370		vctl3 |= TV_EQUAL_ENA;
1371
1372	vctl4 = (tv_mode->vburst_start_f1 << TV_VBURST_START_F1_SHIFT) |
1373		(tv_mode->vburst_end_f1 << TV_VBURST_END_F1_SHIFT);
1374
1375	vctl5 = (tv_mode->vburst_start_f2 << TV_VBURST_START_F2_SHIFT) |
1376		(tv_mode->vburst_end_f2 << TV_VBURST_END_F2_SHIFT);
1377
1378	vctl6 = (tv_mode->vburst_start_f3 << TV_VBURST_START_F3_SHIFT) |
1379		(tv_mode->vburst_end_f3 << TV_VBURST_END_F3_SHIFT);
1380
1381	vctl7 = (tv_mode->vburst_start_f4 << TV_VBURST_START_F4_SHIFT) |
1382		(tv_mode->vburst_end_f4 << TV_VBURST_END_F4_SHIFT);
1383
1384	intel_de_write(dev_priv, TV_H_CTL_1, hctl1);
1385	intel_de_write(dev_priv, TV_H_CTL_2, hctl2);
1386	intel_de_write(dev_priv, TV_H_CTL_3, hctl3);
1387	intel_de_write(dev_priv, TV_V_CTL_1, vctl1);
1388	intel_de_write(dev_priv, TV_V_CTL_2, vctl2);
1389	intel_de_write(dev_priv, TV_V_CTL_3, vctl3);
1390	intel_de_write(dev_priv, TV_V_CTL_4, vctl4);
1391	intel_de_write(dev_priv, TV_V_CTL_5, vctl5);
1392	intel_de_write(dev_priv, TV_V_CTL_6, vctl6);
1393	intel_de_write(dev_priv, TV_V_CTL_7, vctl7);
1394}
1395
1396static void set_color_conversion(struct drm_i915_private *dev_priv,
1397				 const struct color_conversion *color_conversion)
1398{
1399	if (!color_conversion)
1400		return;
1401
1402	intel_de_write(dev_priv, TV_CSC_Y,
1403		       (color_conversion->ry << 16) | color_conversion->gy);
1404	intel_de_write(dev_priv, TV_CSC_Y2,
1405		       (color_conversion->by << 16) | color_conversion->ay);
1406	intel_de_write(dev_priv, TV_CSC_U,
1407		       (color_conversion->ru << 16) | color_conversion->gu);
1408	intel_de_write(dev_priv, TV_CSC_U2,
1409		       (color_conversion->bu << 16) | color_conversion->au);
1410	intel_de_write(dev_priv, TV_CSC_V,
1411		       (color_conversion->rv << 16) | color_conversion->gv);
1412	intel_de_write(dev_priv, TV_CSC_V2,
1413		       (color_conversion->bv << 16) | color_conversion->av);
1414}
1415
1416static void intel_tv_pre_enable(struct intel_atomic_state *state,
1417				struct intel_encoder *encoder,
1418				const struct intel_crtc_state *pipe_config,
1419				const struct drm_connector_state *conn_state)
1420{
1421	struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
1422	struct intel_crtc *intel_crtc = to_intel_crtc(pipe_config->uapi.crtc);
1423	struct intel_tv *intel_tv = enc_to_tv(encoder);
1424	const struct intel_tv_connector_state *tv_conn_state =
1425		to_intel_tv_connector_state(conn_state);
1426	const struct tv_mode *tv_mode = intel_tv_mode_find(conn_state);
1427	u32 tv_ctl, tv_filter_ctl;
1428	u32 scctl1, scctl2, scctl3;
1429	int i, j;
1430	const struct video_levels *video_levels;
1431	const struct color_conversion *color_conversion;
1432	bool burst_ena;
1433	int xpos, ypos;
1434	unsigned int xsize, ysize;
1435
1436	if (!tv_mode)
1437		return;	/* can't happen (mode_prepare prevents this) */
1438
1439	tv_ctl = intel_de_read(dev_priv, TV_CTL);
1440	tv_ctl &= TV_CTL_SAVE;
1441
1442	switch (intel_tv->type) {
1443	default:
1444	case DRM_MODE_CONNECTOR_Unknown:
1445	case DRM_MODE_CONNECTOR_Composite:
1446		tv_ctl |= TV_ENC_OUTPUT_COMPOSITE;
1447		video_levels = tv_mode->composite_levels;
1448		color_conversion = tv_mode->composite_color;
1449		burst_ena = tv_mode->burst_ena;
1450		break;
1451	case DRM_MODE_CONNECTOR_Component:
1452		tv_ctl |= TV_ENC_OUTPUT_COMPONENT;
1453		video_levels = &component_levels;
1454		if (tv_mode->burst_ena)
1455			color_conversion = &sdtv_csc_yprpb;
1456		else
1457			color_conversion = &hdtv_csc_yprpb;
1458		burst_ena = false;
1459		break;
1460	case DRM_MODE_CONNECTOR_SVIDEO:
1461		tv_ctl |= TV_ENC_OUTPUT_SVIDEO;
1462		video_levels = tv_mode->svideo_levels;
1463		color_conversion = tv_mode->svideo_color;
1464		burst_ena = tv_mode->burst_ena;
1465		break;
1466	}
1467
1468	tv_ctl |= TV_ENC_PIPE_SEL(intel_crtc->pipe);
1469
1470	switch (tv_mode->oversample) {
1471	case 8:
1472		tv_ctl |= TV_OVERSAMPLE_8X;
1473		break;
1474	case 4:
1475		tv_ctl |= TV_OVERSAMPLE_4X;
1476		break;
1477	case 2:
1478		tv_ctl |= TV_OVERSAMPLE_2X;
1479		break;
1480	default:
1481		tv_ctl |= TV_OVERSAMPLE_NONE;
1482		break;
1483	}
1484
1485	if (tv_mode->progressive)
1486		tv_ctl |= TV_PROGRESSIVE;
1487	if (tv_mode->trilevel_sync)
1488		tv_ctl |= TV_TRILEVEL_SYNC;
1489	if (tv_mode->pal_burst)
1490		tv_ctl |= TV_PAL_BURST;
1491
1492	scctl1 = 0;
1493	if (tv_mode->dda1_inc)
1494		scctl1 |= TV_SC_DDA1_EN;
1495	if (tv_mode->dda2_inc)
1496		scctl1 |= TV_SC_DDA2_EN;
1497	if (tv_mode->dda3_inc)
1498		scctl1 |= TV_SC_DDA3_EN;
1499	scctl1 |= tv_mode->sc_reset;
1500	if (video_levels)
1501		scctl1 |= video_levels->burst << TV_BURST_LEVEL_SHIFT;
1502	scctl1 |= tv_mode->dda1_inc << TV_SCDDA1_INC_SHIFT;
1503
1504	scctl2 = tv_mode->dda2_size << TV_SCDDA2_SIZE_SHIFT |
1505		tv_mode->dda2_inc << TV_SCDDA2_INC_SHIFT;
1506
1507	scctl3 = tv_mode->dda3_size << TV_SCDDA3_SIZE_SHIFT |
1508		tv_mode->dda3_inc << TV_SCDDA3_INC_SHIFT;
1509
1510	/* Enable two fixes for the chips that need them. */
1511	if (IS_I915GM(dev_priv))
1512		tv_ctl |= TV_ENC_C0_FIX | TV_ENC_SDP_FIX;
1513
1514	set_tv_mode_timings(dev_priv, tv_mode, burst_ena);
1515
1516	intel_de_write(dev_priv, TV_SC_CTL_1, scctl1);
1517	intel_de_write(dev_priv, TV_SC_CTL_2, scctl2);
1518	intel_de_write(dev_priv, TV_SC_CTL_3, scctl3);
1519
1520	set_color_conversion(dev_priv, color_conversion);
1521
1522	if (INTEL_GEN(dev_priv) >= 4)
1523		intel_de_write(dev_priv, TV_CLR_KNOBS, 0x00404000);
1524	else
1525		intel_de_write(dev_priv, TV_CLR_KNOBS, 0x00606000);
1526
1527	if (video_levels)
1528		intel_de_write(dev_priv, TV_CLR_LEVEL,
1529			       ((video_levels->black << TV_BLACK_LEVEL_SHIFT) | (video_levels->blank << TV_BLANK_LEVEL_SHIFT)));
1530
1531	assert_pipe_disabled(dev_priv, pipe_config->cpu_transcoder);
1532
1533	/* Filter ctl must be set before TV_WIN_SIZE */
1534	tv_filter_ctl = TV_AUTO_SCALE;
1535	if (tv_conn_state->bypass_vfilter)
1536		tv_filter_ctl |= TV_V_FILTER_BYPASS;
1537	intel_de_write(dev_priv, TV_FILTER_CTL_1, tv_filter_ctl);
1538
1539	xsize = tv_mode->hblank_start - tv_mode->hblank_end;
1540	ysize = intel_tv_mode_vdisplay(tv_mode);
1541
1542	xpos = conn_state->tv.margins.left;
1543	ypos = tv_conn_state->margins.top;
1544	xsize -= (conn_state->tv.margins.left +
1545		  conn_state->tv.margins.right);
1546	ysize -= (tv_conn_state->margins.top +
1547		  tv_conn_state->margins.bottom);
1548	intel_de_write(dev_priv, TV_WIN_POS, (xpos << 16) | ypos);
1549	intel_de_write(dev_priv, TV_WIN_SIZE, (xsize << 16) | ysize);
1550
1551	j = 0;
1552	for (i = 0; i < 60; i++)
1553		intel_de_write(dev_priv, TV_H_LUMA(i),
1554			       tv_mode->filter_table[j++]);
1555	for (i = 0; i < 60; i++)
1556		intel_de_write(dev_priv, TV_H_CHROMA(i),
1557			       tv_mode->filter_table[j++]);
1558	for (i = 0; i < 43; i++)
1559		intel_de_write(dev_priv, TV_V_LUMA(i),
1560			       tv_mode->filter_table[j++]);
1561	for (i = 0; i < 43; i++)
1562		intel_de_write(dev_priv, TV_V_CHROMA(i),
1563			       tv_mode->filter_table[j++]);
1564	intel_de_write(dev_priv, TV_DAC,
1565		       intel_de_read(dev_priv, TV_DAC) & TV_DAC_SAVE);
1566	intel_de_write(dev_priv, TV_CTL, tv_ctl);
1567}
1568
1569static int
1570intel_tv_detect_type(struct intel_tv *intel_tv,
1571		      struct drm_connector *connector)
1572{
1573	struct drm_crtc *crtc = connector->state->crtc;
1574	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
1575	struct drm_device *dev = connector->dev;
1576	struct drm_i915_private *dev_priv = to_i915(dev);
1577	u32 tv_ctl, save_tv_ctl;
1578	u32 tv_dac, save_tv_dac;
1579	int type;
1580
1581	/* Disable TV interrupts around load detect or we'll recurse */
1582	if (connector->polled & DRM_CONNECTOR_POLL_HPD) {
1583		spin_lock_irq(&dev_priv->irq_lock);
1584		i915_disable_pipestat(dev_priv, 0,
1585				      PIPE_HOTPLUG_INTERRUPT_STATUS |
1586				      PIPE_HOTPLUG_TV_INTERRUPT_STATUS);
1587		spin_unlock_irq(&dev_priv->irq_lock);
1588	}
1589
1590	save_tv_dac = tv_dac = intel_de_read(dev_priv, TV_DAC);
1591	save_tv_ctl = tv_ctl = intel_de_read(dev_priv, TV_CTL);
1592
1593	/* Poll for TV detection */
1594	tv_ctl &= ~(TV_ENC_ENABLE | TV_ENC_PIPE_SEL_MASK | TV_TEST_MODE_MASK);
1595	tv_ctl |= TV_TEST_MODE_MONITOR_DETECT;
1596	tv_ctl |= TV_ENC_PIPE_SEL(intel_crtc->pipe);
1597
1598	tv_dac &= ~(TVDAC_SENSE_MASK | DAC_A_MASK | DAC_B_MASK | DAC_C_MASK);
1599	tv_dac |= (TVDAC_STATE_CHG_EN |
1600		   TVDAC_A_SENSE_CTL |
1601		   TVDAC_B_SENSE_CTL |
1602		   TVDAC_C_SENSE_CTL |
1603		   DAC_CTL_OVERRIDE |
1604		   DAC_A_0_7_V |
1605		   DAC_B_0_7_V |
1606		   DAC_C_0_7_V);
1607
1608
1609	/*
1610	 * The TV sense state should be cleared to zero on cantiga platform. Otherwise
1611	 * the TV is misdetected. This is hardware requirement.
1612	 */
1613	if (IS_GM45(dev_priv))
1614		tv_dac &= ~(TVDAC_STATE_CHG_EN | TVDAC_A_SENSE_CTL |
1615			    TVDAC_B_SENSE_CTL | TVDAC_C_SENSE_CTL);
1616
1617	intel_de_write(dev_priv, TV_CTL, tv_ctl);
1618	intel_de_write(dev_priv, TV_DAC, tv_dac);
1619	intel_de_posting_read(dev_priv, TV_DAC);
1620
1621	intel_wait_for_vblank(dev_priv, intel_crtc->pipe);
1622
1623	type = -1;
1624	tv_dac = intel_de_read(dev_priv, TV_DAC);
1625	drm_dbg_kms(&dev_priv->drm, "TV detected: %x, %x\n", tv_ctl, tv_dac);
1626	/*
1627	 *  A B C
1628	 *  0 1 1 Composite
1629	 *  1 0 X svideo
1630	 *  0 0 0 Component
1631	 */
1632	if ((tv_dac & TVDAC_SENSE_MASK) == (TVDAC_B_SENSE | TVDAC_C_SENSE)) {
1633		drm_dbg_kms(&dev_priv->drm,
1634			    "Detected Composite TV connection\n");
1635		type = DRM_MODE_CONNECTOR_Composite;
1636	} else if ((tv_dac & (TVDAC_A_SENSE|TVDAC_B_SENSE)) == TVDAC_A_SENSE) {
1637		drm_dbg_kms(&dev_priv->drm,
1638			    "Detected S-Video TV connection\n");
1639		type = DRM_MODE_CONNECTOR_SVIDEO;
1640	} else if ((tv_dac & TVDAC_SENSE_MASK) == 0) {
1641		drm_dbg_kms(&dev_priv->drm,
1642			    "Detected Component TV connection\n");
1643		type = DRM_MODE_CONNECTOR_Component;
1644	} else {
1645		drm_dbg_kms(&dev_priv->drm, "Unrecognised TV connection\n");
1646		type = -1;
1647	}
1648
1649	intel_de_write(dev_priv, TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1650	intel_de_write(dev_priv, TV_CTL, save_tv_ctl);
1651	intel_de_posting_read(dev_priv, TV_CTL);
1652
1653	/* For unknown reasons the hw barfs if we don't do this vblank wait. */
1654	intel_wait_for_vblank(dev_priv, intel_crtc->pipe);
1655
1656	/* Restore interrupt config */
1657	if (connector->polled & DRM_CONNECTOR_POLL_HPD) {
1658		spin_lock_irq(&dev_priv->irq_lock);
1659		i915_enable_pipestat(dev_priv, 0,
1660				     PIPE_HOTPLUG_INTERRUPT_STATUS |
1661				     PIPE_HOTPLUG_TV_INTERRUPT_STATUS);
1662		spin_unlock_irq(&dev_priv->irq_lock);
1663	}
1664
1665	return type;
1666}
1667
1668/*
1669 * Here we set accurate tv format according to connector type
1670 * i.e Component TV should not be assigned by NTSC or PAL
1671 */
1672static void intel_tv_find_better_format(struct drm_connector *connector)
1673{
1674	struct intel_tv *intel_tv = intel_attached_tv(to_intel_connector(connector));
1675	const struct tv_mode *tv_mode = intel_tv_mode_find(connector->state);
1676	int i;
1677
1678	/* Component supports everything so we can keep the current mode */
1679	if (intel_tv->type == DRM_MODE_CONNECTOR_Component)
1680		return;
1681
1682	/* If the current mode is fine don't change it */
1683	if (!tv_mode->component_only)
1684		return;
1685
1686	for (i = 0; i < ARRAY_SIZE(tv_modes); i++) {
1687		tv_mode = &tv_modes[i];
1688
1689		if (!tv_mode->component_only)
1690			break;
1691	}
1692
1693	connector->state->tv.mode = i;
1694}
1695
1696static int
1697intel_tv_detect(struct drm_connector *connector,
1698		struct drm_modeset_acquire_ctx *ctx,
1699		bool force)
1700{
1701	struct drm_i915_private *i915 = to_i915(connector->dev);
1702	struct intel_tv *intel_tv = intel_attached_tv(to_intel_connector(connector));
1703	enum drm_connector_status status;
1704	int type;
1705
1706	drm_dbg_kms(&i915->drm, "[CONNECTOR:%d:%s] force=%d\n",
1707		    connector->base.id, connector->name, force);
1708
1709	if (force) {
1710		struct intel_load_detect_pipe tmp;
1711		int ret;
1712
1713		ret = intel_get_load_detect_pipe(connector, &tmp, ctx);
1714		if (ret < 0)
1715			return ret;
1716
1717		if (ret > 0) {
1718			type = intel_tv_detect_type(intel_tv, connector);
1719			intel_release_load_detect_pipe(connector, &tmp, ctx);
1720			status = type < 0 ?
1721				connector_status_disconnected :
1722				connector_status_connected;
1723		} else
1724			status = connector_status_unknown;
1725
1726		if (status == connector_status_connected) {
1727			intel_tv->type = type;
1728			intel_tv_find_better_format(connector);
1729		}
1730
1731		return status;
1732	} else
1733		return connector->status;
1734}
1735
1736static const struct input_res {
1737	u16 w, h;
1738} input_res_table[] = {
1739	{ 640, 480 },
1740	{ 800, 600 },
1741	{ 1024, 768 },
1742	{ 1280, 1024 },
1743	{ 848, 480 },
1744	{ 1280, 720 },
1745	{ 1920, 1080 },
1746};
1747
1748/* Choose preferred mode according to line number of TV format */
1749static bool
1750intel_tv_is_preferred_mode(const struct drm_display_mode *mode,
1751			   const struct tv_mode *tv_mode)
1752{
1753	int vdisplay = intel_tv_mode_vdisplay(tv_mode);
1754
1755	/* prefer 480 line modes for all SD TV modes */
1756	if (vdisplay <= 576)
1757		vdisplay = 480;
1758
1759	return vdisplay == mode->vdisplay;
1760}
1761
1762static void
1763intel_tv_set_mode_type(struct drm_display_mode *mode,
1764		       const struct tv_mode *tv_mode)
1765{
1766	mode->type = DRM_MODE_TYPE_DRIVER;
1767
1768	if (intel_tv_is_preferred_mode(mode, tv_mode))
1769		mode->type |= DRM_MODE_TYPE_PREFERRED;
1770}
1771
1772static int
1773intel_tv_get_modes(struct drm_connector *connector)
1774{
1775	struct drm_i915_private *dev_priv = to_i915(connector->dev);
1776	const struct tv_mode *tv_mode = intel_tv_mode_find(connector->state);
1777	int i, count = 0;
1778
1779	for (i = 0; i < ARRAY_SIZE(input_res_table); i++) {
1780		const struct input_res *input = &input_res_table[i];
1781		struct drm_display_mode *mode;
1782
1783		if (input->w > 1024 &&
1784		    !tv_mode->progressive &&
1785		    !tv_mode->component_only)
1786			continue;
1787
1788		/* no vertical scaling with wide sources on gen3 */
1789		if (IS_GEN(dev_priv, 3) && input->w > 1024 &&
1790		    input->h > intel_tv_mode_vdisplay(tv_mode))
1791			continue;
1792
1793		mode = drm_mode_create(connector->dev);
1794		if (!mode)
1795			continue;
1796
1797		/*
1798		 * We take the TV mode and scale it to look
1799		 * like it had the expected h/vdisplay. This
1800		 * provides the most information to userspace
1801		 * about the actual timings of the mode. We
1802		 * do ignore the margins though.
1803		 */
1804		intel_tv_mode_to_mode(mode, tv_mode);
1805		if (count == 0) {
1806			drm_dbg_kms(&dev_priv->drm, "TV mode:\n");
1807			drm_mode_debug_printmodeline(mode);
1808		}
1809		intel_tv_scale_mode_horiz(mode, input->w, 0, 0);
1810		intel_tv_scale_mode_vert(mode, input->h, 0, 0);
1811		intel_tv_set_mode_type(mode, tv_mode);
1812
1813		drm_mode_set_name(mode);
1814
1815		drm_mode_probed_add(connector, mode);
1816		count++;
1817	}
1818
1819	return count;
1820}
1821
1822static const struct drm_connector_funcs intel_tv_connector_funcs = {
1823	.late_register = intel_connector_register,
1824	.early_unregister = intel_connector_unregister,
1825	.destroy = intel_connector_destroy,
1826	.fill_modes = drm_helper_probe_single_connector_modes,
1827	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
1828	.atomic_duplicate_state = intel_tv_connector_duplicate_state,
1829};
1830
1831static int intel_tv_atomic_check(struct drm_connector *connector,
1832				 struct drm_atomic_state *state)
1833{
1834	struct drm_connector_state *new_state;
1835	struct drm_crtc_state *new_crtc_state;
1836	struct drm_connector_state *old_state;
1837
1838	new_state = drm_atomic_get_new_connector_state(state, connector);
1839	if (!new_state->crtc)
1840		return 0;
1841
1842	old_state = drm_atomic_get_old_connector_state(state, connector);
1843	new_crtc_state = drm_atomic_get_new_crtc_state(state, new_state->crtc);
1844
1845	if (old_state->tv.mode != new_state->tv.mode ||
1846	    old_state->tv.margins.left != new_state->tv.margins.left ||
1847	    old_state->tv.margins.right != new_state->tv.margins.right ||
1848	    old_state->tv.margins.top != new_state->tv.margins.top ||
1849	    old_state->tv.margins.bottom != new_state->tv.margins.bottom) {
1850		/* Force a modeset. */
1851
1852		new_crtc_state->connectors_changed = true;
1853	}
1854
1855	return 0;
1856}
1857
1858static const struct drm_connector_helper_funcs intel_tv_connector_helper_funcs = {
1859	.detect_ctx = intel_tv_detect,
1860	.mode_valid = intel_tv_mode_valid,
1861	.get_modes = intel_tv_get_modes,
1862	.atomic_check = intel_tv_atomic_check,
1863};
1864
1865static const struct drm_encoder_funcs intel_tv_enc_funcs = {
1866	.destroy = intel_encoder_destroy,
1867};
1868
1869void
1870intel_tv_init(struct drm_i915_private *dev_priv)
1871{
1872	struct drm_device *dev = &dev_priv->drm;
1873	struct drm_connector *connector;
1874	struct intel_tv *intel_tv;
1875	struct intel_encoder *intel_encoder;
1876	struct intel_connector *intel_connector;
1877	u32 tv_dac_on, tv_dac_off, save_tv_dac;
1878	const char *tv_format_names[ARRAY_SIZE(tv_modes)];
1879	int i, initial_mode = 0;
1880	struct drm_connector_state *state;
1881
1882	if ((intel_de_read(dev_priv, TV_CTL) & TV_FUSE_STATE_MASK) == TV_FUSE_STATE_DISABLED)
1883		return;
1884
1885	if (!intel_bios_is_tv_present(dev_priv)) {
1886		drm_dbg_kms(&dev_priv->drm, "Integrated TV is not present.\n");
1887		return;
1888	}
1889
1890	/*
1891	 * Sanity check the TV output by checking to see if the
1892	 * DAC register holds a value
1893	 */
1894	save_tv_dac = intel_de_read(dev_priv, TV_DAC);
1895
1896	intel_de_write(dev_priv, TV_DAC, save_tv_dac | TVDAC_STATE_CHG_EN);
1897	tv_dac_on = intel_de_read(dev_priv, TV_DAC);
1898
1899	intel_de_write(dev_priv, TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1900	tv_dac_off = intel_de_read(dev_priv, TV_DAC);
1901
1902	intel_de_write(dev_priv, TV_DAC, save_tv_dac);
1903
1904	/*
1905	 * If the register does not hold the state change enable
1906	 * bit, (either as a 0 or a 1), assume it doesn't really
1907	 * exist
1908	 */
1909	if ((tv_dac_on & TVDAC_STATE_CHG_EN) == 0 ||
1910	    (tv_dac_off & TVDAC_STATE_CHG_EN) != 0)
1911		return;
1912
1913	intel_tv = kzalloc(sizeof(*intel_tv), GFP_KERNEL);
1914	if (!intel_tv) {
1915		return;
1916	}
1917
1918	intel_connector = intel_connector_alloc();
1919	if (!intel_connector) {
1920		kfree(intel_tv);
1921		return;
1922	}
1923
1924	intel_encoder = &intel_tv->base;
1925	connector = &intel_connector->base;
1926	state = connector->state;
1927
1928	/*
1929	 * The documentation, for the older chipsets at least, recommend
1930	 * using a polling method rather than hotplug detection for TVs.
1931	 * This is because in order to perform the hotplug detection, the PLLs
1932	 * for the TV must be kept alive increasing power drain and starving
1933	 * bandwidth from other encoders. Notably for instance, it causes
1934	 * pipe underruns on Crestline when this encoder is supposedly idle.
1935	 *
1936	 * More recent chipsets favour HDMI rather than integrated S-Video.
1937	 */
1938	intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT;
1939
1940	drm_connector_init(dev, connector, &intel_tv_connector_funcs,
1941			   DRM_MODE_CONNECTOR_SVIDEO);
1942
1943	drm_encoder_init(dev, &intel_encoder->base, &intel_tv_enc_funcs,
1944			 DRM_MODE_ENCODER_TVDAC, "TV");
1945
1946	intel_encoder->compute_config = intel_tv_compute_config;
1947	intel_encoder->get_config = intel_tv_get_config;
1948	intel_encoder->pre_enable = intel_tv_pre_enable;
1949	intel_encoder->enable = intel_enable_tv;
1950	intel_encoder->disable = intel_disable_tv;
1951	intel_encoder->get_hw_state = intel_tv_get_hw_state;
1952	intel_connector->get_hw_state = intel_connector_get_hw_state;
1953
1954	intel_connector_attach_encoder(intel_connector, intel_encoder);
1955
1956	intel_encoder->type = INTEL_OUTPUT_TVOUT;
1957	intel_encoder->power_domain = POWER_DOMAIN_PORT_OTHER;
1958	intel_encoder->port = PORT_NONE;
1959	intel_encoder->pipe_mask = ~0;
1960	intel_encoder->cloneable = 0;
1961	intel_tv->type = DRM_MODE_CONNECTOR_Unknown;
1962
1963	/* BIOS margin values */
1964	state->tv.margins.left = 54;
1965	state->tv.margins.top = 36;
1966	state->tv.margins.right = 46;
1967	state->tv.margins.bottom = 37;
1968
1969	state->tv.mode = initial_mode;
1970
1971	drm_connector_helper_add(connector, &intel_tv_connector_helper_funcs);
1972	connector->interlace_allowed = false;
1973	connector->doublescan_allowed = false;
1974
1975	/* Create TV properties then attach current values */
1976	for (i = 0; i < ARRAY_SIZE(tv_modes); i++) {
1977		/* 1080p50/1080p60 not supported on gen3 */
1978		if (IS_GEN(dev_priv, 3) &&
1979		    tv_modes[i].oversample == 1)
1980			break;
1981
1982		tv_format_names[i] = tv_modes[i].name;
1983	}
1984	drm_mode_create_tv_properties(dev, i, tv_format_names);
1985
1986	drm_object_attach_property(&connector->base, dev->mode_config.tv_mode_property,
1987				   state->tv.mode);
1988	drm_object_attach_property(&connector->base,
1989				   dev->mode_config.tv_left_margin_property,
1990				   state->tv.margins.left);
1991	drm_object_attach_property(&connector->base,
1992				   dev->mode_config.tv_top_margin_property,
1993				   state->tv.margins.top);
1994	drm_object_attach_property(&connector->base,
1995				   dev->mode_config.tv_right_margin_property,
1996				   state->tv.margins.right);
1997	drm_object_attach_property(&connector->base,
1998				   dev->mode_config.tv_bottom_margin_property,
1999				   state->tv.margins.bottom);
2000}