]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/gpu/drm/i915/intel_tv.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
drm/i915: wait for actual vblank, not just 20ms
[net-next-2.6.git] / drivers / gpu / drm / i915 / intel_tv.c
CommitLineData
79e53945
JB		 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 */
ea5b213a
CW		 47struct intel_tv {
48 struct intel_encoder base;
49
79e53945
JB		 50 int type;
51 char *tv_format;
52 int margin[4];
53 u32 save_TV_H_CTL_1;
54 u32 save_TV_H_CTL_2;
55 u32 save_TV_H_CTL_3;
56 u32 save_TV_V_CTL_1;
57 u32 save_TV_V_CTL_2;
58 u32 save_TV_V_CTL_3;
59 u32 save_TV_V_CTL_4;
60 u32 save_TV_V_CTL_5;
61 u32 save_TV_V_CTL_6;
62 u32 save_TV_V_CTL_7;
63 u32 save_TV_SC_CTL_1, save_TV_SC_CTL_2, save_TV_SC_CTL_3;
64
65 u32 save_TV_CSC_Y;
66 u32 save_TV_CSC_Y2;
67 u32 save_TV_CSC_U;
68 u32 save_TV_CSC_U2;
69 u32 save_TV_CSC_V;
70 u32 save_TV_CSC_V2;
71 u32 save_TV_CLR_KNOBS;
72 u32 save_TV_CLR_LEVEL;
73 u32 save_TV_WIN_POS;
74 u32 save_TV_WIN_SIZE;
75 u32 save_TV_FILTER_CTL_1;
76 u32 save_TV_FILTER_CTL_2;
77 u32 save_TV_FILTER_CTL_3;
78
79 u32 save_TV_H_LUMA[60];
80 u32 save_TV_H_CHROMA[60];
81 u32 save_TV_V_LUMA[43];
82 u32 save_TV_V_CHROMA[43];
83
84 u32 save_TV_DAC;
85 u32 save_TV_CTL;
86};
87
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,
ba01079c
ZW		 222 .ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
223 .rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
79e53945
JB		 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 = {
ba01079c
ZW		 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,
79e53945
JB		 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,
ba01079c
ZW		 242 .ru = 0x074c, .gu = 0x0546, .bu = 0x05ec, .au = 0x0200,
243 .rv = 0x035a, .gv = 0x0322, .bv = 0x06e1, .av = 0x0200,
79e53945
JB		 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,
ba01079c
ZW		 252 .ru = 0x0788, .gu = 0x0581, .bu = 0x0322, .au = 0x0200,
253 .rv = 0x0399, .gv = 0x0356, .bv = 0x070a, .av = 0x0200,
79e53945
JB		 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,
ba01079c
ZW		 262 .ru = 0x0745, .gu = 0x053f, .bu = 0x05e1, .au = 0x0200,
263 .rv = 0x0353, .gv = 0x031c, .bv = 0x06dc, .av = 0x0200,
79e53945
JB		 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,
ba01079c
ZW		 272 .ru = 0x0780, .gu = 0x0579, .bu = 0x031c, .au = 0x0200,
273 .rv = 0x0390, .gv = 0x034f, .bv = 0x0705, .av = 0x0200,
79e53945
JB		 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,
ba01079c
ZW		 282 .ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
283 .rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
79e53945
JB		 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 = {
ba01079c
ZW		 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,
79e53945
JB		 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,
ba01079c
ZW		 302 .ru = 0x0733, .gu = 0x052d, .bu = 0x05c7, .au = 0x0200,
303 .rv = 0x0340, .gv = 0x030c, .bv = 0x06d0, .av = 0x0200,
79e53945
JB		 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 = {
ba01079c
ZW		 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,
79e53945
JB		 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 = {
ba01079c
ZW		 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,
79e53945
JB		 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 = {
ba01079c
ZW		 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,
79e53945
JB		 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 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
005568be 416static const struct tv_mode tv_modes[] = {
79e53945
JB		 417 {
418 .name = "NTSC-M",
ba01079c 419 .clock = 108000,
79e53945
JB		 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 */
ba01079c
ZW		 447 .dda1_inc = 135,
448 .dda2_inc = 20800, .dda2_size = 27456,
79e53945
JB		 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",
ba01079c 462 .clock = 108000,
79e53945
JB		 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
3ca87e82 481 .burst_ena = true,
79e53945
JB		 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,
ba01079c
ZW		 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,
79e53945
JB		 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",
ba01079c 504 .clock = 108000,
79e53945
JB		 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 */
ba01079c
ZW		 532 .dda1_inc = 135,
533 .dda2_inc = 20800, .dda2_size = 27456,
79e53945
JB		 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",
ba01079c 547 .clock = 108000,
79e53945
JB		 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 */
ba01079c
ZW		 575 .dda1_inc = 135,
576 .dda2_inc = 16704, .dda2_size = 27456,
79e53945 577 .dda3_inc = 0, .dda3_size = 0,
ba01079c
ZW		 578 .sc_reset = TV_SC_RESET_EVERY_8,
579 .pal_burst = true,
79e53945
JB		 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",
ba01079c 591 .clock = 108000,
79e53945
JB		 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 */
ba01079c
ZW		 620 .dda1_inc = 135,
621 .dda2_inc = 23578, .dda2_size = 27648,
622 .dda3_inc = 134, .dda3_size = 625,
79e53945
JB		 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",
ba01079c 636 .clock = 108000,
79e53945
JB		 637 .refresh = 25000,
638 .oversample = TV_OVERSAMPLE_8X,
639 .component_only = 0,
640
ba01079c 641 .hsync_end = 64, .hblank_end = 142,
79e53945
JB		 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,
ba01079c
ZW		 664 .dda2_inc = 4122, .dda2_size = 27648,
665 .dda3_inc = 67, .dda3_size = 625,
79e53945
JB		 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,
ba01079c 694 .nbr_end = 479,
79e53945
JB		 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,
ba01079c 718 .nbr_end = 479,
79e53945
JB		 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,
ba01079c 881 .hblank_start = 2155, .htotal = 2201,
79e53945
JB		 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
ea5b213a
CW		 901static struct intel_tv *enc_to_intel_tv(struct drm_encoder *encoder)
902{
903 return container_of(enc_to_intel_encoder(encoder), struct intel_tv, base);
904}
905
79e53945
JB		 906static void
907intel_tv_dpms(struct drm_encoder *encoder, int mode)
908{
909 struct drm_device *dev = encoder->dev;
910 struct drm_i915_private *dev_priv = dev->dev_private;
911
912 switch(mode) {
913 case DRM_MODE_DPMS_ON:
914 I915_WRITE(TV_CTL, I915_READ(TV_CTL) | TV_ENC_ENABLE);
915 break;
916 case DRM_MODE_DPMS_STANDBY:
917 case DRM_MODE_DPMS_SUSPEND:
918 case DRM_MODE_DPMS_OFF:
919 I915_WRITE(TV_CTL, I915_READ(TV_CTL) & ~TV_ENC_ENABLE);
920 break;
921 }
922}
923
79e53945
JB		 924static const struct tv_mode *
925intel_tv_mode_lookup (char *tv_format)
926{
927 int i;
928
929 for (i = 0; i < sizeof(tv_modes) / sizeof (tv_modes[0]); i++) {
930 const struct tv_mode *tv_mode = &tv_modes[i];
931
932 if (!strcmp(tv_format, tv_mode->name))
933 return tv_mode;
934 }
935 return NULL;
936}
937
938static const struct tv_mode *
ea5b213a 939intel_tv_mode_find (struct intel_tv *intel_tv)
79e53945 940{
ea5b213a 941 return intel_tv_mode_lookup(intel_tv->tv_format);
79e53945
JB		 942}
943
944static enum drm_mode_status
945intel_tv_mode_valid(struct drm_connector *connector, struct drm_display_mode *mode)
946{
0c41ee2b 947 struct drm_encoder *encoder = intel_attached_encoder(connector);
ea5b213a
CW		 948 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
949 const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
79e53945
JB		 950
951 /* Ensure TV refresh is close to desired refresh */
0d0884ce
ZY		 952 if (tv_mode && abs(tv_mode->refresh - drm_mode_vrefresh(mode) * 1000)
953 < 1000)
79e53945
JB		 954 return MODE_OK;
955 return MODE_CLOCK_RANGE;
956}
957
958
959static bool
960intel_tv_mode_fixup(struct drm_encoder *encoder, struct drm_display_mode *mode,
961 struct drm_display_mode *adjusted_mode)
962{
963 struct drm_device *dev = encoder->dev;
964 struct drm_mode_config *drm_config = &dev->mode_config;
ea5b213a
CW		 965 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
966 const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
79e53945
JB		 967 struct drm_encoder *other_encoder;
968
969 if (!tv_mode)
970 return false;
971
972 /* FIXME: lock encoder list */
973 list_for_each_entry(other_encoder, &drm_config->encoder_list, head) {
974 if (other_encoder != encoder &&
975 other_encoder->crtc == encoder->crtc)
976 return false;
977 }
978
979 adjusted_mode->clock = tv_mode->clock;
980 return true;
981}
982
983static void
984intel_tv_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode,
985 struct drm_display_mode *adjusted_mode)
986{
987 struct drm_device *dev = encoder->dev;
988 struct drm_i915_private *dev_priv = dev->dev_private;
989 struct drm_crtc *crtc = encoder->crtc;
990 struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
ea5b213a
CW		 991 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
992 const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
79e53945
JB		 993 u32 tv_ctl;
994 u32 hctl1, hctl2, hctl3;
995 u32 vctl1, vctl2, vctl3, vctl4, vctl5, vctl6, vctl7;
996 u32 scctl1, scctl2, scctl3;
997 int i, j;
998 const struct video_levels *video_levels;
999 const struct color_conversion *color_conversion;
1000 bool burst_ena;
1001
1002 if (!tv_mode)
1003 return; /* can't happen (mode_prepare prevents this) */
1004
d2d9f232
ZW		 1005 tv_ctl = I915_READ(TV_CTL);
1006 tv_ctl &= TV_CTL_SAVE;
79e53945 1007
ea5b213a 1008 switch (intel_tv->type) {
79e53945
JB		 1009 default:
1010 case DRM_MODE_CONNECTOR_Unknown:
1011 case DRM_MODE_CONNECTOR_Composite:
1012 tv_ctl |= TV_ENC_OUTPUT_COMPOSITE;
1013 video_levels = tv_mode->composite_levels;
1014 color_conversion = tv_mode->composite_color;
1015 burst_ena = tv_mode->burst_ena;
1016 break;
1017 case DRM_MODE_CONNECTOR_Component:
1018 tv_ctl |= TV_ENC_OUTPUT_COMPONENT;
1019 video_levels = &component_levels;
1020 if (tv_mode->burst_ena)
1021 color_conversion = &sdtv_csc_yprpb;
1022 else
1023 color_conversion = &hdtv_csc_yprpb;
1024 burst_ena = false;
1025 break;
1026 case DRM_MODE_CONNECTOR_SVIDEO:
1027 tv_ctl |= TV_ENC_OUTPUT_SVIDEO;
1028 video_levels = tv_mode->svideo_levels;
1029 color_conversion = tv_mode->svideo_color;
1030 burst_ena = tv_mode->burst_ena;
1031 break;
1032 }
1033 hctl1 = (tv_mode->hsync_end << TV_HSYNC_END_SHIFT) |
1034 (tv_mode->htotal << TV_HTOTAL_SHIFT);
1035
1036 hctl2 = (tv_mode->hburst_start << 16) |
1037 (tv_mode->hburst_len << TV_HBURST_LEN_SHIFT);
1038
1039 if (burst_ena)
1040 hctl2 |= TV_BURST_ENA;
1041
1042 hctl3 = (tv_mode->hblank_start << TV_HBLANK_START_SHIFT) |
1043 (tv_mode->hblank_end << TV_HBLANK_END_SHIFT);
1044
1045 vctl1 = (tv_mode->nbr_end << TV_NBR_END_SHIFT) |
1046 (tv_mode->vi_end_f1 << TV_VI_END_F1_SHIFT) |
1047 (tv_mode->vi_end_f2 << TV_VI_END_F2_SHIFT);
1048
1049 vctl2 = (tv_mode->vsync_len << TV_VSYNC_LEN_SHIFT) |
1050 (tv_mode->vsync_start_f1 << TV_VSYNC_START_F1_SHIFT) |
1051 (tv_mode->vsync_start_f2 << TV_VSYNC_START_F2_SHIFT);
1052
1053 vctl3 = (tv_mode->veq_len << TV_VEQ_LEN_SHIFT) |
1054 (tv_mode->veq_start_f1 << TV_VEQ_START_F1_SHIFT) |
1055 (tv_mode->veq_start_f2 << TV_VEQ_START_F2_SHIFT);
1056
1057 if (tv_mode->veq_ena)
1058 vctl3 |= TV_EQUAL_ENA;
1059
1060 vctl4 = (tv_mode->vburst_start_f1 << TV_VBURST_START_F1_SHIFT) |
1061 (tv_mode->vburst_end_f1 << TV_VBURST_END_F1_SHIFT);
1062
1063 vctl5 = (tv_mode->vburst_start_f2 << TV_VBURST_START_F2_SHIFT) |
1064 (tv_mode->vburst_end_f2 << TV_VBURST_END_F2_SHIFT);
1065
1066 vctl6 = (tv_mode->vburst_start_f3 << TV_VBURST_START_F3_SHIFT) |
1067 (tv_mode->vburst_end_f3 << TV_VBURST_END_F3_SHIFT);
1068
1069 vctl7 = (tv_mode->vburst_start_f4 << TV_VBURST_START_F4_SHIFT) |
1070 (tv_mode->vburst_end_f4 << TV_VBURST_END_F4_SHIFT);
1071
1072 if (intel_crtc->pipe == 1)
1073 tv_ctl |= TV_ENC_PIPEB_SELECT;
1074 tv_ctl |= tv_mode->oversample;
1075
1076 if (tv_mode->progressive)
1077 tv_ctl |= TV_PROGRESSIVE;
1078 if (tv_mode->trilevel_sync)
1079 tv_ctl |= TV_TRILEVEL_SYNC;
1080 if (tv_mode->pal_burst)
1081 tv_ctl |= TV_PAL_BURST;
d271817b 1082
79e53945 1083 scctl1 = 0;
d271817b 1084 if (tv_mode->dda1_inc)
79e53945 1085 scctl1 |= TV_SC_DDA1_EN;
79e53945
JB		 1086 if (tv_mode->dda2_inc)
1087 scctl1 |= TV_SC_DDA2_EN;
79e53945
JB		 1088 if (tv_mode->dda3_inc)
1089 scctl1 |= TV_SC_DDA3_EN;
79e53945 1090 scctl1 |= tv_mode->sc_reset;
d271817b
CW		 1091 if (video_levels)
1092 scctl1 |= video_levels->burst << TV_BURST_LEVEL_SHIFT;
79e53945
JB		 1093 scctl1 |= tv_mode->dda1_inc << TV_SCDDA1_INC_SHIFT;
1094
1095 scctl2 = tv_mode->dda2_size << TV_SCDDA2_SIZE_SHIFT |
1096 tv_mode->dda2_inc << TV_SCDDA2_INC_SHIFT;
1097
1098 scctl3 = tv_mode->dda3_size << TV_SCDDA3_SIZE_SHIFT |
1099 tv_mode->dda3_inc << TV_SCDDA3_INC_SHIFT;
1100
1101 /* Enable two fixes for the chips that need them. */
1102 if (dev->pci_device < 0x2772)
1103 tv_ctl |= TV_ENC_C0_FIX | TV_ENC_SDP_FIX;
1104
1105 I915_WRITE(TV_H_CTL_1, hctl1);
1106 I915_WRITE(TV_H_CTL_2, hctl2);
1107 I915_WRITE(TV_H_CTL_3, hctl3);
1108 I915_WRITE(TV_V_CTL_1, vctl1);
1109 I915_WRITE(TV_V_CTL_2, vctl2);
1110 I915_WRITE(TV_V_CTL_3, vctl3);
1111 I915_WRITE(TV_V_CTL_4, vctl4);
1112 I915_WRITE(TV_V_CTL_5, vctl5);
1113 I915_WRITE(TV_V_CTL_6, vctl6);
1114 I915_WRITE(TV_V_CTL_7, vctl7);
1115 I915_WRITE(TV_SC_CTL_1, scctl1);
1116 I915_WRITE(TV_SC_CTL_2, scctl2);
1117 I915_WRITE(TV_SC_CTL_3, scctl3);
1118
1119 if (color_conversion) {
1120 I915_WRITE(TV_CSC_Y, (color_conversion->ry << 16) |
1121 color_conversion->gy);
1122 I915_WRITE(TV_CSC_Y2,(color_conversion->by << 16) |
1123 color_conversion->ay);
1124 I915_WRITE(TV_CSC_U, (color_conversion->ru << 16) |
1125 color_conversion->gu);
1126 I915_WRITE(TV_CSC_U2, (color_conversion->bu << 16) |
1127 color_conversion->au);
1128 I915_WRITE(TV_CSC_V, (color_conversion->rv << 16) |
1129 color_conversion->gv);
1130 I915_WRITE(TV_CSC_V2, (color_conversion->bv << 16) |
1131 color_conversion->av);
1132 }
1133
d2d9f232
ZW		 1134 if (IS_I965G(dev))
1135 I915_WRITE(TV_CLR_KNOBS, 0x00404000);
1136 else
1137 I915_WRITE(TV_CLR_KNOBS, 0x00606000);
1138
79e53945
JB		 1139 if (video_levels)
1140 I915_WRITE(TV_CLR_LEVEL,
1141 ((video_levels->black << TV_BLACK_LEVEL_SHIFT) |
1142 (video_levels->blank << TV_BLANK_LEVEL_SHIFT)));
1143 {
1144 int pipeconf_reg = (intel_crtc->pipe == 0) ?
1145 PIPEACONF : PIPEBCONF;
1146 int dspcntr_reg = (intel_crtc->plane == 0) ?
1147 DSPACNTR : DSPBCNTR;
1148 int pipeconf = I915_READ(pipeconf_reg);
1149 int dspcntr = I915_READ(dspcntr_reg);
1150 int dspbase_reg = (intel_crtc->plane == 0) ?
1151 DSPAADDR : DSPBADDR;
1152 int xpos = 0x0, ypos = 0x0;
1153 unsigned int xsize, ysize;
1154 /* Pipe must be off here */
1155 I915_WRITE(dspcntr_reg, dspcntr & ~DISPLAY_PLANE_ENABLE);
1156 /* Flush the plane changes */
1157 I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1158
1159 /* Wait for vblank for the disable to take effect */
1160 if (!IS_I9XX(dev))
9d0498a2 1161 intel_wait_for_vblank(dev, intel_crtc->pipe);
79e53945
JB		 1162
1163 I915_WRITE(pipeconf_reg, pipeconf & ~PIPEACONF_ENABLE);
1164 /* Wait for vblank for the disable to take effect. */
9d0498a2 1165 intel_wait_for_vblank(dev, intel_crtc->pipe);
79e53945
JB		 1166
1167 /* Filter ctl must be set before TV_WIN_SIZE */
1168 I915_WRITE(TV_FILTER_CTL_1, TV_AUTO_SCALE);
1169 xsize = tv_mode->hblank_start - tv_mode->hblank_end;
1170 if (tv_mode->progressive)
1171 ysize = tv_mode->nbr_end + 1;
1172 else
1173 ysize = 2*tv_mode->nbr_end + 1;
1174
ea5b213a
CW		 1175 xpos += intel_tv->margin[TV_MARGIN_LEFT];
1176 ypos += intel_tv->margin[TV_MARGIN_TOP];
1177 xsize -= (intel_tv->margin[TV_MARGIN_LEFT] +
1178 intel_tv->margin[TV_MARGIN_RIGHT]);
1179 ysize -= (intel_tv->margin[TV_MARGIN_TOP] +
1180 intel_tv->margin[TV_MARGIN_BOTTOM]);
79e53945
JB		 1181 I915_WRITE(TV_WIN_POS, (xpos<<16)|ypos);
1182 I915_WRITE(TV_WIN_SIZE, (xsize<<16)|ysize);
1183
1184 I915_WRITE(pipeconf_reg, pipeconf);
1185 I915_WRITE(dspcntr_reg, dspcntr);
1186 /* Flush the plane changes */
1187 I915_WRITE(dspbase_reg, I915_READ(dspbase_reg));
1188 }
1189
1190 j = 0;
1191 for (i = 0; i < 60; i++)
1192 I915_WRITE(TV_H_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1193 for (i = 0; i < 60; i++)
1194 I915_WRITE(TV_H_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1195 for (i = 0; i < 43; i++)
1196 I915_WRITE(TV_V_LUMA_0 + (i<<2), tv_mode->filter_table[j++]);
1197 for (i = 0; i < 43; i++)
1198 I915_WRITE(TV_V_CHROMA_0 + (i<<2), tv_mode->filter_table[j++]);
1199 I915_WRITE(TV_DAC, 0);
1200 I915_WRITE(TV_CTL, tv_ctl);
1201}
1202
1203static const struct drm_display_mode reported_modes[] = {
1204 {
1205 .name = "NTSC 480i",
1206 .clock = 107520,
1207 .hdisplay = 1280,
1208 .hsync_start = 1368,
1209 .hsync_end = 1496,
1210 .htotal = 1712,
1211
1212 .vdisplay = 1024,
1213 .vsync_start = 1027,
1214 .vsync_end = 1034,
1215 .vtotal = 1104,
1216 .type = DRM_MODE_TYPE_DRIVER,
1217 },
1218};
1219
1220/**
1221 * Detects TV presence by checking for load.
1222 *
1223 * Requires that the current pipe's DPLL is active.
1224
1225 * \return true if TV is connected.
1226 * \return false if TV is disconnected.
1227 */
1228static int
ea5b213a 1229intel_tv_detect_type (struct intel_tv *intel_tv)
79e53945 1230{
ea5b213a 1231 struct drm_encoder *encoder = &intel_tv->base.enc;
79e53945
JB		 1232 struct drm_device *dev = encoder->dev;
1233 struct drm_i915_private *dev_priv = dev->dev_private;
9d0498a2 1234 struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
79e53945
JB		 1235 unsigned long irqflags;
1236 u32 tv_ctl, save_tv_ctl;
1237 u32 tv_dac, save_tv_dac;
1238 int type = DRM_MODE_CONNECTOR_Unknown;
1239
1240 tv_dac = I915_READ(TV_DAC);
1241
1242 /* Disable TV interrupts around load detect or we'll recurse */
1243 spin_lock_irqsave(&dev_priv->user_irq_lock, irqflags);
1244 i915_disable_pipestat(dev_priv, 0, PIPE_HOTPLUG_INTERRUPT_ENABLE |
1245 PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1246 spin_unlock_irqrestore(&dev_priv->user_irq_lock, irqflags);
1247
1248 /*
1249 * Detect TV by polling)
1250 */
8ed9a5bc 1251 save_tv_dac = tv_dac;
1252 tv_ctl = I915_READ(TV_CTL);
1253 save_tv_ctl = tv_ctl;
1254 tv_ctl &= ~TV_ENC_ENABLE;
1255 tv_ctl &= ~TV_TEST_MODE_MASK;
1256 tv_ctl |= TV_TEST_MODE_MONITOR_DETECT;
1257 tv_dac &= ~TVDAC_SENSE_MASK;
1258 tv_dac &= ~DAC_A_MASK;
1259 tv_dac &= ~DAC_B_MASK;
1260 tv_dac &= ~DAC_C_MASK;
1261 tv_dac |= (TVDAC_STATE_CHG_EN |
1262 TVDAC_A_SENSE_CTL |
1263 TVDAC_B_SENSE_CTL |
1264 TVDAC_C_SENSE_CTL |
1265 DAC_CTL_OVERRIDE |
1266 DAC_A_0_7_V |
1267 DAC_B_0_7_V |
1268 DAC_C_0_7_V);
1269 I915_WRITE(TV_CTL, tv_ctl);
1270 I915_WRITE(TV_DAC, tv_dac);
9d0498a2 1271 intel_wait_for_vblank(dev, intel_crtc->pipe);
8ed9a5bc 1272 tv_dac = I915_READ(TV_DAC);
1273 I915_WRITE(TV_DAC, save_tv_dac);
1274 I915_WRITE(TV_CTL, save_tv_ctl);
9d0498a2 1275 intel_wait_for_vblank(dev, intel_crtc->pipe);
79e53945
JB		 1276 /*
1277 * A B C
1278 * 0 1 1 Composite
1279 * 1 0 X svideo
1280 * 0 0 0 Component
1281 */
1282 if ((tv_dac & TVDAC_SENSE_MASK) == (TVDAC_B_SENSE | TVDAC_C_SENSE)) {
28c97730 1283 DRM_DEBUG_KMS("Detected Composite TV connection\n");
79e53945
JB		 1284 type = DRM_MODE_CONNECTOR_Composite;
1285 } else if ((tv_dac & (TVDAC_A_SENSE|TVDAC_B_SENSE)) == TVDAC_A_SENSE) {
28c97730 1286 DRM_DEBUG_KMS("Detected S-Video TV connection\n");
79e53945
JB		 1287 type = DRM_MODE_CONNECTOR_SVIDEO;
1288 } else if ((tv_dac & TVDAC_SENSE_MASK) == 0) {
28c97730 1289 DRM_DEBUG_KMS("Detected Component TV connection\n");
79e53945
JB		 1290 type = DRM_MODE_CONNECTOR_Component;
1291 } else {
28c97730 1292 DRM_DEBUG_KMS("No TV connection detected\n");
79e53945
JB		 1293 type = -1;
1294 }
1295
1296 /* Restore interrupt config */
1297 spin_lock_irqsave(&dev_priv->user_irq_lock, irqflags);
1298 i915_enable_pipestat(dev_priv, 0, PIPE_HOTPLUG_INTERRUPT_ENABLE |
1299 PIPE_HOTPLUG_TV_INTERRUPT_ENABLE);
1300 spin_unlock_irqrestore(&dev_priv->user_irq_lock, irqflags);
1301
1302 return type;
1303}
1304
213c2e64
ML		 1305/*
1306 * Here we set accurate tv format according to connector type
1307 * i.e Component TV should not be assigned by NTSC or PAL
1308 */
1309static void intel_tv_find_better_format(struct drm_connector *connector)
1310{
0c41ee2b 1311 struct drm_encoder *encoder = intel_attached_encoder(connector);
ea5b213a
CW		 1312 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1313 const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
213c2e64
ML		 1314 int i;
1315
ea5b213a 1316 if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
213c2e64
ML		 1317 tv_mode->component_only)
1318 return;
1319
1320
1321 for (i = 0; i < sizeof(tv_modes) / sizeof(*tv_modes); i++) {
1322 tv_mode = tv_modes + i;
1323
ea5b213a 1324 if ((intel_tv->type == DRM_MODE_CONNECTOR_Component) ==
213c2e64
ML		 1325 tv_mode->component_only)
1326 break;
1327 }
1328
ea5b213a 1329 intel_tv->tv_format = tv_mode->name;
213c2e64
ML		 1330 drm_connector_property_set_value(connector,
1331 connector->dev->mode_config.tv_mode_property, i);
1332}
1333
79e53945
JB		 1334/**
1335 * Detect the TV connection.
1336 *
1337 * Currently this always returns CONNECTOR_STATUS_UNKNOWN, as we need to be sure
1338 * we have a pipe programmed in order to probe the TV.
1339 */
1340static enum drm_connector_status
1341intel_tv_detect(struct drm_connector *connector)
1342{
79e53945 1343 struct drm_display_mode mode;
0c41ee2b 1344 struct drm_encoder *encoder = intel_attached_encoder(connector);
ea5b213a
CW		 1345 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1346 int type;
79e53945
JB		 1347
1348 mode = reported_modes[0];
1349 drm_mode_set_crtcinfo(&mode, CRTC_INTERLACE_HALVE_V);
1350
bf5a269a 1351 if (encoder->crtc && encoder->crtc->enabled) {
ea5b213a 1352 type = intel_tv_detect_type(intel_tv);
79e53945 1353 } else {
ea5b213a
CW		 1354 struct drm_crtc *crtc;
1355 int dpms_mode;
1356
1357 crtc = intel_get_load_detect_pipe(&intel_tv->base, connector,
c1c43977 1358 &mode, &dpms_mode);
79e53945 1359 if (crtc) {
ea5b213a
CW		 1360 type = intel_tv_detect_type(intel_tv);
1361 intel_release_load_detect_pipe(&intel_tv->base, connector,
c1c43977 1362 dpms_mode);
79e53945
JB		 1363 } else
1364 type = -1;
1365 }
1366
ea5b213a 1367 intel_tv->type = type;
bf5a269a 1368
79e53945
JB		 1369 if (type < 0)
1370 return connector_status_disconnected;
1371
213c2e64 1372 intel_tv_find_better_format(connector);
79e53945
JB		 1373 return connector_status_connected;
1374}
1375
1376static struct input_res {
1377 char *name;
1378 int w, h;
1379} input_res_table[] =
1380{
1381 {"640x480", 640, 480},
1382 {"800x600", 800, 600},
1383 {"1024x768", 1024, 768},
1384 {"1280x1024", 1280, 1024},
1385 {"848x480", 848, 480},
1386 {"1280x720", 1280, 720},
1387 {"1920x1080", 1920, 1080},
1388};
1389
bcae2ca8 1390/*
1391 * Chose preferred mode according to line number of TV format
1392 */
1393static void
1394intel_tv_chose_preferred_modes(struct drm_connector *connector,
1395 struct drm_display_mode *mode_ptr)
1396{
0c41ee2b 1397 struct drm_encoder *encoder = intel_attached_encoder(connector);
ea5b213a
CW		 1398 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1399 const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
bcae2ca8 1400
1401 if (tv_mode->nbr_end < 480 && mode_ptr->vdisplay == 480)
1402 mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1403 else if (tv_mode->nbr_end > 480) {
1404 if (tv_mode->progressive == true && tv_mode->nbr_end < 720) {
1405 if (mode_ptr->vdisplay == 720)
1406 mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1407 } else if (mode_ptr->vdisplay == 1080)
1408 mode_ptr->type |= DRM_MODE_TYPE_PREFERRED;
1409 }
1410}
1411
79e53945
JB		 1412/**
1413 * Stub get_modes function.
1414 *
1415 * This should probably return a set of fixed modes, unless we can figure out
1416 * how to probe modes off of TV connections.
1417 */
1418
1419static int
1420intel_tv_get_modes(struct drm_connector *connector)
1421{
1422 struct drm_display_mode *mode_ptr;
0c41ee2b 1423 struct drm_encoder *encoder = intel_attached_encoder(connector);
ea5b213a
CW		 1424 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
1425 const struct tv_mode *tv_mode = intel_tv_mode_find(intel_tv);
02c5dd98
ZW		 1426 int j, count = 0;
1427 u64 tmp;
79e53945 1428
04ad327f 1429 for (j = 0; j < ARRAY_SIZE(input_res_table);
79e53945
JB		 1430 j++) {
1431 struct input_res *input = &input_res_table[j];
1432 unsigned int hactive_s = input->w;
1433 unsigned int vactive_s = input->h;
1434
1435 if (tv_mode->max_srcw && input->w > tv_mode->max_srcw)
1436 continue;
1437
1438 if (input->w > 1024 && (!tv_mode->progressive
1439 && !tv_mode->component_only))
1440 continue;
1441
02c5dd98
ZW		 1442 mode_ptr = drm_mode_create(connector->dev);
1443 if (!mode_ptr)
1444 continue;
79e53945
JB		 1445 strncpy(mode_ptr->name, input->name, DRM_DISPLAY_MODE_LEN);
1446
1447 mode_ptr->hdisplay = hactive_s;
1448 mode_ptr->hsync_start = hactive_s + 1;
1449 mode_ptr->hsync_end = hactive_s + 64;
1450 if (mode_ptr->hsync_end <= mode_ptr->hsync_start)
1451 mode_ptr->hsync_end = mode_ptr->hsync_start + 1;
1452 mode_ptr->htotal = hactive_s + 96;
1453
1454 mode_ptr->vdisplay = vactive_s;
1455 mode_ptr->vsync_start = vactive_s + 1;
1456 mode_ptr->vsync_end = vactive_s + 32;
1457 if (mode_ptr->vsync_end <= mode_ptr->vsync_start)
1458 mode_ptr->vsync_end = mode_ptr->vsync_start + 1;
1459 mode_ptr->vtotal = vactive_s + 33;
1460
02c5dd98
ZW		 1461 tmp = (u64) tv_mode->refresh * mode_ptr->vtotal;
1462 tmp *= mode_ptr->htotal;
1463 tmp = div_u64(tmp, 1000000);
1464 mode_ptr->clock = (int) tmp;
79e53945
JB		 1465
1466 mode_ptr->type = DRM_MODE_TYPE_DRIVER;
bcae2ca8 1467 intel_tv_chose_preferred_modes(connector, mode_ptr);
79e53945 1468 drm_mode_probed_add(connector, mode_ptr);
02c5dd98 1469 count++;
79e53945
JB		 1470 }
1471
02c5dd98 1472 return count;
79e53945
JB		 1473}
1474
1475static void
1476intel_tv_destroy (struct drm_connector *connector)
1477{
79e53945
JB		 1478 drm_sysfs_connector_remove(connector);
1479 drm_connector_cleanup(connector);
0c41ee2b 1480 kfree(connector);
79e53945
JB		 1481}
1482
1483
1484static int
1485intel_tv_set_property(struct drm_connector *connector, struct drm_property *property,
1486 uint64_t val)
1487{
1488 struct drm_device *dev = connector->dev;
0c41ee2b 1489 struct drm_encoder *encoder = intel_attached_encoder(connector);
ea5b213a 1490 struct intel_tv *intel_tv = enc_to_intel_tv(encoder);
7d6ff785 1491 struct drm_crtc *crtc = encoder->crtc;
79e53945 1492 int ret = 0;
ebcc8f2e 1493 bool changed = false;
79e53945
JB		 1494
1495 ret = drm_connector_property_set_value(connector, property, val);
1496 if (ret < 0)
1497 goto out;
1498
ebcc8f2e 1499 if (property == dev->mode_config.tv_left_margin_property &&
ea5b213a
CW		 1500 intel_tv->margin[TV_MARGIN_LEFT] != val) {
1501 intel_tv->margin[TV_MARGIN_LEFT] = val;
ebcc8f2e
ZW		 1502 changed = true;
1503 } else if (property == dev->mode_config.tv_right_margin_property &&
ea5b213a
CW		 1504 intel_tv->margin[TV_MARGIN_RIGHT] != val) {
1505 intel_tv->margin[TV_MARGIN_RIGHT] = val;
ebcc8f2e
ZW		 1506 changed = true;
1507 } else if (property == dev->mode_config.tv_top_margin_property &&
ea5b213a
CW		 1508 intel_tv->margin[TV_MARGIN_TOP] != val) {
1509 intel_tv->margin[TV_MARGIN_TOP] = val;
ebcc8f2e
ZW		 1510 changed = true;
1511 } else if (property == dev->mode_config.tv_bottom_margin_property &&
ea5b213a
CW		 1512 intel_tv->margin[TV_MARGIN_BOTTOM] != val) {
1513 intel_tv->margin[TV_MARGIN_BOTTOM] = val;
ebcc8f2e
ZW		 1514 changed = true;
1515 } else if (property == dev->mode_config.tv_mode_property) {
2991196f 1516 if (val >= ARRAY_SIZE(tv_modes)) {
79e53945
JB		 1517 ret = -EINVAL;
1518 goto out;
1519 }
ea5b213a 1520 if (!strcmp(intel_tv->tv_format, tv_modes[val].name))
ebcc8f2e
ZW		 1521 goto out;
1522
ea5b213a 1523 intel_tv->tv_format = tv_modes[val].name;
ebcc8f2e 1524 changed = true;
79e53945
JB		 1525 } else {
1526 ret = -EINVAL;
1527 goto out;
1528 }
1529
7d6ff785
ZW		 1530 if (changed && crtc)
1531 drm_crtc_helper_set_mode(crtc, &crtc->mode, crtc->x,
1532 crtc->y, crtc->fb);
79e53945
JB		 1533out:
1534 return ret;
1535}
1536
1537static const struct drm_encoder_helper_funcs intel_tv_helper_funcs = {
1538 .dpms = intel_tv_dpms,
1539 .mode_fixup = intel_tv_mode_fixup,
1540 .prepare = intel_encoder_prepare,
1541 .mode_set = intel_tv_mode_set,
1542 .commit = intel_encoder_commit,
1543};
1544
1545static const struct drm_connector_funcs intel_tv_connector_funcs = {
c9fb15f6 1546 .dpms = drm_helper_connector_dpms,
79e53945
JB		 1547 .detect = intel_tv_detect,
1548 .destroy = intel_tv_destroy,
1549 .set_property = intel_tv_set_property,
1550 .fill_modes = drm_helper_probe_single_connector_modes,
1551};
1552
1553static const struct drm_connector_helper_funcs intel_tv_connector_helper_funcs = {
1554 .mode_valid = intel_tv_mode_valid,
1555 .get_modes = intel_tv_get_modes,
0c41ee2b 1556 .best_encoder = intel_attached_encoder,
79e53945
JB		 1557};
1558
79e53945 1559static const struct drm_encoder_funcs intel_tv_enc_funcs = {
ea5b213a 1560 .destroy = intel_encoder_destroy,
79e53945
JB		 1561};
1562
c3561438
ZY		 1563/*
1564 * Enumerate the child dev array parsed from VBT to check whether
1565 * the integrated TV is present.
1566 * If it is present, return 1.
1567 * If it is not present, return false.
1568 * If no child dev is parsed from VBT, it assumes that the TV is present.
1569 */
6e36595a 1570static int tv_is_present_in_vbt(struct drm_device *dev)
c3561438
ZY		 1571{
1572 struct drm_i915_private *dev_priv = dev->dev_private;
1573 struct child_device_config *p_child;
1574 int i, ret;
1575
1576 if (!dev_priv->child_dev_num)
1577 return 1;
1578
1579 ret = 0;
1580 for (i = 0; i < dev_priv->child_dev_num; i++) {
1581 p_child = dev_priv->child_dev + i;
1582 /*
1583 * If the device type is not TV, continue.
1584 */
1585 if (p_child->device_type != DEVICE_TYPE_INT_TV &&
1586 p_child->device_type != DEVICE_TYPE_TV)
1587 continue;
1588 /* Only when the addin_offset is non-zero, it is regarded
1589 * as present.
1590 */
1591 if (p_child->addin_offset) {
1592 ret = 1;
1593 break;
1594 }
1595 }
1596 return ret;
1597}
79e53945
JB		 1598
1599void
1600intel_tv_init(struct drm_device *dev)
1601{
1602 struct drm_i915_private *dev_priv = dev->dev_private;
1603 struct drm_connector *connector;
ea5b213a 1604 struct intel_tv *intel_tv;
21d40d37 1605 struct intel_encoder *intel_encoder;
0c41ee2b 1606 struct intel_connector *intel_connector;
79e53945
JB		 1607 u32 tv_dac_on, tv_dac_off, save_tv_dac;
1608 char **tv_format_names;
1609 int i, initial_mode = 0;
1610
1611 if ((I915_READ(TV_CTL) & TV_FUSE_STATE_MASK) == TV_FUSE_STATE_DISABLED)
1612 return;
1613
c3561438
ZY		 1614 if (!tv_is_present_in_vbt(dev)) {
1615 DRM_DEBUG_KMS("Integrated TV is not present.\n");
1616 return;
1617 }
79e53945
JB		 1618 /* Even if we have an encoder we may not have a connector */
1619 if (!dev_priv->int_tv_support)
1620 return;
1621
1622 /*
1623 * Sanity check the TV output by checking to see if the
1624 * DAC register holds a value
1625 */
1626 save_tv_dac = I915_READ(TV_DAC);
1627
1628 I915_WRITE(TV_DAC, save_tv_dac | TVDAC_STATE_CHG_EN);
1629 tv_dac_on = I915_READ(TV_DAC);
1630
1631 I915_WRITE(TV_DAC, save_tv_dac & ~TVDAC_STATE_CHG_EN);
1632 tv_dac_off = I915_READ(TV_DAC);
1633
1634 I915_WRITE(TV_DAC, save_tv_dac);
1635
1636 /*
1637 * If the register does not hold the state change enable
1638 * bit, (either as a 0 or a 1), assume it doesn't really
1639 * exist
1640 */
1641 if ((tv_dac_on & TVDAC_STATE_CHG_EN) == 0 ||
1642 (tv_dac_off & TVDAC_STATE_CHG_EN) != 0)
1643 return;
1644
ea5b213a
CW		 1645 intel_tv = kzalloc(sizeof(struct intel_tv), GFP_KERNEL);
1646 if (!intel_tv) {
79e53945
JB		 1647 return;
1648 }
f8aed700 1649
0c41ee2b
ZW		 1650 intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
1651 if (!intel_connector) {
ea5b213a 1652 kfree(intel_tv);
0c41ee2b
ZW		 1653 return;
1654 }
1655
ea5b213a 1656 intel_encoder = &intel_tv->base;
0c41ee2b 1657 connector = &intel_connector->base;
79e53945
JB		 1658
1659 drm_connector_init(dev, connector, &intel_tv_connector_funcs,
1660 DRM_MODE_CONNECTOR_SVIDEO);
1661
21d40d37 1662 drm_encoder_init(dev, &intel_encoder->enc, &intel_tv_enc_funcs,
79e53945
JB		 1663 DRM_MODE_ENCODER_TVDAC);
1664
0c41ee2b 1665 drm_mode_connector_attach_encoder(&intel_connector->base, &intel_encoder->enc);
21d40d37
EA		 1666 intel_encoder->type = INTEL_OUTPUT_TVOUT;
1667 intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
1668 intel_encoder->clone_mask = (1 << INTEL_TV_CLONE_BIT);
1669 intel_encoder->enc.possible_crtcs = ((1 << 0) | (1 << 1));
1670 intel_encoder->enc.possible_clones = (1 << INTEL_OUTPUT_TVOUT);
ea5b213a 1671 intel_tv->type = DRM_MODE_CONNECTOR_Unknown;
79e53945
JB		 1672
1673 /* BIOS margin values */
ea5b213a
CW		 1674 intel_tv->margin[TV_MARGIN_LEFT] = 54;
1675 intel_tv->margin[TV_MARGIN_TOP] = 36;
1676 intel_tv->margin[TV_MARGIN_RIGHT] = 46;
1677 intel_tv->margin[TV_MARGIN_BOTTOM] = 37;
79e53945 1678
ea5b213a 1679 intel_tv->tv_format = kstrdup(tv_modes[initial_mode].name, GFP_KERNEL);
79e53945 1680
21d40d37 1681 drm_encoder_helper_add(&intel_encoder->enc, &intel_tv_helper_funcs);
79e53945
JB		 1682 drm_connector_helper_add(connector, &intel_tv_connector_helper_funcs);
1683 connector->interlace_allowed = false;
1684 connector->doublescan_allowed = false;
1685
1686 /* Create TV properties then attach current values */
2991196f 1687 tv_format_names = kmalloc(sizeof(char *) * ARRAY_SIZE(tv_modes),
9a298b2a 1688 GFP_KERNEL);
79e53945
JB		 1689 if (!tv_format_names)
1690 goto out;
2991196f 1691 for (i = 0; i < ARRAY_SIZE(tv_modes); i++)
79e53945 1692 tv_format_names[i] = tv_modes[i].name;
2991196f 1693 drm_mode_create_tv_properties(dev, ARRAY_SIZE(tv_modes), tv_format_names);
79e53945
JB		 1694
1695 drm_connector_attach_property(connector, dev->mode_config.tv_mode_property,
1696 initial_mode);
1697 drm_connector_attach_property(connector,
1698 dev->mode_config.tv_left_margin_property,
ea5b213a 1699 intel_tv->margin[TV_MARGIN_LEFT]);
79e53945
JB		 1700 drm_connector_attach_property(connector,
1701 dev->mode_config.tv_top_margin_property,
ea5b213a 1702 intel_tv->margin[TV_MARGIN_TOP]);
79e53945
JB		 1703 drm_connector_attach_property(connector,
1704 dev->mode_config.tv_right_margin_property,
ea5b213a 1705 intel_tv->margin[TV_MARGIN_RIGHT]);
79e53945
JB		 1706 drm_connector_attach_property(connector,
1707 dev->mode_config.tv_bottom_margin_property,
ea5b213a 1708 intel_tv->margin[TV_MARGIN_BOTTOM]);
79e53945
JB		 1709out:
1710 drm_sysfs_connector_add(connector);
1711}
Clone of davem's net-next-2.6 tree