intel_sdvo.c 89.5 KB
Newer Older
J
Jesse Barnes 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
/*
 * Copyright 2006 Dave Airlie <airlied@linux.ie>
 * Copyright © 2006-2007 Intel Corporation
 *   Jesse Barnes <jesse.barnes@intel.com>
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 *
 * Authors:
 *	Eric Anholt <eric@anholt.net>
 */
#include <linux/i2c.h>
29
#include <linux/slab.h>
J
Jesse Barnes 已提交
30
#include <linux/delay.h>
31
#include <linux/export.h>
32 33 34
#include <drm/drmP.h>
#include <drm/drm_crtc.h>
#include <drm/drm_edid.h>
C
Chris Wilson 已提交
35
#include "intel_drv.h"
36
#include <drm/i915_drm.h>
J
Jesse Barnes 已提交
37 38 39
#include "i915_drv.h"
#include "intel_sdvo_regs.h"

40 41 42
#define SDVO_TMDS_MASK (SDVO_OUTPUT_TMDS0 | SDVO_OUTPUT_TMDS1)
#define SDVO_RGB_MASK  (SDVO_OUTPUT_RGB0 | SDVO_OUTPUT_RGB1)
#define SDVO_LVDS_MASK (SDVO_OUTPUT_LVDS0 | SDVO_OUTPUT_LVDS1)
43
#define SDVO_TV_MASK   (SDVO_OUTPUT_CVBS0 | SDVO_OUTPUT_SVID0 | SDVO_OUTPUT_YPRPB0)
44 45

#define SDVO_OUTPUT_MASK (SDVO_TMDS_MASK | SDVO_RGB_MASK | SDVO_LVDS_MASK |\
46
			SDVO_TV_MASK)
47 48

#define IS_TV(c)	(c->output_flag & SDVO_TV_MASK)
49
#define IS_TMDS(c)	(c->output_flag & SDVO_TMDS_MASK)
50
#define IS_LVDS(c)	(c->output_flag & SDVO_LVDS_MASK)
51
#define IS_TV_OR_LVDS(c) (c->output_flag & (SDVO_TV_MASK | SDVO_LVDS_MASK))
52
#define IS_DIGITAL(c) (c->output_flag & (SDVO_TMDS_MASK | SDVO_LVDS_MASK))
53

J
Jesse Barnes 已提交
54

55
static const char *tv_format_names[] = {
56 57 58 59 60 61 62 63 64 65 66
	"NTSC_M"   , "NTSC_J"  , "NTSC_443",
	"PAL_B"    , "PAL_D"   , "PAL_G"   ,
	"PAL_H"    , "PAL_I"   , "PAL_M"   ,
	"PAL_N"    , "PAL_NC"  , "PAL_60"  ,
	"SECAM_B"  , "SECAM_D" , "SECAM_G" ,
	"SECAM_K"  , "SECAM_K1", "SECAM_L" ,
	"SECAM_60"
};

#define TV_FORMAT_NUM  (sizeof(tv_format_names) / sizeof(*tv_format_names))

C
Chris Wilson 已提交
67 68 69
struct intel_sdvo {
	struct intel_encoder base;

70
	struct i2c_adapter *i2c;
71
	u8 slave_addr;
72

C
Chris Wilson 已提交
73 74
	struct i2c_adapter ddc;

75
	/* Register for the SDVO device: SDVOB or SDVOC */
76
	uint32_t sdvo_reg;
J
Jesse Barnes 已提交
77

78 79
	/* Active outputs controlled by this SDVO output */
	uint16_t controlled_output;
J
Jesse Barnes 已提交
80

81 82
	/*
	 * Capabilities of the SDVO device returned by
83
	 * intel_sdvo_get_capabilities()
84
	 */
J
Jesse Barnes 已提交
85
	struct intel_sdvo_caps caps;
86 87

	/* Pixel clock limitations reported by the SDVO device, in kHz */
J
Jesse Barnes 已提交
88 89
	int pixel_clock_min, pixel_clock_max;

90 91 92 93 94 95
	/*
	* For multiple function SDVO device,
	* this is for current attached outputs.
	*/
	uint16_t attached_output;

96 97 98
	/*
	 * Hotplug activation bits for this device
	 */
99
	uint16_t hotplug_active;
100

101 102 103 104 105
	/**
	 * This is used to select the color range of RBG outputs in HDMI mode.
	 * It is only valid when using TMDS encoding and 8 bit per color mode.
	 */
	uint32_t color_range;
106
	bool color_range_auto;
107

108 109 110 111 112 113 114 115 116
	/**
	 * This is set if we're going to treat the device as TV-out.
	 *
	 * While we have these nice friendly flags for output types that ought
	 * to decide this for us, the S-Video output on our HDMI+S-Video card
	 * shows up as RGB1 (VGA).
	 */
	bool is_tv;

117 118 119
	/* On different gens SDVOB is at different places. */
	bool is_sdvob;

120
	/* This is for current tv format name */
121
	int tv_format_index;
122

123 124 125 126
	/**
	 * This is set if we treat the device as HDMI, instead of DVI.
	 */
	bool is_hdmi;
127 128
	bool has_hdmi_monitor;
	bool has_hdmi_audio;
129
	bool rgb_quant_range_selectable;
130

131
	/**
132 133
	 * This is set if we detect output of sdvo device as LVDS and
	 * have a valid fixed mode to use with the panel.
134 135
	 */
	bool is_lvds;
136

137 138 139 140 141
	/**
	 * This is sdvo fixed pannel mode pointer
	 */
	struct drm_display_mode *sdvo_lvds_fixed_mode;

142
	/* DDC bus used by this SDVO encoder */
143
	uint8_t ddc_bus;
144 145 146 147 148

	/*
	 * the sdvo flag gets lost in round trip: dtd->adjusted_mode->dtd
	 */
	uint8_t dtd_sdvo_flags;
149 150 151
};

struct intel_sdvo_connector {
152 153
	struct intel_connector base;

154 155 156
	/* Mark the type of connector */
	uint16_t output_flag;

157
	enum hdmi_force_audio force_audio;
158

159
	/* This contains all current supported TV format */
160
	u8 tv_format_supported[TV_FORMAT_NUM];
161
	int   format_supported_num;
162
	struct drm_property *tv_format;
163

164
	/* add the property for the SDVO-TV */
165 166 167 168 169 170 171 172 173 174 175 176 177 178 179
	struct drm_property *left;
	struct drm_property *right;
	struct drm_property *top;
	struct drm_property *bottom;
	struct drm_property *hpos;
	struct drm_property *vpos;
	struct drm_property *contrast;
	struct drm_property *saturation;
	struct drm_property *hue;
	struct drm_property *sharpness;
	struct drm_property *flicker_filter;
	struct drm_property *flicker_filter_adaptive;
	struct drm_property *flicker_filter_2d;
	struct drm_property *tv_chroma_filter;
	struct drm_property *tv_luma_filter;
180
	struct drm_property *dot_crawl;
181 182

	/* add the property for the SDVO-TV/LVDS */
183
	struct drm_property *brightness;
184 185 186

	/* Add variable to record current setting for the above property */
	u32	left_margin, right_margin, top_margin, bottom_margin;
187

188 189 190 191 192 193 194 195
	/* this is to get the range of margin.*/
	u32	max_hscan,  max_vscan;
	u32	max_hpos, cur_hpos;
	u32	max_vpos, cur_vpos;
	u32	cur_brightness, max_brightness;
	u32	cur_contrast,	max_contrast;
	u32	cur_saturation, max_saturation;
	u32	cur_hue,	max_hue;
196 197 198 199 200 201
	u32	cur_sharpness,	max_sharpness;
	u32	cur_flicker_filter,		max_flicker_filter;
	u32	cur_flicker_filter_adaptive,	max_flicker_filter_adaptive;
	u32	cur_flicker_filter_2d,		max_flicker_filter_2d;
	u32	cur_tv_chroma_filter,	max_tv_chroma_filter;
	u32	cur_tv_luma_filter,	max_tv_luma_filter;
202
	u32	cur_dot_crawl,	max_dot_crawl;
J
Jesse Barnes 已提交
203 204
};

205
static struct intel_sdvo *to_sdvo(struct intel_encoder *encoder)
C
Chris Wilson 已提交
206
{
207
	return container_of(encoder, struct intel_sdvo, base);
C
Chris Wilson 已提交
208 209
}

210 211
static struct intel_sdvo *intel_attached_sdvo(struct drm_connector *connector)
{
212
	return to_sdvo(intel_attached_encoder(connector));
213 214
}

215 216 217 218 219
static struct intel_sdvo_connector *to_intel_sdvo_connector(struct drm_connector *connector)
{
	return container_of(to_intel_connector(connector), struct intel_sdvo_connector, base);
}

220
static bool
C
Chris Wilson 已提交
221
intel_sdvo_output_setup(struct intel_sdvo *intel_sdvo, uint16_t flags);
222 223 224 225 226 227 228
static bool
intel_sdvo_tv_create_property(struct intel_sdvo *intel_sdvo,
			      struct intel_sdvo_connector *intel_sdvo_connector,
			      int type);
static bool
intel_sdvo_create_enhance_property(struct intel_sdvo *intel_sdvo,
				   struct intel_sdvo_connector *intel_sdvo_connector);
229

J
Jesse Barnes 已提交
230 231 232 233 234
/**
 * Writes the SDVOB or SDVOC with the given value, but always writes both
 * SDVOB and SDVOC to work around apparent hardware issues (according to
 * comments in the BIOS).
 */
C
Chris Wilson 已提交
235
static void intel_sdvo_write_sdvox(struct intel_sdvo *intel_sdvo, u32 val)
J
Jesse Barnes 已提交
236
{
237
	struct drm_device *dev = intel_sdvo->base.base.dev;
J
Jesse Barnes 已提交
238 239 240 241
	struct drm_i915_private *dev_priv = dev->dev_private;
	u32 bval = val, cval = val;
	int i;

C
Chris Wilson 已提交
242 243 244
	if (intel_sdvo->sdvo_reg == PCH_SDVOB) {
		I915_WRITE(intel_sdvo->sdvo_reg, val);
		I915_READ(intel_sdvo->sdvo_reg);
245 246 247
		return;
	}

248 249 250 251 252
	if (intel_sdvo->sdvo_reg == GEN3_SDVOB)
		cval = I915_READ(GEN3_SDVOC);
	else
		bval = I915_READ(GEN3_SDVOB);

J
Jesse Barnes 已提交
253 254 255 256 257 258 259
	/*
	 * Write the registers twice for luck. Sometimes,
	 * writing them only once doesn't appear to 'stick'.
	 * The BIOS does this too. Yay, magic
	 */
	for (i = 0; i < 2; i++)
	{
260 261 262 263
		I915_WRITE(GEN3_SDVOB, bval);
		I915_READ(GEN3_SDVOB);
		I915_WRITE(GEN3_SDVOC, cval);
		I915_READ(GEN3_SDVOC);
J
Jesse Barnes 已提交
264 265 266
	}
}

267
static bool intel_sdvo_read_byte(struct intel_sdvo *intel_sdvo, u8 addr, u8 *ch)
J
Jesse Barnes 已提交
268 269 270
{
	struct i2c_msg msgs[] = {
		{
C
Chris Wilson 已提交
271
			.addr = intel_sdvo->slave_addr,
J
Jesse Barnes 已提交
272 273
			.flags = 0,
			.len = 1,
C
Chris Wilson 已提交
274
			.buf = &addr,
J
Jesse Barnes 已提交
275 276
		},
		{
C
Chris Wilson 已提交
277
			.addr = intel_sdvo->slave_addr,
J
Jesse Barnes 已提交
278 279
			.flags = I2C_M_RD,
			.len = 1,
C
Chris Wilson 已提交
280
			.buf = ch,
J
Jesse Barnes 已提交
281 282
		}
	};
283
	int ret;
J
Jesse Barnes 已提交
284

285
	if ((ret = i2c_transfer(intel_sdvo->i2c, msgs, 2)) == 2)
J
Jesse Barnes 已提交
286 287
		return true;

288
	DRM_DEBUG_KMS("i2c transfer returned %d\n", ret);
J
Jesse Barnes 已提交
289 290 291 292 293
	return false;
}

#define SDVO_CMD_NAME_ENTRY(cmd) {cmd, #cmd}
/** Mapping of command numbers to names, for debug output */
294
static const struct _sdvo_cmd_name {
295
	u8 cmd;
296
	const char *name;
J
Jesse Barnes 已提交
297
} sdvo_cmd_names[] = {
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_RESET),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_DEVICE_CAPS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_FIRMWARE_REV),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_TRAINED_INPUTS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_ACTIVE_OUTPUTS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_ACTIVE_OUTPUTS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_IN_OUT_MAP),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_IN_OUT_MAP),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_ATTACHED_DISPLAYS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HOT_PLUG_SUPPORT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_ACTIVE_HOT_PLUG),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_ACTIVE_HOT_PLUG),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_INTERRUPT_EVENT_SOURCE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_TARGET_INPUT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_TARGET_OUTPUT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_INPUT_TIMINGS_PART1),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_INPUT_TIMINGS_PART2),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_INPUT_TIMINGS_PART1),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_INPUT_TIMINGS_PART2),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_INPUT_TIMINGS_PART1),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_OUTPUT_TIMINGS_PART1),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_OUTPUT_TIMINGS_PART2),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_OUTPUT_TIMINGS_PART1),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_OUTPUT_TIMINGS_PART2),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_CREATE_PREFERRED_INPUT_TIMING),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_PREFERRED_INPUT_TIMING_PART1),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_PREFERRED_INPUT_TIMING_PART2),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_INPUT_PIXEL_CLOCK_RANGE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_OUTPUT_PIXEL_CLOCK_RANGE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SUPPORTED_CLOCK_RATE_MULTS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_CLOCK_RATE_MULT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_CLOCK_RATE_MULT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SUPPORTED_TV_FORMATS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_TV_FORMAT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_TV_FORMAT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SUPPORTED_POWER_STATES),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_POWER_STATE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_ENCODER_POWER_STATE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_DISPLAY_POWER_STATE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_CONTROL_BUS_SWITCH),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SDTV_RESOLUTION_SUPPORT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SCALED_HDTV_RESOLUTION_SUPPORT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SUPPORTED_ENHANCEMENTS),

	/* Add the op code for SDVO enhancements */
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_HPOS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HPOS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_HPOS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_VPOS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_VPOS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_VPOS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_SATURATION),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SATURATION),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_SATURATION),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_HUE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HUE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_HUE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_CONTRAST),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_CONTRAST),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_CONTRAST),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_BRIGHTNESS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_BRIGHTNESS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_BRIGHTNESS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_OVERSCAN_H),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_OVERSCAN_H),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_OVERSCAN_H),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_OVERSCAN_V),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_OVERSCAN_V),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_OVERSCAN_V),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_FLICKER_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_FLICKER_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_FLICKER_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_FLICKER_FILTER_ADAPTIVE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_FLICKER_FILTER_ADAPTIVE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_FLICKER_FILTER_ADAPTIVE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_FLICKER_FILTER_2D),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_FLICKER_FILTER_2D),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_FLICKER_FILTER_2D),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_SHARPNESS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SHARPNESS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_SHARPNESS),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_DOT_CRAWL),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_DOT_CRAWL),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_TV_CHROMA_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_TV_CHROMA_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_TV_CHROMA_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_MAX_TV_LUMA_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_TV_LUMA_FILTER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_TV_LUMA_FILTER),

	/* HDMI op code */
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_SUPP_ENCODE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_ENCODE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_ENCODE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_PIXEL_REPLI),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_PIXEL_REPLI),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_COLORIMETRY_CAP),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_COLORIMETRY),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_COLORIMETRY),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_AUDIO_ENCRYPT_PREFER),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_AUDIO_STAT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_AUDIO_STAT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HBUF_INDEX),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_HBUF_INDEX),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HBUF_INFO),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HBUF_AV_SPLIT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_HBUF_AV_SPLIT),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HBUF_TXRATE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_HBUF_TXRATE),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_SET_HBUF_DATA),
	SDVO_CMD_NAME_ENTRY(SDVO_CMD_GET_HBUF_DATA),
J
Jesse Barnes 已提交
409 410
};

411
#define SDVO_NAME(svdo) ((svdo)->is_sdvob ? "SDVOB" : "SDVOC")
J
Jesse Barnes 已提交
412

C
Chris Wilson 已提交
413
static void intel_sdvo_debug_write(struct intel_sdvo *intel_sdvo, u8 cmd,
414
				   const void *args, int args_len)
J
Jesse Barnes 已提交
415 416 417
{
	int i;

418
	DRM_DEBUG_KMS("%s: W: %02X ",
C
Chris Wilson 已提交
419
				SDVO_NAME(intel_sdvo), cmd);
J
Jesse Barnes 已提交
420
	for (i = 0; i < args_len; i++)
421
		DRM_LOG_KMS("%02X ", ((u8 *)args)[i]);
J
Jesse Barnes 已提交
422
	for (; i < 8; i++)
423
		DRM_LOG_KMS("   ");
K
Kulikov Vasiliy 已提交
424
	for (i = 0; i < ARRAY_SIZE(sdvo_cmd_names); i++) {
J
Jesse Barnes 已提交
425
		if (cmd == sdvo_cmd_names[i].cmd) {
426
			DRM_LOG_KMS("(%s)", sdvo_cmd_names[i].name);
J
Jesse Barnes 已提交
427 428 429
			break;
		}
	}
K
Kulikov Vasiliy 已提交
430
	if (i == ARRAY_SIZE(sdvo_cmd_names))
431 432
		DRM_LOG_KMS("(%02X)", cmd);
	DRM_LOG_KMS("\n");
J
Jesse Barnes 已提交
433 434
}

C
Chris Wilson 已提交
435 436 437 438 439 440 441 442 443 444
static const char *cmd_status_names[] = {
	"Power on",
	"Success",
	"Not supported",
	"Invalid arg",
	"Pending",
	"Target not specified",
	"Scaling not supported"
};

445 446
static bool intel_sdvo_write_cmd(struct intel_sdvo *intel_sdvo, u8 cmd,
				 const void *args, int args_len)
J
Jesse Barnes 已提交
447
{
448 449 450 451
	u8 *buf, status;
	struct i2c_msg *msgs;
	int i, ret = true;

452
        /* Would be simpler to allocate both in one go ? */        
453
	buf = kzalloc(args_len * 2 + 2, GFP_KERNEL);
454 455 456 457
	if (!buf)
		return false;

	msgs = kcalloc(args_len + 3, sizeof(*msgs), GFP_KERNEL);
458 459
	if (!msgs) {
	        kfree(buf);
460
		return false;
461
        }
J
Jesse Barnes 已提交
462

C
Chris Wilson 已提交
463
	intel_sdvo_debug_write(intel_sdvo, cmd, args, args_len);
J
Jesse Barnes 已提交
464 465

	for (i = 0; i < args_len; i++) {
C
Chris Wilson 已提交
466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494
		msgs[i].addr = intel_sdvo->slave_addr;
		msgs[i].flags = 0;
		msgs[i].len = 2;
		msgs[i].buf = buf + 2 *i;
		buf[2*i + 0] = SDVO_I2C_ARG_0 - i;
		buf[2*i + 1] = ((u8*)args)[i];
	}
	msgs[i].addr = intel_sdvo->slave_addr;
	msgs[i].flags = 0;
	msgs[i].len = 2;
	msgs[i].buf = buf + 2*i;
	buf[2*i + 0] = SDVO_I2C_OPCODE;
	buf[2*i + 1] = cmd;

	/* the following two are to read the response */
	status = SDVO_I2C_CMD_STATUS;
	msgs[i+1].addr = intel_sdvo->slave_addr;
	msgs[i+1].flags = 0;
	msgs[i+1].len = 1;
	msgs[i+1].buf = &status;

	msgs[i+2].addr = intel_sdvo->slave_addr;
	msgs[i+2].flags = I2C_M_RD;
	msgs[i+2].len = 1;
	msgs[i+2].buf = &status;

	ret = i2c_transfer(intel_sdvo->i2c, msgs, i+3);
	if (ret < 0) {
		DRM_DEBUG_KMS("I2c transfer returned %d\n", ret);
495 496
		ret = false;
		goto out;
C
Chris Wilson 已提交
497 498 499 500
	}
	if (ret != i+3) {
		/* failure in I2C transfer */
		DRM_DEBUG_KMS("I2c transfer returned %d/%d\n", ret, i+3);
501
		ret = false;
C
Chris Wilson 已提交
502 503
	}

504 505 506 507
out:
	kfree(msgs);
	kfree(buf);
	return ret;
J
Jesse Barnes 已提交
508 509
}

510 511
static bool intel_sdvo_read_response(struct intel_sdvo *intel_sdvo,
				     void *response, int response_len)
J
Jesse Barnes 已提交
512
{
513
	u8 retry = 15; /* 5 quick checks, followed by 10 long checks */
514
	u8 status;
515
	int i;
J
Jesse Barnes 已提交
516

517 518
	DRM_DEBUG_KMS("%s: R: ", SDVO_NAME(intel_sdvo));

519 520 521 522 523 524 525
	/*
	 * The documentation states that all commands will be
	 * processed within 15µs, and that we need only poll
	 * the status byte a maximum of 3 times in order for the
	 * command to be complete.
	 *
	 * Check 5 times in case the hardware failed to read the docs.
526 527 528 529 530 531 532 533 534
	 *
	 * Also beware that the first response by many devices is to
	 * reply PENDING and stall for time. TVs are notorious for
	 * requiring longer than specified to complete their replies.
	 * Originally (in the DDX long ago), the delay was only ever 15ms
	 * with an additional delay of 30ms applied for TVs added later after
	 * many experiments. To accommodate both sets of delays, we do a
	 * sequence of slow checks if the device is falling behind and fails
	 * to reply within 5*15µs.
535
	 */
536 537 538 539 540
	if (!intel_sdvo_read_byte(intel_sdvo,
				  SDVO_I2C_CMD_STATUS,
				  &status))
		goto log_fail;

541 542 543 544 545 546
	while (status == SDVO_CMD_STATUS_PENDING && --retry) {
		if (retry < 10)
			msleep(15);
		else
			udelay(15);

547 548 549
		if (!intel_sdvo_read_byte(intel_sdvo,
					  SDVO_I2C_CMD_STATUS,
					  &status))
550 551
			goto log_fail;
	}
552

J
Jesse Barnes 已提交
553
	if (status <= SDVO_CMD_STATUS_SCALING_NOT_SUPP)
554
		DRM_LOG_KMS("(%s)", cmd_status_names[status]);
J
Jesse Barnes 已提交
555
	else
556
		DRM_LOG_KMS("(??? %d)", status);
J
Jesse Barnes 已提交
557

558 559
	if (status != SDVO_CMD_STATUS_SUCCESS)
		goto log_fail;
J
Jesse Barnes 已提交
560

561 562 563 564 565 566
	/* Read the command response */
	for (i = 0; i < response_len; i++) {
		if (!intel_sdvo_read_byte(intel_sdvo,
					  SDVO_I2C_RETURN_0 + i,
					  &((u8 *)response)[i]))
			goto log_fail;
C
Chris Wilson 已提交
567
		DRM_LOG_KMS(" %02X", ((u8 *)response)[i]);
568 569 570
	}
	DRM_LOG_KMS("\n");
	return true;
J
Jesse Barnes 已提交
571

572
log_fail:
573
	DRM_LOG_KMS("... failed\n");
574
	return false;
J
Jesse Barnes 已提交
575 576
}

577
static int intel_sdvo_get_pixel_multiplier(struct drm_display_mode *mode)
J
Jesse Barnes 已提交
578 579 580 581 582 583 584 585 586
{
	if (mode->clock >= 100000)
		return 1;
	else if (mode->clock >= 50000)
		return 2;
	else
		return 4;
}

C
Chris Wilson 已提交
587 588
static bool intel_sdvo_set_control_bus_switch(struct intel_sdvo *intel_sdvo,
					      u8 ddc_bus)
J
Jesse Barnes 已提交
589
{
590
	/* This must be the immediately preceding write before the i2c xfer */
C
Chris Wilson 已提交
591 592 593
	return intel_sdvo_write_cmd(intel_sdvo,
				    SDVO_CMD_SET_CONTROL_BUS_SWITCH,
				    &ddc_bus, 1);
J
Jesse Barnes 已提交
594 595
}

596
static bool intel_sdvo_set_value(struct intel_sdvo *intel_sdvo, u8 cmd, const void *data, int len)
J
Jesse Barnes 已提交
597
{
598 599 600 601
	if (!intel_sdvo_write_cmd(intel_sdvo, cmd, data, len))
		return false;

	return intel_sdvo_read_response(intel_sdvo, NULL, 0);
602
}
J
Jesse Barnes 已提交
603

604 605 606 607 608
static bool
intel_sdvo_get_value(struct intel_sdvo *intel_sdvo, u8 cmd, void *value, int len)
{
	if (!intel_sdvo_write_cmd(intel_sdvo, cmd, NULL, 0))
		return false;
J
Jesse Barnes 已提交
609

610 611
	return intel_sdvo_read_response(intel_sdvo, value, len);
}
J
Jesse Barnes 已提交
612

613 614 615 616 617 618
static bool intel_sdvo_set_target_input(struct intel_sdvo *intel_sdvo)
{
	struct intel_sdvo_set_target_input_args targets = {0};
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_TARGET_INPUT,
				    &targets, sizeof(targets));
J
Jesse Barnes 已提交
619 620 621 622 623 624 625 626
}

/**
 * Return whether each input is trained.
 *
 * This function is making an assumption about the layout of the response,
 * which should be checked against the docs.
 */
C
Chris Wilson 已提交
627
static bool intel_sdvo_get_trained_inputs(struct intel_sdvo *intel_sdvo, bool *input_1, bool *input_2)
J
Jesse Barnes 已提交
628 629 630
{
	struct intel_sdvo_get_trained_inputs_response response;

631
	BUILD_BUG_ON(sizeof(response) != 1);
632 633
	if (!intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_TRAINED_INPUTS,
				  &response, sizeof(response)))
J
Jesse Barnes 已提交
634 635 636 637 638 639 640
		return false;

	*input_1 = response.input0_trained;
	*input_2 = response.input1_trained;
	return true;
}

C
Chris Wilson 已提交
641
static bool intel_sdvo_set_active_outputs(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
642 643
					  u16 outputs)
{
644 645 646
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_ACTIVE_OUTPUTS,
				    &outputs, sizeof(outputs));
J
Jesse Barnes 已提交
647 648
}

649 650 651 652 653 654 655 656
static bool intel_sdvo_get_active_outputs(struct intel_sdvo *intel_sdvo,
					  u16 *outputs)
{
	return intel_sdvo_get_value(intel_sdvo,
				    SDVO_CMD_GET_ACTIVE_OUTPUTS,
				    outputs, sizeof(*outputs));
}

C
Chris Wilson 已提交
657
static bool intel_sdvo_set_encoder_power_state(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
658 659
					       int mode)
{
660
	u8 state = SDVO_ENCODER_STATE_ON;
J
Jesse Barnes 已提交
661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676

	switch (mode) {
	case DRM_MODE_DPMS_ON:
		state = SDVO_ENCODER_STATE_ON;
		break;
	case DRM_MODE_DPMS_STANDBY:
		state = SDVO_ENCODER_STATE_STANDBY;
		break;
	case DRM_MODE_DPMS_SUSPEND:
		state = SDVO_ENCODER_STATE_SUSPEND;
		break;
	case DRM_MODE_DPMS_OFF:
		state = SDVO_ENCODER_STATE_OFF;
		break;
	}

677 678
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_ENCODER_POWER_STATE, &state, sizeof(state));
J
Jesse Barnes 已提交
679 680
}

C
Chris Wilson 已提交
681
static bool intel_sdvo_get_input_pixel_clock_range(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
682 683 684 685 686
						   int *clock_min,
						   int *clock_max)
{
	struct intel_sdvo_pixel_clock_range clocks;

687
	BUILD_BUG_ON(sizeof(clocks) != 4);
688 689 690
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_INPUT_PIXEL_CLOCK_RANGE,
				  &clocks, sizeof(clocks)))
J
Jesse Barnes 已提交
691 692 693 694 695 696 697 698
		return false;

	/* Convert the values from units of 10 kHz to kHz. */
	*clock_min = clocks.min * 10;
	*clock_max = clocks.max * 10;
	return true;
}

C
Chris Wilson 已提交
699
static bool intel_sdvo_set_target_output(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
700 701
					 u16 outputs)
{
702 703 704
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_TARGET_OUTPUT,
				    &outputs, sizeof(outputs));
J
Jesse Barnes 已提交
705 706
}

C
Chris Wilson 已提交
707
static bool intel_sdvo_set_timing(struct intel_sdvo *intel_sdvo, u8 cmd,
J
Jesse Barnes 已提交
708 709
				  struct intel_sdvo_dtd *dtd)
{
710 711
	return intel_sdvo_set_value(intel_sdvo, cmd, &dtd->part1, sizeof(dtd->part1)) &&
		intel_sdvo_set_value(intel_sdvo, cmd + 1, &dtd->part2, sizeof(dtd->part2));
J
Jesse Barnes 已提交
712 713
}

714 715 716 717 718 719 720
static bool intel_sdvo_get_timing(struct intel_sdvo *intel_sdvo, u8 cmd,
				  struct intel_sdvo_dtd *dtd)
{
	return intel_sdvo_get_value(intel_sdvo, cmd, &dtd->part1, sizeof(dtd->part1)) &&
		intel_sdvo_get_value(intel_sdvo, cmd + 1, &dtd->part2, sizeof(dtd->part2));
}

C
Chris Wilson 已提交
721
static bool intel_sdvo_set_input_timing(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
722 723
					 struct intel_sdvo_dtd *dtd)
{
C
Chris Wilson 已提交
724
	return intel_sdvo_set_timing(intel_sdvo,
J
Jesse Barnes 已提交
725 726 727
				     SDVO_CMD_SET_INPUT_TIMINGS_PART1, dtd);
}

C
Chris Wilson 已提交
728
static bool intel_sdvo_set_output_timing(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
729 730
					 struct intel_sdvo_dtd *dtd)
{
C
Chris Wilson 已提交
731
	return intel_sdvo_set_timing(intel_sdvo,
J
Jesse Barnes 已提交
732 733 734
				     SDVO_CMD_SET_OUTPUT_TIMINGS_PART1, dtd);
}

735 736 737 738 739 740 741
static bool intel_sdvo_get_input_timing(struct intel_sdvo *intel_sdvo,
					struct intel_sdvo_dtd *dtd)
{
	return intel_sdvo_get_timing(intel_sdvo,
				     SDVO_CMD_GET_INPUT_TIMINGS_PART1, dtd);
}

742
static bool
C
Chris Wilson 已提交
743
intel_sdvo_create_preferred_input_timing(struct intel_sdvo *intel_sdvo,
744 745 746 747 748 749
					 uint16_t clock,
					 uint16_t width,
					 uint16_t height)
{
	struct intel_sdvo_preferred_input_timing_args args;

750
	memset(&args, 0, sizeof(args));
751 752 753
	args.clock = clock;
	args.width = width;
	args.height = height;
754
	args.interlace = 0;
755

C
Chris Wilson 已提交
756 757 758
	if (intel_sdvo->is_lvds &&
	   (intel_sdvo->sdvo_lvds_fixed_mode->hdisplay != width ||
	    intel_sdvo->sdvo_lvds_fixed_mode->vdisplay != height))
759 760
		args.scaled = 1;

761 762 763
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_CREATE_PREFERRED_INPUT_TIMING,
				    &args, sizeof(args));
764 765
}

C
Chris Wilson 已提交
766
static bool intel_sdvo_get_preferred_input_timing(struct intel_sdvo *intel_sdvo,
767 768
						  struct intel_sdvo_dtd *dtd)
{
769 770
	BUILD_BUG_ON(sizeof(dtd->part1) != 8);
	BUILD_BUG_ON(sizeof(dtd->part2) != 8);
771 772 773 774
	return intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_PREFERRED_INPUT_TIMING_PART1,
				    &dtd->part1, sizeof(dtd->part1)) &&
		intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_PREFERRED_INPUT_TIMING_PART2,
				     &dtd->part2, sizeof(dtd->part2));
775
}
J
Jesse Barnes 已提交
776

C
Chris Wilson 已提交
777
static bool intel_sdvo_set_clock_rate_mult(struct intel_sdvo *intel_sdvo, u8 val)
J
Jesse Barnes 已提交
778
{
779
	return intel_sdvo_set_value(intel_sdvo, SDVO_CMD_SET_CLOCK_RATE_MULT, &val, 1);
J
Jesse Barnes 已提交
780 781
}

782
static void intel_sdvo_get_dtd_from_mode(struct intel_sdvo_dtd *dtd,
783
					 const struct drm_display_mode *mode)
J
Jesse Barnes 已提交
784
{
785 786 787
	uint16_t width, height;
	uint16_t h_blank_len, h_sync_len, v_blank_len, v_sync_len;
	uint16_t h_sync_offset, v_sync_offset;
788
	int mode_clock;
J
Jesse Barnes 已提交
789

790 791
	width = mode->hdisplay;
	height = mode->vdisplay;
J
Jesse Barnes 已提交
792 793

	/* do some mode translations */
794 795
	h_blank_len = mode->htotal - mode->hdisplay;
	h_sync_len = mode->hsync_end - mode->hsync_start;
J
Jesse Barnes 已提交
796

797 798
	v_blank_len = mode->vtotal - mode->vdisplay;
	v_sync_len = mode->vsync_end - mode->vsync_start;
J
Jesse Barnes 已提交
799

800 801
	h_sync_offset = mode->hsync_start - mode->hdisplay;
	v_sync_offset = mode->vsync_start - mode->vdisplay;
J
Jesse Barnes 已提交
802

803 804 805 806
	mode_clock = mode->clock;
	mode_clock /= 10;
	dtd->part1.clock = mode_clock;

807 808 809
	dtd->part1.h_active = width & 0xff;
	dtd->part1.h_blank = h_blank_len & 0xff;
	dtd->part1.h_high = (((width >> 8) & 0xf) << 4) |
J
Jesse Barnes 已提交
810
		((h_blank_len >> 8) & 0xf);
811 812 813
	dtd->part1.v_active = height & 0xff;
	dtd->part1.v_blank = v_blank_len & 0xff;
	dtd->part1.v_high = (((height >> 8) & 0xf) << 4) |
J
Jesse Barnes 已提交
814 815
		((v_blank_len >> 8) & 0xf);

816
	dtd->part2.h_sync_off = h_sync_offset & 0xff;
817 818
	dtd->part2.h_sync_width = h_sync_len & 0xff;
	dtd->part2.v_sync_off_width = (v_sync_offset & 0xf) << 4 |
J
Jesse Barnes 已提交
819
		(v_sync_len & 0xf);
820
	dtd->part2.sync_off_width_high = ((h_sync_offset & 0x300) >> 2) |
J
Jesse Barnes 已提交
821 822 823
		((h_sync_len & 0x300) >> 4) | ((v_sync_offset & 0x30) >> 2) |
		((v_sync_len & 0x30) >> 4);

824
	dtd->part2.dtd_flags = 0x18;
825 826
	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
		dtd->part2.dtd_flags |= DTD_FLAG_INTERLACE;
J
Jesse Barnes 已提交
827
	if (mode->flags & DRM_MODE_FLAG_PHSYNC)
828
		dtd->part2.dtd_flags |= DTD_FLAG_HSYNC_POSITIVE;
J
Jesse Barnes 已提交
829
	if (mode->flags & DRM_MODE_FLAG_PVSYNC)
830
		dtd->part2.dtd_flags |= DTD_FLAG_VSYNC_POSITIVE;
831 832 833 834 835 836 837

	dtd->part2.sdvo_flags = 0;
	dtd->part2.v_sync_off_high = v_sync_offset & 0xc0;
	dtd->part2.reserved = 0;
}

static void intel_sdvo_get_mode_from_dtd(struct drm_display_mode * mode,
838
					 const struct intel_sdvo_dtd *dtd)
839 840 841 842
{
	mode->hdisplay = dtd->part1.h_active;
	mode->hdisplay += ((dtd->part1.h_high >> 4) & 0x0f) << 8;
	mode->hsync_start = mode->hdisplay + dtd->part2.h_sync_off;
843
	mode->hsync_start += (dtd->part2.sync_off_width_high & 0xc0) << 2;
844 845 846 847 848 849 850 851 852
	mode->hsync_end = mode->hsync_start + dtd->part2.h_sync_width;
	mode->hsync_end += (dtd->part2.sync_off_width_high & 0x30) << 4;
	mode->htotal = mode->hdisplay + dtd->part1.h_blank;
	mode->htotal += (dtd->part1.h_high & 0xf) << 8;

	mode->vdisplay = dtd->part1.v_active;
	mode->vdisplay += ((dtd->part1.v_high >> 4) & 0x0f) << 8;
	mode->vsync_start = mode->vdisplay;
	mode->vsync_start += (dtd->part2.v_sync_off_width >> 4) & 0xf;
853
	mode->vsync_start += (dtd->part2.sync_off_width_high & 0x0c) << 2;
854 855 856 857 858 859 860 861 862
	mode->vsync_start += dtd->part2.v_sync_off_high & 0xc0;
	mode->vsync_end = mode->vsync_start +
		(dtd->part2.v_sync_off_width & 0xf);
	mode->vsync_end += (dtd->part2.sync_off_width_high & 0x3) << 4;
	mode->vtotal = mode->vdisplay + dtd->part1.v_blank;
	mode->vtotal += (dtd->part1.v_high & 0xf) << 8;

	mode->clock = dtd->part1.clock * 10;

863
	mode->flags &= ~(DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC);
864 865 866
	if (dtd->part2.dtd_flags & DTD_FLAG_INTERLACE)
		mode->flags |= DRM_MODE_FLAG_INTERLACE;
	if (dtd->part2.dtd_flags & DTD_FLAG_HSYNC_POSITIVE)
867
		mode->flags |= DRM_MODE_FLAG_PHSYNC;
868
	if (dtd->part2.dtd_flags & DTD_FLAG_VSYNC_POSITIVE)
869 870 871
		mode->flags |= DRM_MODE_FLAG_PVSYNC;
}

872
static bool intel_sdvo_check_supp_encode(struct intel_sdvo *intel_sdvo)
873
{
874
	struct intel_sdvo_encode encode;
875

876
	BUILD_BUG_ON(sizeof(encode) != 2);
877 878 879
	return intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_SUPP_ENCODE,
				  &encode, sizeof(encode));
880 881
}

C
Chris Wilson 已提交
882
static bool intel_sdvo_set_encode(struct intel_sdvo *intel_sdvo,
883
				  uint8_t mode)
884
{
885
	return intel_sdvo_set_value(intel_sdvo, SDVO_CMD_SET_ENCODE, &mode, 1);
886 887
}

C
Chris Wilson 已提交
888
static bool intel_sdvo_set_colorimetry(struct intel_sdvo *intel_sdvo,
889 890
				       uint8_t mode)
{
891
	return intel_sdvo_set_value(intel_sdvo, SDVO_CMD_SET_COLORIMETRY, &mode, 1);
892 893 894
}

#if 0
C
Chris Wilson 已提交
895
static void intel_sdvo_dump_hdmi_buf(struct intel_sdvo *intel_sdvo)
896 897 898 899 900 901 902 903
{
	int i, j;
	uint8_t set_buf_index[2];
	uint8_t av_split;
	uint8_t buf_size;
	uint8_t buf[48];
	uint8_t *pos;

904
	intel_sdvo_get_value(encoder, SDVO_CMD_GET_HBUF_AV_SPLIT, &av_split, 1);
905 906 907

	for (i = 0; i <= av_split; i++) {
		set_buf_index[0] = i; set_buf_index[1] = 0;
908
		intel_sdvo_write_cmd(encoder, SDVO_CMD_SET_HBUF_INDEX,
909
				     set_buf_index, 2);
910 911
		intel_sdvo_write_cmd(encoder, SDVO_CMD_GET_HBUF_INFO, NULL, 0);
		intel_sdvo_read_response(encoder, &buf_size, 1);
912 913 914

		pos = buf;
		for (j = 0; j <= buf_size; j += 8) {
915
			intel_sdvo_write_cmd(encoder, SDVO_CMD_GET_HBUF_DATA,
916
					     NULL, 0);
917
			intel_sdvo_read_response(encoder, pos, 8);
918 919 920 921 922 923
			pos += 8;
		}
	}
}
#endif

924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962
static bool intel_sdvo_write_infoframe(struct intel_sdvo *intel_sdvo,
				       unsigned if_index, uint8_t tx_rate,
				       uint8_t *data, unsigned length)
{
	uint8_t set_buf_index[2] = { if_index, 0 };
	uint8_t hbuf_size, tmp[8];
	int i;

	if (!intel_sdvo_set_value(intel_sdvo,
				  SDVO_CMD_SET_HBUF_INDEX,
				  set_buf_index, 2))
		return false;

	if (!intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_HBUF_INFO,
				  &hbuf_size, 1))
		return false;

	/* Buffer size is 0 based, hooray! */
	hbuf_size++;

	DRM_DEBUG_KMS("writing sdvo hbuf: %i, hbuf_size %i, hbuf_size: %i\n",
		      if_index, length, hbuf_size);

	for (i = 0; i < hbuf_size; i += 8) {
		memset(tmp, 0, 8);
		if (i < length)
			memcpy(tmp, data + i, min_t(unsigned, 8, length - i));

		if (!intel_sdvo_set_value(intel_sdvo,
					  SDVO_CMD_SET_HBUF_DATA,
					  tmp, 8))
			return false;
	}

	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_HBUF_TXRATE,
				    &tx_rate, 1);
}

963 964
static bool intel_sdvo_set_avi_infoframe(struct intel_sdvo *intel_sdvo,
					 const struct drm_display_mode *adjusted_mode)
965
{
966 967 968 969 970 971 972 973 974 975 976 977 978
	uint8_t sdvo_data[HDMI_INFOFRAME_SIZE(AVI)];
	struct drm_crtc *crtc = intel_sdvo->base.base.crtc;
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
	union hdmi_infoframe frame;
	int ret;
	ssize_t len;

	ret = drm_hdmi_avi_infoframe_from_display_mode(&frame.avi,
						       adjusted_mode);
	if (ret < 0) {
		DRM_ERROR("couldn't fill AVI infoframe\n");
		return false;
	}
979

980
	if (intel_sdvo->rgb_quant_range_selectable) {
981
		if (intel_crtc->config.limited_color_range)
982 983
			frame.avi.quantization_range =
				HDMI_QUANTIZATION_RANGE_LIMITED;
984
		else
985 986
			frame.avi.quantization_range =
				HDMI_QUANTIZATION_RANGE_FULL;
987 988
	}

989 990 991
	len = hdmi_infoframe_pack(&frame, sdvo_data, sizeof(sdvo_data));
	if (len < 0)
		return false;
992

993 994 995
	return intel_sdvo_write_infoframe(intel_sdvo, SDVO_HBUF_INDEX_AVI_IF,
					  SDVO_HBUF_TX_VSYNC,
					  sdvo_data, sizeof(sdvo_data));
996 997
}

998
static bool intel_sdvo_set_tv_format(struct intel_sdvo *intel_sdvo)
Z
Zhenyu Wang 已提交
999
{
1000
	struct intel_sdvo_tv_format format;
1001
	uint32_t format_map;
1002

1003
	format_map = 1 << intel_sdvo->tv_format_index;
1004
	memset(&format, 0, sizeof(format));
1005
	memcpy(&format, &format_map, min(sizeof(format), sizeof(format_map)));
1006

1007 1008 1009 1010
	BUILD_BUG_ON(sizeof(format) != 6);
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_TV_FORMAT,
				    &format, sizeof(format));
Z
Zhenyu Wang 已提交
1011 1012
}

1013 1014
static bool
intel_sdvo_set_output_timings_from_mode(struct intel_sdvo *intel_sdvo,
1015
					const struct drm_display_mode *mode)
1016
{
1017
	struct intel_sdvo_dtd output_dtd;
J
Jesse Barnes 已提交
1018

1019 1020 1021
	if (!intel_sdvo_set_target_output(intel_sdvo,
					  intel_sdvo->attached_output))
		return false;
1022

1023 1024 1025
	intel_sdvo_get_dtd_from_mode(&output_dtd, mode);
	if (!intel_sdvo_set_output_timing(intel_sdvo, &output_dtd))
		return false;
1026

1027 1028 1029
	return true;
}

1030 1031
/* Asks the sdvo controller for the preferred input mode given the output mode.
 * Unfortunately we have to set up the full output mode to do that. */
1032
static bool
1033
intel_sdvo_get_preferred_input_mode(struct intel_sdvo *intel_sdvo,
1034
				    const struct drm_display_mode *mode,
1035
				    struct drm_display_mode *adjusted_mode)
1036
{
1037 1038
	struct intel_sdvo_dtd input_dtd;

1039 1040 1041
	/* Reset the input timing to the screen. Assume always input 0. */
	if (!intel_sdvo_set_target_input(intel_sdvo))
		return false;
1042

1043 1044 1045 1046 1047
	if (!intel_sdvo_create_preferred_input_timing(intel_sdvo,
						      mode->clock / 10,
						      mode->hdisplay,
						      mode->vdisplay))
		return false;
1048

1049
	if (!intel_sdvo_get_preferred_input_timing(intel_sdvo,
1050
						   &input_dtd))
1051
		return false;
1052

1053
	intel_sdvo_get_mode_from_dtd(adjusted_mode, &input_dtd);
1054
	intel_sdvo->dtd_sdvo_flags = input_dtd.part2.sdvo_flags;
J
Jesse Barnes 已提交
1055

1056 1057
	return true;
}
1058

1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084
static void i9xx_adjust_sdvo_tv_clock(struct intel_crtc_config *pipe_config)
{
	unsigned dotclock = pipe_config->adjusted_mode.clock;
	struct dpll *clock = &pipe_config->dpll;

	/* SDVO TV has fixed PLL values depend on its clock range,
	   this mirrors vbios setting. */
	if (dotclock >= 100000 && dotclock < 140500) {
		clock->p1 = 2;
		clock->p2 = 10;
		clock->n = 3;
		clock->m1 = 16;
		clock->m2 = 8;
	} else if (dotclock >= 140500 && dotclock <= 200000) {
		clock->p1 = 1;
		clock->p2 = 10;
		clock->n = 6;
		clock->m1 = 12;
		clock->m2 = 8;
	} else {
		WARN(1, "SDVO TV clock out of range: %i\n", dotclock);
	}

	pipe_config->clock_set = true;
}

1085 1086
static bool intel_sdvo_compute_config(struct intel_encoder *encoder,
				      struct intel_crtc_config *pipe_config)
1087
{
1088
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1089 1090
	struct drm_display_mode *adjusted_mode = &pipe_config->adjusted_mode;
	struct drm_display_mode *mode = &pipe_config->requested_mode;
1091

1092 1093 1094
	DRM_DEBUG_KMS("forcing bpc to 8 for SDVO\n");
	pipe_config->pipe_bpp = 8*3;

1095 1096 1097
	if (HAS_PCH_SPLIT(encoder->base.dev))
		pipe_config->has_pch_encoder = true;

1098 1099 1100 1101 1102 1103 1104 1105
	/* We need to construct preferred input timings based on our
	 * output timings.  To do that, we have to set the output
	 * timings, even though this isn't really the right place in
	 * the sequence to do it. Oh well.
	 */
	if (intel_sdvo->is_tv) {
		if (!intel_sdvo_set_output_timings_from_mode(intel_sdvo, mode))
			return false;
1106

1107 1108 1109
		(void) intel_sdvo_get_preferred_input_mode(intel_sdvo,
							   mode,
							   adjusted_mode);
1110
		pipe_config->sdvo_tv_clock = true;
C
Chris Wilson 已提交
1111
	} else if (intel_sdvo->is_lvds) {
1112
		if (!intel_sdvo_set_output_timings_from_mode(intel_sdvo,
1113
							     intel_sdvo->sdvo_lvds_fixed_mode))
1114
			return false;
1115

1116 1117 1118
		(void) intel_sdvo_get_preferred_input_mode(intel_sdvo,
							   mode,
							   adjusted_mode);
1119
	}
1120 1121

	/* Make the CRTC code factor in the SDVO pixel multiplier.  The
1122
	 * SDVO device will factor out the multiplier during mode_set.
1123
	 */
1124 1125 1126
	pipe_config->pixel_multiplier =
		intel_sdvo_get_pixel_multiplier(adjusted_mode);
	adjusted_mode->clock *= pipe_config->pixel_multiplier;
1127

1128 1129
	if (intel_sdvo->color_range_auto) {
		/* See CEA-861-E - 5.1 Default Encoding Parameters */
1130 1131
		/* FIXME: This bit is only valid when using TMDS encoding and 8
		 * bit per color mode. */
1132
		if (intel_sdvo->has_hdmi_monitor &&
1133
		    drm_match_cea_mode(adjusted_mode) > 1)
1134
			intel_sdvo->color_range = HDMI_COLOR_RANGE_16_235;
1135 1136 1137 1138
		else
			intel_sdvo->color_range = 0;
	}

1139
	if (intel_sdvo->color_range)
1140
		pipe_config->limited_color_range = true;
1141

1142 1143 1144 1145
	/* Clock computation needs to happen after pixel multiplier. */
	if (intel_sdvo->is_tv)
		i9xx_adjust_sdvo_tv_clock(pipe_config);

1146 1147 1148
	return true;
}

1149
static void intel_sdvo_mode_set(struct intel_encoder *intel_encoder)
1150
{
1151
	struct drm_device *dev = intel_encoder->base.dev;
1152
	struct drm_i915_private *dev_priv = dev->dev_private;
1153
	struct drm_crtc *crtc = intel_encoder->base.crtc;
1154
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
1155 1156 1157
	struct drm_display_mode *adjusted_mode =
		&intel_crtc->config.adjusted_mode;
	struct drm_display_mode *mode = &intel_crtc->config.requested_mode;
1158
	struct intel_sdvo *intel_sdvo = to_sdvo(intel_encoder);
1159
	u32 sdvox;
1160
	struct intel_sdvo_in_out_map in_out;
1161
	struct intel_sdvo_dtd input_dtd, output_dtd;
1162
	int rate;
1163 1164 1165 1166 1167 1168 1169 1170 1171 1172

	if (!mode)
		return;

	/* First, set the input mapping for the first input to our controlled
	 * output. This is only correct if we're a single-input device, in
	 * which case the first input is the output from the appropriate SDVO
	 * channel on the motherboard.  In a two-input device, the first input
	 * will be SDVOB and the second SDVOC.
	 */
C
Chris Wilson 已提交
1173
	in_out.in0 = intel_sdvo->attached_output;
1174 1175
	in_out.in1 = 0;

1176 1177 1178
	intel_sdvo_set_value(intel_sdvo,
			     SDVO_CMD_SET_IN_OUT_MAP,
			     &in_out, sizeof(in_out));
1179

1180 1181 1182 1183
	/* Set the output timings to the screen */
	if (!intel_sdvo_set_target_output(intel_sdvo,
					  intel_sdvo->attached_output))
		return;
1184

1185 1186 1187 1188 1189 1190
	/* lvds has a special fixed output timing. */
	if (intel_sdvo->is_lvds)
		intel_sdvo_get_dtd_from_mode(&output_dtd,
					     intel_sdvo->sdvo_lvds_fixed_mode);
	else
		intel_sdvo_get_dtd_from_mode(&output_dtd, mode);
1191 1192 1193
	if (!intel_sdvo_set_output_timing(intel_sdvo, &output_dtd))
		DRM_INFO("Setting output timings on %s failed\n",
			 SDVO_NAME(intel_sdvo));
J
Jesse Barnes 已提交
1194 1195

	/* Set the input timing to the screen. Assume always input 0. */
1196 1197
	if (!intel_sdvo_set_target_input(intel_sdvo))
		return;
J
Jesse Barnes 已提交
1198

1199 1200 1201 1202
	if (intel_sdvo->has_hdmi_monitor) {
		intel_sdvo_set_encode(intel_sdvo, SDVO_ENCODE_HDMI);
		intel_sdvo_set_colorimetry(intel_sdvo,
					   SDVO_COLORIMETRY_RGB256);
1203
		intel_sdvo_set_avi_infoframe(intel_sdvo, adjusted_mode);
1204 1205
	} else
		intel_sdvo_set_encode(intel_sdvo, SDVO_ENCODE_DVI);
Z
Zhenyu Wang 已提交
1206

1207 1208 1209
	if (intel_sdvo->is_tv &&
	    !intel_sdvo_set_tv_format(intel_sdvo))
		return;
1210

1211 1212 1213 1214
	/* We have tried to get input timing in mode_fixup, and filled into
	 * adjusted_mode.
	 */
	intel_sdvo_get_dtd_from_mode(&input_dtd, adjusted_mode);
1215 1216
	if (intel_sdvo->is_tv || intel_sdvo->is_lvds)
		input_dtd.part2.sdvo_flags = intel_sdvo->dtd_sdvo_flags;
1217 1218 1219
	if (!intel_sdvo_set_input_timing(intel_sdvo, &input_dtd))
		DRM_INFO("Setting input timings on %s failed\n",
			 SDVO_NAME(intel_sdvo));
J
Jesse Barnes 已提交
1220

1221
	switch (intel_crtc->config.pixel_multiplier) {
1222
	default:
1223
		WARN(1, "unknown pixel mutlipler specified\n");
1224 1225 1226
	case 1: rate = SDVO_CLOCK_RATE_MULT_1X; break;
	case 2: rate = SDVO_CLOCK_RATE_MULT_2X; break;
	case 4: rate = SDVO_CLOCK_RATE_MULT_4X; break;
J
Jesse Barnes 已提交
1227
	}
1228 1229
	if (!intel_sdvo_set_clock_rate_mult(intel_sdvo, rate))
		return;
J
Jesse Barnes 已提交
1230 1231

	/* Set the SDVO control regs. */
1232
	if (INTEL_INFO(dev)->gen >= 4) {
1233 1234 1235
		/* The real mode polarity is set by the SDVO commands, using
		 * struct intel_sdvo_dtd. */
		sdvox = SDVO_VSYNC_ACTIVE_HIGH | SDVO_HSYNC_ACTIVE_HIGH;
1236
		if (!HAS_PCH_SPLIT(dev) && intel_sdvo->is_hdmi)
1237
			sdvox |= intel_sdvo->color_range;
1238 1239
		if (INTEL_INFO(dev)->gen < 5)
			sdvox |= SDVO_BORDER_ENABLE;
1240
	} else {
1241
		sdvox = I915_READ(intel_sdvo->sdvo_reg);
C
Chris Wilson 已提交
1242
		switch (intel_sdvo->sdvo_reg) {
1243
		case GEN3_SDVOB:
1244 1245
			sdvox &= SDVOB_PRESERVE_MASK;
			break;
1246
		case GEN3_SDVOC:
1247 1248 1249 1250 1251
			sdvox &= SDVOC_PRESERVE_MASK;
			break;
		}
		sdvox |= (9 << 19) | SDVO_BORDER_ENABLE;
	}
1252 1253

	if (INTEL_PCH_TYPE(dev) >= PCH_CPT)
1254
		sdvox |= SDVO_PIPE_SEL_CPT(intel_crtc->pipe);
1255
	else
1256
		sdvox |= SDVO_PIPE_SEL(intel_crtc->pipe);
1257

1258
	if (intel_sdvo->has_hdmi_audio)
1259
		sdvox |= SDVO_AUDIO_ENABLE;
J
Jesse Barnes 已提交
1260

1261
	if (INTEL_INFO(dev)->gen >= 4) {
1262 1263 1264
		/* done in crtc_mode_set as the dpll_md reg must be written early */
	} else if (IS_I945G(dev) || IS_I945GM(dev) || IS_G33(dev)) {
		/* done in crtc_mode_set as it lives inside the dpll register */
J
Jesse Barnes 已提交
1265
	} else {
1266 1267
		sdvox |= (intel_crtc->config.pixel_multiplier - 1)
			<< SDVO_PORT_MULTIPLY_SHIFT;
J
Jesse Barnes 已提交
1268 1269
	}

1270 1271
	if (input_dtd.part2.sdvo_flags & SDVO_NEED_TO_STALL &&
	    INTEL_INFO(dev)->gen < 5)
1272
		sdvox |= SDVO_STALL_SELECT;
C
Chris Wilson 已提交
1273
	intel_sdvo_write_sdvox(intel_sdvo, sdvox);
J
Jesse Barnes 已提交
1274 1275
}

1276
static bool intel_sdvo_connector_get_hw_state(struct intel_connector *connector)
J
Jesse Barnes 已提交
1277
{
1278 1279 1280
	struct intel_sdvo_connector *intel_sdvo_connector =
		to_intel_sdvo_connector(&connector->base);
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(&connector->base);
1281
	u16 active_outputs = 0;
1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294

	intel_sdvo_get_active_outputs(intel_sdvo, &active_outputs);

	if (active_outputs & intel_sdvo_connector->output_flag)
		return true;
	else
		return false;
}

static bool intel_sdvo_get_hw_state(struct intel_encoder *encoder,
				    enum pipe *pipe)
{
	struct drm_device *dev = encoder->base.dev;
J
Jesse Barnes 已提交
1295
	struct drm_i915_private *dev_priv = dev->dev_private;
1296
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1297
	u16 active_outputs = 0;
1298 1299 1300
	u32 tmp;

	tmp = I915_READ(intel_sdvo->sdvo_reg);
1301
	intel_sdvo_get_active_outputs(intel_sdvo, &active_outputs);
1302

1303
	if (!(tmp & SDVO_ENABLE) && (active_outputs == 0))
1304 1305 1306 1307 1308 1309 1310 1311 1312 1313
		return false;

	if (HAS_PCH_CPT(dev))
		*pipe = PORT_TO_PIPE_CPT(tmp);
	else
		*pipe = PORT_TO_PIPE(tmp);

	return true;
}

1314 1315 1316
static void intel_sdvo_get_config(struct intel_encoder *encoder,
				  struct intel_crtc_config *pipe_config)
{
1317 1318
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
1319
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1320
	struct intel_sdvo_dtd dtd;
1321 1322 1323
	int encoder_pixel_multiplier = 0;
	u32 flags = 0, sdvox;
	u8 val;
1324 1325 1326 1327
	bool ret;

	ret = intel_sdvo_get_input_timing(intel_sdvo, &dtd);
	if (!ret) {
1328 1329
		/* Some sdvo encoders are not spec compliant and don't
		 * implement the mandatory get_timings function. */
1330
		DRM_DEBUG_DRIVER("failed to retrieve SDVO DTD\n");
1331 1332 1333 1334 1335 1336
		pipe_config->quirks |= PIPE_CONFIG_QUIRK_MODE_SYNC_FLAGS;
	} else {
		if (dtd.part2.dtd_flags & DTD_FLAG_HSYNC_POSITIVE)
			flags |= DRM_MODE_FLAG_PHSYNC;
		else
			flags |= DRM_MODE_FLAG_NHSYNC;
1337

1338 1339 1340 1341
		if (dtd.part2.dtd_flags & DTD_FLAG_VSYNC_POSITIVE)
			flags |= DRM_MODE_FLAG_PVSYNC;
		else
			flags |= DRM_MODE_FLAG_NVSYNC;
1342 1343 1344 1345
	}

	pipe_config->adjusted_mode.flags |= flags;

1346 1347 1348 1349 1350 1351 1352
	/*
	 * pixel multiplier readout is tricky: Only on i915g/gm it is stored in
	 * the sdvo port register, on all other platforms it is part of the dpll
	 * state. Since the general pipe state readout happens before the
	 * encoder->get_config we so already have a valid pixel multplier on all
	 * other platfroms.
	 */
1353 1354 1355 1356 1357 1358
	if (IS_I915G(dev) || IS_I915GM(dev)) {
		sdvox = I915_READ(intel_sdvo->sdvo_reg);
		pipe_config->pixel_multiplier =
			((sdvox & SDVO_PORT_MULTIPLY_MASK)
			 >> SDVO_PORT_MULTIPLY_SHIFT) + 1;
	}
1359

1360
	/* Cross check the port pixel multiplier with the sdvo encoder state. */
1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
	if (intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_CLOCK_RATE_MULT,
				 &val, 1)) {
		switch (val) {
		case SDVO_CLOCK_RATE_MULT_1X:
			encoder_pixel_multiplier = 1;
			break;
		case SDVO_CLOCK_RATE_MULT_2X:
			encoder_pixel_multiplier = 2;
			break;
		case SDVO_CLOCK_RATE_MULT_4X:
			encoder_pixel_multiplier = 4;
			break;
		}
1374
	}
1375

1376 1377 1378
	WARN(encoder_pixel_multiplier != pipe_config->pixel_multiplier,
	     "SDVO pixel multiplier mismatch, port: %i, encoder: %i\n",
	     pipe_config->pixel_multiplier, encoder_pixel_multiplier);
1379 1380
}

1381 1382 1383
static void intel_disable_sdvo(struct intel_encoder *encoder)
{
	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
1384
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1385 1386 1387 1388 1389 1390 1391 1392 1393
	u32 temp;

	intel_sdvo_set_active_outputs(intel_sdvo, 0);
	if (0)
		intel_sdvo_set_encoder_power_state(intel_sdvo,
						   DRM_MODE_DPMS_OFF);

	temp = I915_READ(intel_sdvo->sdvo_reg);
	if ((temp & SDVO_ENABLE) != 0) {
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417
		/* HW workaround for IBX, we need to move the port to
		 * transcoder A before disabling it. */
		if (HAS_PCH_IBX(encoder->base.dev)) {
			struct drm_crtc *crtc = encoder->base.crtc;
			int pipe = crtc ? to_intel_crtc(crtc)->pipe : -1;

			if (temp & SDVO_PIPE_B_SELECT) {
				temp &= ~SDVO_PIPE_B_SELECT;
				I915_WRITE(intel_sdvo->sdvo_reg, temp);
				POSTING_READ(intel_sdvo->sdvo_reg);

				/* Again we need to write this twice. */
				I915_WRITE(intel_sdvo->sdvo_reg, temp);
				POSTING_READ(intel_sdvo->sdvo_reg);

				/* Transcoder selection bits only update
				 * effectively on vblank. */
				if (crtc)
					intel_wait_for_vblank(encoder->base.dev, pipe);
				else
					msleep(50);
			}
		}

1418 1419 1420 1421 1422 1423 1424 1425
		intel_sdvo_write_sdvox(intel_sdvo, temp & ~SDVO_ENABLE);
	}
}

static void intel_enable_sdvo(struct intel_encoder *encoder)
{
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
1426
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1427
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
J
Jesse Barnes 已提交
1428
	u32 temp;
1429 1430 1431 1432 1433
	bool input1, input2;
	int i;
	u8 status;

	temp = I915_READ(intel_sdvo->sdvo_reg);
1434 1435
	if ((temp & SDVO_ENABLE) == 0) {
		/* HW workaround for IBX, we need to move the port
1436 1437 1438
		 * to transcoder A before disabling it, so restore it here. */
		if (HAS_PCH_IBX(dev))
			temp |= SDVO_PIPE_SEL(intel_crtc->pipe);
1439

1440
		intel_sdvo_write_sdvox(intel_sdvo, temp | SDVO_ENABLE);
1441
	}
1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460
	for (i = 0; i < 2; i++)
		intel_wait_for_vblank(dev, intel_crtc->pipe);

	status = intel_sdvo_get_trained_inputs(intel_sdvo, &input1, &input2);
	/* Warn if the device reported failure to sync.
	 * A lot of SDVO devices fail to notify of sync, but it's
	 * a given it the status is a success, we succeeded.
	 */
	if (status == SDVO_CMD_STATUS_SUCCESS && !input1) {
		DRM_DEBUG_KMS("First %s output reported failure to "
				"sync\n", SDVO_NAME(intel_sdvo));
	}

	if (0)
		intel_sdvo_set_encoder_power_state(intel_sdvo,
						   DRM_MODE_DPMS_ON);
	intel_sdvo_set_active_outputs(intel_sdvo, intel_sdvo->attached_output);
}

1461
/* Special dpms function to support cloning between dvo/sdvo/crt. */
1462
static void intel_sdvo_dpms(struct drm_connector *connector, int mode)
J
Jesse Barnes 已提交
1463
{
1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481
	struct drm_crtc *crtc;
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);

	/* dvo supports only 2 dpms states. */
	if (mode != DRM_MODE_DPMS_ON)
		mode = DRM_MODE_DPMS_OFF;

	if (mode == connector->dpms)
		return;

	connector->dpms = mode;

	/* Only need to change hw state when actually enabled */
	crtc = intel_sdvo->base.base.crtc;
	if (!crtc) {
		intel_sdvo->base.connectors_active = false;
		return;
	}
J
Jesse Barnes 已提交
1482

1483 1484
	/* We set active outputs manually below in case pipe dpms doesn't change
	 * due to cloning. */
J
Jesse Barnes 已提交
1485
	if (mode != DRM_MODE_DPMS_ON) {
C
Chris Wilson 已提交
1486
		intel_sdvo_set_active_outputs(intel_sdvo, 0);
J
Jesse Barnes 已提交
1487
		if (0)
C
Chris Wilson 已提交
1488
			intel_sdvo_set_encoder_power_state(intel_sdvo, mode);
J
Jesse Barnes 已提交
1489

1490 1491 1492
		intel_sdvo->base.connectors_active = false;

		intel_crtc_update_dpms(crtc);
J
Jesse Barnes 已提交
1493
	} else {
1494 1495 1496
		intel_sdvo->base.connectors_active = true;

		intel_crtc_update_dpms(crtc);
J
Jesse Barnes 已提交
1497 1498

		if (0)
C
Chris Wilson 已提交
1499 1500
			intel_sdvo_set_encoder_power_state(intel_sdvo, mode);
		intel_sdvo_set_active_outputs(intel_sdvo, intel_sdvo->attached_output);
J
Jesse Barnes 已提交
1501
	}
1502

1503
	intel_modeset_check_state(connector->dev);
J
Jesse Barnes 已提交
1504 1505 1506 1507 1508
}

static int intel_sdvo_mode_valid(struct drm_connector *connector,
				 struct drm_display_mode *mode)
{
1509
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
J
Jesse Barnes 已提交
1510 1511 1512 1513

	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
		return MODE_NO_DBLESCAN;

C
Chris Wilson 已提交
1514
	if (intel_sdvo->pixel_clock_min > mode->clock)
J
Jesse Barnes 已提交
1515 1516
		return MODE_CLOCK_LOW;

C
Chris Wilson 已提交
1517
	if (intel_sdvo->pixel_clock_max < mode->clock)
J
Jesse Barnes 已提交
1518 1519
		return MODE_CLOCK_HIGH;

1520
	if (intel_sdvo->is_lvds) {
C
Chris Wilson 已提交
1521
		if (mode->hdisplay > intel_sdvo->sdvo_lvds_fixed_mode->hdisplay)
1522 1523
			return MODE_PANEL;

C
Chris Wilson 已提交
1524
		if (mode->vdisplay > intel_sdvo->sdvo_lvds_fixed_mode->vdisplay)
1525 1526 1527
			return MODE_PANEL;
	}

J
Jesse Barnes 已提交
1528 1529 1530
	return MODE_OK;
}

C
Chris Wilson 已提交
1531
static bool intel_sdvo_get_capabilities(struct intel_sdvo *intel_sdvo, struct intel_sdvo_caps *caps)
J
Jesse Barnes 已提交
1532
{
1533
	BUILD_BUG_ON(sizeof(*caps) != 8);
C
Chris Wilson 已提交
1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_DEVICE_CAPS,
				  caps, sizeof(*caps)))
		return false;

	DRM_DEBUG_KMS("SDVO capabilities:\n"
		      "  vendor_id: %d\n"
		      "  device_id: %d\n"
		      "  device_rev_id: %d\n"
		      "  sdvo_version_major: %d\n"
		      "  sdvo_version_minor: %d\n"
		      "  sdvo_inputs_mask: %d\n"
		      "  smooth_scaling: %d\n"
		      "  sharp_scaling: %d\n"
		      "  up_scaling: %d\n"
		      "  down_scaling: %d\n"
		      "  stall_support: %d\n"
		      "  output_flags: %d\n",
		      caps->vendor_id,
		      caps->device_id,
		      caps->device_rev_id,
		      caps->sdvo_version_major,
		      caps->sdvo_version_minor,
		      caps->sdvo_inputs_mask,
		      caps->smooth_scaling,
		      caps->sharp_scaling,
		      caps->up_scaling,
		      caps->down_scaling,
		      caps->stall_support,
		      caps->output_flags);

	return true;
J
Jesse Barnes 已提交
1566 1567
}

1568
static uint16_t intel_sdvo_get_hotplug_support(struct intel_sdvo *intel_sdvo)
J
Jesse Barnes 已提交
1569
{
1570
	struct drm_device *dev = intel_sdvo->base.base.dev;
1571
	uint16_t hotplug;
J
Jesse Barnes 已提交
1572

1573 1574 1575
	/* HW Erratum: SDVO Hotplug is broken on all i945G chips, there's noise
	 * on the line. */
	if (IS_I945G(dev) || IS_I945GM(dev))
1576
		return 0;
1577

1578 1579 1580
	if (!intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_HOT_PLUG_SUPPORT,
					&hotplug, sizeof(hotplug)))
		return 0;
1581

1582
	return hotplug;
J
Jesse Barnes 已提交
1583 1584
}

1585
static void intel_sdvo_enable_hotplug(struct intel_encoder *encoder)
J
Jesse Barnes 已提交
1586
{
1587
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
J
Jesse Barnes 已提交
1588

1589 1590
	intel_sdvo_write_cmd(intel_sdvo, SDVO_CMD_SET_ACTIVE_HOT_PLUG,
			&intel_sdvo->hotplug_active, 2);
J
Jesse Barnes 已提交
1591 1592
}

1593
static bool
C
Chris Wilson 已提交
1594
intel_sdvo_multifunc_encoder(struct intel_sdvo *intel_sdvo)
1595
{
1596
	/* Is there more than one type of output? */
1597
	return hweight16(intel_sdvo->caps.output_flags) > 1;
1598 1599
}

1600
static struct edid *
C
Chris Wilson 已提交
1601
intel_sdvo_get_edid(struct drm_connector *connector)
1602
{
C
Chris Wilson 已提交
1603 1604
	struct intel_sdvo *sdvo = intel_attached_sdvo(connector);
	return drm_get_edid(connector, &sdvo->ddc);
1605 1606
}

1607 1608 1609 1610
/* Mac mini hack -- use the same DDC as the analog connector */
static struct edid *
intel_sdvo_get_analog_edid(struct drm_connector *connector)
{
1611
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
1612

1613
	return drm_get_edid(connector,
1614
			    intel_gmbus_get_adapter(dev_priv,
1615
						    dev_priv->vbt.crt_ddc_pin));
1616 1617
}

1618
static enum drm_connector_status
1619
intel_sdvo_tmds_sink_detect(struct drm_connector *connector)
1620
{
1621
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
1622 1623
	enum drm_connector_status status;
	struct edid *edid;
1624

C
Chris Wilson 已提交
1625
	edid = intel_sdvo_get_edid(connector);
1626

C
Chris Wilson 已提交
1627
	if (edid == NULL && intel_sdvo_multifunc_encoder(intel_sdvo)) {
C
Chris Wilson 已提交
1628
		u8 ddc, saved_ddc = intel_sdvo->ddc_bus;
1629

1630 1631 1632 1633
		/*
		 * Don't use the 1 as the argument of DDC bus switch to get
		 * the EDID. It is used for SDVO SPD ROM.
		 */
1634
		for (ddc = intel_sdvo->ddc_bus >> 1; ddc > 1; ddc >>= 1) {
C
Chris Wilson 已提交
1635 1636 1637
			intel_sdvo->ddc_bus = ddc;
			edid = intel_sdvo_get_edid(connector);
			if (edid)
1638 1639
				break;
		}
C
Chris Wilson 已提交
1640 1641 1642 1643 1644 1645
		/*
		 * If we found the EDID on the other bus,
		 * assume that is the correct DDC bus.
		 */
		if (edid == NULL)
			intel_sdvo->ddc_bus = saved_ddc;
1646
	}
1647 1648 1649 1650

	/*
	 * When there is no edid and no monitor is connected with VGA
	 * port, try to use the CRT ddc to read the EDID for DVI-connector.
1651
	 */
1652 1653
	if (edid == NULL)
		edid = intel_sdvo_get_analog_edid(connector);
1654

1655
	status = connector_status_unknown;
1656
	if (edid != NULL) {
1657
		/* DDC bus is shared, match EDID to connector type */
1658 1659
		if (edid->input & DRM_EDID_INPUT_DIGITAL) {
			status = connector_status_connected;
1660 1661 1662
			if (intel_sdvo->is_hdmi) {
				intel_sdvo->has_hdmi_monitor = drm_detect_hdmi_monitor(edid);
				intel_sdvo->has_hdmi_audio = drm_detect_monitor_audio(edid);
1663 1664
				intel_sdvo->rgb_quant_range_selectable =
					drm_rgb_quant_range_selectable(edid);
1665
			}
1666 1667
		} else
			status = connector_status_disconnected;
1668 1669
		kfree(edid);
	}
1670 1671 1672

	if (status == connector_status_connected) {
		struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1673 1674
		if (intel_sdvo_connector->force_audio != HDMI_AUDIO_AUTO)
			intel_sdvo->has_hdmi_audio = (intel_sdvo_connector->force_audio == HDMI_AUDIO_ON);
1675 1676
	}

1677
	return status;
1678 1679
}

1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691
static bool
intel_sdvo_connector_matches_edid(struct intel_sdvo_connector *sdvo,
				  struct edid *edid)
{
	bool monitor_is_digital = !!(edid->input & DRM_EDID_INPUT_DIGITAL);
	bool connector_is_digital = !!IS_DIGITAL(sdvo);

	DRM_DEBUG_KMS("connector_is_digital? %d, monitor_is_digital? %d\n",
		      connector_is_digital, monitor_is_digital);
	return connector_is_digital == monitor_is_digital;
}

1692
static enum drm_connector_status
1693
intel_sdvo_detect(struct drm_connector *connector, bool force)
J
Jesse Barnes 已提交
1694
{
1695
	uint16_t response;
1696
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
1697
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1698
	enum drm_connector_status ret;
J
Jesse Barnes 已提交
1699

1700 1701 1702
	DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
		      connector->base.id, drm_get_connector_name(connector));

1703 1704 1705
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_ATTACHED_DISPLAYS,
				  &response, 2))
1706
		return connector_status_unknown;
J
Jesse Barnes 已提交
1707

C
Chris Wilson 已提交
1708 1709 1710
	DRM_DEBUG_KMS("SDVO response %d %d [%x]\n",
		      response & 0xff, response >> 8,
		      intel_sdvo_connector->output_flag);
1711

1712
	if (response == 0)
J
Jesse Barnes 已提交
1713
		return connector_status_disconnected;
1714

C
Chris Wilson 已提交
1715
	intel_sdvo->attached_output = response;
1716

1717 1718
	intel_sdvo->has_hdmi_monitor = false;
	intel_sdvo->has_hdmi_audio = false;
1719
	intel_sdvo->rgb_quant_range_selectable = false;
1720

1721
	if ((intel_sdvo_connector->output_flag & response) == 0)
1722
		ret = connector_status_disconnected;
1723
	else if (IS_TMDS(intel_sdvo_connector))
1724
		ret = intel_sdvo_tmds_sink_detect(connector);
1725 1726 1727 1728 1729 1730 1731 1732
	else {
		struct edid *edid;

		/* if we have an edid check it matches the connection */
		edid = intel_sdvo_get_edid(connector);
		if (edid == NULL)
			edid = intel_sdvo_get_analog_edid(connector);
		if (edid != NULL) {
1733 1734
			if (intel_sdvo_connector_matches_edid(intel_sdvo_connector,
							      edid))
1735
				ret = connector_status_connected;
1736 1737 1738
			else
				ret = connector_status_disconnected;

1739 1740 1741 1742
			kfree(edid);
		} else
			ret = connector_status_connected;
	}
1743 1744 1745

	/* May update encoder flag for like clock for SDVO TV, etc.*/
	if (ret == connector_status_connected) {
C
Chris Wilson 已提交
1746 1747
		intel_sdvo->is_tv = false;
		intel_sdvo->is_lvds = false;
1748

1749
		if (response & SDVO_TV_MASK)
C
Chris Wilson 已提交
1750
			intel_sdvo->is_tv = true;
1751
		if (response & SDVO_LVDS_MASK)
1752
			intel_sdvo->is_lvds = intel_sdvo->sdvo_lvds_fixed_mode != NULL;
1753
	}
1754 1755

	return ret;
J
Jesse Barnes 已提交
1756 1757
}

1758
static void intel_sdvo_get_ddc_modes(struct drm_connector *connector)
J
Jesse Barnes 已提交
1759
{
1760
	struct edid *edid;
J
Jesse Barnes 已提交
1761 1762

	/* set the bus switch and get the modes */
C
Chris Wilson 已提交
1763
	edid = intel_sdvo_get_edid(connector);
J
Jesse Barnes 已提交
1764

1765 1766 1767 1768 1769
	/*
	 * Mac mini hack.  On this device, the DVI-I connector shares one DDC
	 * link between analog and digital outputs. So, if the regular SDVO
	 * DDC fails, check to see if the analog output is disconnected, in
	 * which case we'll look there for the digital DDC data.
1770
	 */
1771 1772 1773
	if (edid == NULL)
		edid = intel_sdvo_get_analog_edid(connector);

1774
	if (edid != NULL) {
1775 1776
		if (intel_sdvo_connector_matches_edid(to_intel_sdvo_connector(connector),
						      edid)) {
1777 1778 1779
			drm_mode_connector_update_edid_property(connector, edid);
			drm_add_edid_modes(connector, edid);
		}
1780

1781
		kfree(edid);
1782 1783 1784 1785 1786 1787 1788 1789
	}
}

/*
 * Set of SDVO TV modes.
 * Note!  This is in reply order (see loop in get_tv_modes).
 * XXX: all 60Hz refresh?
 */
1790
static const struct drm_display_mode sdvo_tv_modes[] = {
Z
Zhenyu Wang 已提交
1791 1792
	{ DRM_MODE("320x200", DRM_MODE_TYPE_DRIVER, 5815, 320, 321, 384,
		   416, 0, 200, 201, 232, 233, 0,
1793
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1794 1795
	{ DRM_MODE("320x240", DRM_MODE_TYPE_DRIVER, 6814, 320, 321, 384,
		   416, 0, 240, 241, 272, 273, 0,
1796
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1797 1798
	{ DRM_MODE("400x300", DRM_MODE_TYPE_DRIVER, 9910, 400, 401, 464,
		   496, 0, 300, 301, 332, 333, 0,
1799
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1800 1801
	{ DRM_MODE("640x350", DRM_MODE_TYPE_DRIVER, 16913, 640, 641, 704,
		   736, 0, 350, 351, 382, 383, 0,
1802
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1803 1804
	{ DRM_MODE("640x400", DRM_MODE_TYPE_DRIVER, 19121, 640, 641, 704,
		   736, 0, 400, 401, 432, 433, 0,
1805
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1806 1807
	{ DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 22654, 640, 641, 704,
		   736, 0, 480, 481, 512, 513, 0,
1808
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1809 1810
	{ DRM_MODE("704x480", DRM_MODE_TYPE_DRIVER, 24624, 704, 705, 768,
		   800, 0, 480, 481, 512, 513, 0,
1811
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1812 1813
	{ DRM_MODE("704x576", DRM_MODE_TYPE_DRIVER, 29232, 704, 705, 768,
		   800, 0, 576, 577, 608, 609, 0,
1814
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1815 1816
	{ DRM_MODE("720x350", DRM_MODE_TYPE_DRIVER, 18751, 720, 721, 784,
		   816, 0, 350, 351, 382, 383, 0,
1817
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1818 1819
	{ DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 21199, 720, 721, 784,
		   816, 0, 400, 401, 432, 433, 0,
1820
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1821 1822
	{ DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 25116, 720, 721, 784,
		   816, 0, 480, 481, 512, 513, 0,
1823
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1824 1825
	{ DRM_MODE("720x540", DRM_MODE_TYPE_DRIVER, 28054, 720, 721, 784,
		   816, 0, 540, 541, 572, 573, 0,
1826
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1827 1828
	{ DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 29816, 720, 721, 784,
		   816, 0, 576, 577, 608, 609, 0,
1829
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1830 1831
	{ DRM_MODE("768x576", DRM_MODE_TYPE_DRIVER, 31570, 768, 769, 832,
		   864, 0, 576, 577, 608, 609, 0,
1832
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1833 1834
	{ DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 34030, 800, 801, 864,
		   896, 0, 600, 601, 632, 633, 0,
1835
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1836 1837
	{ DRM_MODE("832x624", DRM_MODE_TYPE_DRIVER, 36581, 832, 833, 896,
		   928, 0, 624, 625, 656, 657, 0,
1838
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1839 1840
	{ DRM_MODE("920x766", DRM_MODE_TYPE_DRIVER, 48707, 920, 921, 984,
		   1016, 0, 766, 767, 798, 799, 0,
1841
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1842 1843
	{ DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 53827, 1024, 1025, 1088,
		   1120, 0, 768, 769, 800, 801, 0,
1844
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
Z
Zhenyu Wang 已提交
1845 1846
	{ DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 87265, 1280, 1281, 1344,
		   1376, 0, 1024, 1025, 1056, 1057, 0,
1847 1848 1849 1850 1851
		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
};

static void intel_sdvo_get_tv_modes(struct drm_connector *connector)
{
1852
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
Z
Zhenyu Wang 已提交
1853
	struct intel_sdvo_sdtv_resolution_request tv_res;
1854 1855
	uint32_t reply = 0, format_map = 0;
	int i;
1856 1857 1858 1859

	/* Read the list of supported input resolutions for the selected TV
	 * format.
	 */
1860
	format_map = 1 << intel_sdvo->tv_format_index;
1861
	memcpy(&tv_res, &format_map,
1862
	       min(sizeof(format_map), sizeof(struct intel_sdvo_sdtv_resolution_request)));
1863

1864 1865
	if (!intel_sdvo_set_target_output(intel_sdvo, intel_sdvo->attached_output))
		return;
1866

1867
	BUILD_BUG_ON(sizeof(tv_res) != 3);
C
Chris Wilson 已提交
1868 1869
	if (!intel_sdvo_write_cmd(intel_sdvo,
				  SDVO_CMD_GET_SDTV_RESOLUTION_SUPPORT,
1870 1871 1872
				  &tv_res, sizeof(tv_res)))
		return;
	if (!intel_sdvo_read_response(intel_sdvo, &reply, 3))
1873 1874 1875
		return;

	for (i = 0; i < ARRAY_SIZE(sdvo_tv_modes); i++)
Z
Zhenyu Wang 已提交
1876 1877 1878
		if (reply & (1 << i)) {
			struct drm_display_mode *nmode;
			nmode = drm_mode_duplicate(connector->dev,
1879
						   &sdvo_tv_modes[i]);
Z
Zhenyu Wang 已提交
1880 1881 1882
			if (nmode)
				drm_mode_probed_add(connector, nmode);
		}
1883 1884
}

1885 1886
static void intel_sdvo_get_lvds_modes(struct drm_connector *connector)
{
1887
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
1888
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
1889
	struct drm_display_mode *newmode;
1890 1891

	/*
1892
	 * Fetch modes from VBT. For SDVO prefer the VBT mode since some
1893
	 * SDVO->LVDS transcoders can't cope with the EDID mode.
1894
	 */
1895
	if (dev_priv->vbt.sdvo_lvds_vbt_mode != NULL) {
1896
		newmode = drm_mode_duplicate(connector->dev,
1897
					     dev_priv->vbt.sdvo_lvds_vbt_mode);
1898 1899 1900 1901 1902 1903 1904
		if (newmode != NULL) {
			/* Guarantee the mode is preferred */
			newmode->type = (DRM_MODE_TYPE_PREFERRED |
					 DRM_MODE_TYPE_DRIVER);
			drm_mode_probed_add(connector, newmode);
		}
	}
1905

1906 1907 1908 1909 1910 1911 1912
	/*
	 * Attempt to get the mode list from DDC.
	 * Assume that the preferred modes are
	 * arranged in priority order.
	 */
	intel_ddc_get_modes(connector, &intel_sdvo->ddc);

1913 1914
	list_for_each_entry(newmode, &connector->probed_modes, head) {
		if (newmode->type & DRM_MODE_TYPE_PREFERRED) {
C
Chris Wilson 已提交
1915
			intel_sdvo->sdvo_lvds_fixed_mode =
1916
				drm_mode_duplicate(connector->dev, newmode);
1917

1918
			intel_sdvo->is_lvds = true;
1919 1920 1921 1922
			break;
		}
	}

1923 1924
}

1925 1926
static int intel_sdvo_get_modes(struct drm_connector *connector)
{
1927
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1928

1929
	if (IS_TV(intel_sdvo_connector))
1930
		intel_sdvo_get_tv_modes(connector);
1931
	else if (IS_LVDS(intel_sdvo_connector))
1932
		intel_sdvo_get_lvds_modes(connector);
1933 1934 1935
	else
		intel_sdvo_get_ddc_modes(connector);

1936
	return !list_empty(&connector->probed_modes);
J
Jesse Barnes 已提交
1937 1938
}

1939 1940
static void
intel_sdvo_destroy_enhance_property(struct drm_connector *connector)
1941
{
1942
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1943 1944
	struct drm_device *dev = connector->dev;

1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974
	if (intel_sdvo_connector->left)
		drm_property_destroy(dev, intel_sdvo_connector->left);
	if (intel_sdvo_connector->right)
		drm_property_destroy(dev, intel_sdvo_connector->right);
	if (intel_sdvo_connector->top)
		drm_property_destroy(dev, intel_sdvo_connector->top);
	if (intel_sdvo_connector->bottom)
		drm_property_destroy(dev, intel_sdvo_connector->bottom);
	if (intel_sdvo_connector->hpos)
		drm_property_destroy(dev, intel_sdvo_connector->hpos);
	if (intel_sdvo_connector->vpos)
		drm_property_destroy(dev, intel_sdvo_connector->vpos);
	if (intel_sdvo_connector->saturation)
		drm_property_destroy(dev, intel_sdvo_connector->saturation);
	if (intel_sdvo_connector->contrast)
		drm_property_destroy(dev, intel_sdvo_connector->contrast);
	if (intel_sdvo_connector->hue)
		drm_property_destroy(dev, intel_sdvo_connector->hue);
	if (intel_sdvo_connector->sharpness)
		drm_property_destroy(dev, intel_sdvo_connector->sharpness);
	if (intel_sdvo_connector->flicker_filter)
		drm_property_destroy(dev, intel_sdvo_connector->flicker_filter);
	if (intel_sdvo_connector->flicker_filter_2d)
		drm_property_destroy(dev, intel_sdvo_connector->flicker_filter_2d);
	if (intel_sdvo_connector->flicker_filter_adaptive)
		drm_property_destroy(dev, intel_sdvo_connector->flicker_filter_adaptive);
	if (intel_sdvo_connector->tv_luma_filter)
		drm_property_destroy(dev, intel_sdvo_connector->tv_luma_filter);
	if (intel_sdvo_connector->tv_chroma_filter)
		drm_property_destroy(dev, intel_sdvo_connector->tv_chroma_filter);
1975 1976
	if (intel_sdvo_connector->dot_crawl)
		drm_property_destroy(dev, intel_sdvo_connector->dot_crawl);
1977 1978
	if (intel_sdvo_connector->brightness)
		drm_property_destroy(dev, intel_sdvo_connector->brightness);
1979 1980
}

J
Jesse Barnes 已提交
1981 1982
static void intel_sdvo_destroy(struct drm_connector *connector)
{
1983
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
J
Jesse Barnes 已提交
1984

1985
	if (intel_sdvo_connector->tv_format)
1986
		drm_property_destroy(connector->dev,
1987
				     intel_sdvo_connector->tv_format);
1988

1989
	intel_sdvo_destroy_enhance_property(connector);
J
Jesse Barnes 已提交
1990 1991
	drm_sysfs_connector_remove(connector);
	drm_connector_cleanup(connector);
1992
	kfree(intel_sdvo_connector);
J
Jesse Barnes 已提交
1993 1994
}

1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006
static bool intel_sdvo_detect_hdmi_audio(struct drm_connector *connector)
{
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
	struct edid *edid;
	bool has_audio = false;

	if (!intel_sdvo->is_hdmi)
		return false;

	edid = intel_sdvo_get_edid(connector);
	if (edid != NULL && edid->input & DRM_EDID_INPUT_DIGITAL)
		has_audio = drm_detect_monitor_audio(edid);
2007
	kfree(edid);
2008 2009 2010 2011

	return has_audio;
}

2012 2013 2014 2015 2016
static int
intel_sdvo_set_property(struct drm_connector *connector,
			struct drm_property *property,
			uint64_t val)
{
2017
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
2018
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
2019
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
2020
	uint16_t temp_value;
2021 2022
	uint8_t cmd;
	int ret;
2023

2024
	ret = drm_object_property_set_value(&connector->base, property, val);
2025 2026
	if (ret)
		return ret;
2027

2028
	if (property == dev_priv->force_audio_property) {
2029 2030 2031 2032
		int i = val;
		bool has_audio;

		if (i == intel_sdvo_connector->force_audio)
2033 2034
			return 0;

2035
		intel_sdvo_connector->force_audio = i;
2036

2037
		if (i == HDMI_AUDIO_AUTO)
2038 2039
			has_audio = intel_sdvo_detect_hdmi_audio(connector);
		else
2040
			has_audio = (i == HDMI_AUDIO_ON);
2041

2042
		if (has_audio == intel_sdvo->has_hdmi_audio)
2043 2044
			return 0;

2045
		intel_sdvo->has_hdmi_audio = has_audio;
2046 2047 2048
		goto done;
	}

2049
	if (property == dev_priv->broadcast_rgb_property) {
2050 2051 2052
		bool old_auto = intel_sdvo->color_range_auto;
		uint32_t old_range = intel_sdvo->color_range;

2053 2054 2055 2056 2057 2058 2059 2060 2061 2062
		switch (val) {
		case INTEL_BROADCAST_RGB_AUTO:
			intel_sdvo->color_range_auto = true;
			break;
		case INTEL_BROADCAST_RGB_FULL:
			intel_sdvo->color_range_auto = false;
			intel_sdvo->color_range = 0;
			break;
		case INTEL_BROADCAST_RGB_LIMITED:
			intel_sdvo->color_range_auto = false;
2063 2064 2065
			/* FIXME: this bit is only valid when using TMDS
			 * encoding and 8 bit per color mode. */
			intel_sdvo->color_range = HDMI_COLOR_RANGE_16_235;
2066 2067 2068 2069
			break;
		default:
			return -EINVAL;
		}
2070 2071 2072 2073 2074

		if (old_auto == intel_sdvo->color_range_auto &&
		    old_range == intel_sdvo->color_range)
			return 0;

2075 2076 2077
		goto done;
	}

2078 2079 2080 2081 2082 2083 2084 2085 2086 2087
#define CHECK_PROPERTY(name, NAME) \
	if (intel_sdvo_connector->name == property) { \
		if (intel_sdvo_connector->cur_##name == temp_value) return 0; \
		if (intel_sdvo_connector->max_##name < temp_value) return -EINVAL; \
		cmd = SDVO_CMD_SET_##NAME; \
		intel_sdvo_connector->cur_##name = temp_value; \
		goto set_value; \
	}

	if (property == intel_sdvo_connector->tv_format) {
2088 2089 2090
		if (val >= TV_FORMAT_NUM)
			return -EINVAL;

2091
		if (intel_sdvo->tv_format_index ==
2092
		    intel_sdvo_connector->tv_format_supported[val])
2093
			return 0;
2094

2095
		intel_sdvo->tv_format_index = intel_sdvo_connector->tv_format_supported[val];
2096
		goto done;
2097
	} else if (IS_TV_OR_LVDS(intel_sdvo_connector)) {
2098
		temp_value = val;
2099
		if (intel_sdvo_connector->left == property) {
2100
			drm_object_property_set_value(&connector->base,
2101
							 intel_sdvo_connector->right, val);
2102
			if (intel_sdvo_connector->left_margin == temp_value)
2103
				return 0;
2104

2105 2106 2107
			intel_sdvo_connector->left_margin = temp_value;
			intel_sdvo_connector->right_margin = temp_value;
			temp_value = intel_sdvo_connector->max_hscan -
2108
				intel_sdvo_connector->left_margin;
2109
			cmd = SDVO_CMD_SET_OVERSCAN_H;
2110 2111
			goto set_value;
		} else if (intel_sdvo_connector->right == property) {
2112
			drm_object_property_set_value(&connector->base,
2113
							 intel_sdvo_connector->left, val);
2114
			if (intel_sdvo_connector->right_margin == temp_value)
2115
				return 0;
2116

2117 2118 2119 2120
			intel_sdvo_connector->left_margin = temp_value;
			intel_sdvo_connector->right_margin = temp_value;
			temp_value = intel_sdvo_connector->max_hscan -
				intel_sdvo_connector->left_margin;
2121
			cmd = SDVO_CMD_SET_OVERSCAN_H;
2122 2123
			goto set_value;
		} else if (intel_sdvo_connector->top == property) {
2124
			drm_object_property_set_value(&connector->base,
2125
							 intel_sdvo_connector->bottom, val);
2126
			if (intel_sdvo_connector->top_margin == temp_value)
2127
				return 0;
2128

2129 2130 2131
			intel_sdvo_connector->top_margin = temp_value;
			intel_sdvo_connector->bottom_margin = temp_value;
			temp_value = intel_sdvo_connector->max_vscan -
2132
				intel_sdvo_connector->top_margin;
2133
			cmd = SDVO_CMD_SET_OVERSCAN_V;
2134 2135
			goto set_value;
		} else if (intel_sdvo_connector->bottom == property) {
2136
			drm_object_property_set_value(&connector->base,
2137
							 intel_sdvo_connector->top, val);
2138
			if (intel_sdvo_connector->bottom_margin == temp_value)
2139 2140
				return 0;

2141 2142 2143
			intel_sdvo_connector->top_margin = temp_value;
			intel_sdvo_connector->bottom_margin = temp_value;
			temp_value = intel_sdvo_connector->max_vscan -
2144
				intel_sdvo_connector->top_margin;
2145
			cmd = SDVO_CMD_SET_OVERSCAN_V;
2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159
			goto set_value;
		}
		CHECK_PROPERTY(hpos, HPOS)
		CHECK_PROPERTY(vpos, VPOS)
		CHECK_PROPERTY(saturation, SATURATION)
		CHECK_PROPERTY(contrast, CONTRAST)
		CHECK_PROPERTY(hue, HUE)
		CHECK_PROPERTY(brightness, BRIGHTNESS)
		CHECK_PROPERTY(sharpness, SHARPNESS)
		CHECK_PROPERTY(flicker_filter, FLICKER_FILTER)
		CHECK_PROPERTY(flicker_filter_2d, FLICKER_FILTER_2D)
		CHECK_PROPERTY(flicker_filter_adaptive, FLICKER_FILTER_ADAPTIVE)
		CHECK_PROPERTY(tv_chroma_filter, TV_CHROMA_FILTER)
		CHECK_PROPERTY(tv_luma_filter, TV_LUMA_FILTER)
2160
		CHECK_PROPERTY(dot_crawl, DOT_CRAWL)
2161
	}
2162

2163
	return -EINVAL; /* unknown property */
2164

2165 2166 2167
set_value:
	if (!intel_sdvo_set_value(intel_sdvo, cmd, &temp_value, 2))
		return -EIO;
2168 2169


2170
done:
2171 2172
	if (intel_sdvo->base.base.crtc)
		intel_crtc_restore_mode(intel_sdvo->base.base.crtc);
2173

2174
	return 0;
2175
#undef CHECK_PROPERTY
2176 2177
}

J
Jesse Barnes 已提交
2178
static const struct drm_connector_funcs intel_sdvo_connector_funcs = {
2179
	.dpms = intel_sdvo_dpms,
J
Jesse Barnes 已提交
2180 2181
	.detect = intel_sdvo_detect,
	.fill_modes = drm_helper_probe_single_connector_modes,
2182
	.set_property = intel_sdvo_set_property,
J
Jesse Barnes 已提交
2183 2184 2185 2186 2187 2188
	.destroy = intel_sdvo_destroy,
};

static const struct drm_connector_helper_funcs intel_sdvo_connector_helper_funcs = {
	.get_modes = intel_sdvo_get_modes,
	.mode_valid = intel_sdvo_mode_valid,
2189
	.best_encoder = intel_best_encoder,
J
Jesse Barnes 已提交
2190 2191
};

2192
static void intel_sdvo_enc_destroy(struct drm_encoder *encoder)
J
Jesse Barnes 已提交
2193
{
2194
	struct intel_sdvo *intel_sdvo = to_sdvo(to_intel_encoder(encoder));
2195

C
Chris Wilson 已提交
2196
	if (intel_sdvo->sdvo_lvds_fixed_mode != NULL)
2197
		drm_mode_destroy(encoder->dev,
C
Chris Wilson 已提交
2198
				 intel_sdvo->sdvo_lvds_fixed_mode);
2199

C
Chris Wilson 已提交
2200
	i2c_del_adapter(&intel_sdvo->ddc);
C
Chris Wilson 已提交
2201
	intel_encoder_destroy(encoder);
J
Jesse Barnes 已提交
2202 2203 2204 2205 2206 2207
}

static const struct drm_encoder_funcs intel_sdvo_enc_funcs = {
	.destroy = intel_sdvo_enc_destroy,
};

2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242
static void
intel_sdvo_guess_ddc_bus(struct intel_sdvo *sdvo)
{
	uint16_t mask = 0;
	unsigned int num_bits;

	/* Make a mask of outputs less than or equal to our own priority in the
	 * list.
	 */
	switch (sdvo->controlled_output) {
	case SDVO_OUTPUT_LVDS1:
		mask |= SDVO_OUTPUT_LVDS1;
	case SDVO_OUTPUT_LVDS0:
		mask |= SDVO_OUTPUT_LVDS0;
	case SDVO_OUTPUT_TMDS1:
		mask |= SDVO_OUTPUT_TMDS1;
	case SDVO_OUTPUT_TMDS0:
		mask |= SDVO_OUTPUT_TMDS0;
	case SDVO_OUTPUT_RGB1:
		mask |= SDVO_OUTPUT_RGB1;
	case SDVO_OUTPUT_RGB0:
		mask |= SDVO_OUTPUT_RGB0;
		break;
	}

	/* Count bits to find what number we are in the priority list. */
	mask &= sdvo->caps.output_flags;
	num_bits = hweight16(mask);
	/* If more than 3 outputs, default to DDC bus 3 for now. */
	if (num_bits > 3)
		num_bits = 3;

	/* Corresponds to SDVO_CONTROL_BUS_DDCx */
	sdvo->ddc_bus = 1 << num_bits;
}
J
Jesse Barnes 已提交
2243

2244 2245 2246 2247 2248 2249 2250 2251
/**
 * Choose the appropriate DDC bus for control bus switch command for this
 * SDVO output based on the controlled output.
 *
 * DDC bus number assignment is in a priority order of RGB outputs, then TMDS
 * outputs, then LVDS outputs.
 */
static void
2252
intel_sdvo_select_ddc_bus(struct drm_i915_private *dev_priv,
C
Chris Wilson 已提交
2253
			  struct intel_sdvo *sdvo, u32 reg)
2254
{
2255
	struct sdvo_device_mapping *mapping;
2256

2257
	if (sdvo->is_sdvob)
2258 2259 2260
		mapping = &(dev_priv->sdvo_mappings[0]);
	else
		mapping = &(dev_priv->sdvo_mappings[1]);
2261

2262 2263 2264 2265
	if (mapping->initialized)
		sdvo->ddc_bus = 1 << ((mapping->ddc_pin & 0xf0) >> 4);
	else
		intel_sdvo_guess_ddc_bus(sdvo);
2266 2267
}

C
Chris Wilson 已提交
2268 2269 2270 2271 2272
static void
intel_sdvo_select_i2c_bus(struct drm_i915_private *dev_priv,
			  struct intel_sdvo *sdvo, u32 reg)
{
	struct sdvo_device_mapping *mapping;
2273
	u8 pin;
C
Chris Wilson 已提交
2274

2275
	if (sdvo->is_sdvob)
C
Chris Wilson 已提交
2276 2277 2278 2279
		mapping = &dev_priv->sdvo_mappings[0];
	else
		mapping = &dev_priv->sdvo_mappings[1];

2280
	if (mapping->initialized && intel_gmbus_is_port_valid(mapping->i2c_pin))
C
Chris Wilson 已提交
2281
		pin = mapping->i2c_pin;
2282 2283
	else
		pin = GMBUS_PORT_DPB;
C
Chris Wilson 已提交
2284

2285 2286 2287 2288 2289 2290
	sdvo->i2c = intel_gmbus_get_adapter(dev_priv, pin);

	/* With gmbus we should be able to drive sdvo i2c at 2MHz, but somehow
	 * our code totally fails once we start using gmbus. Hence fall back to
	 * bit banging for now. */
	intel_gmbus_force_bit(sdvo->i2c, true);
C
Chris Wilson 已提交
2291 2292
}

2293 2294 2295 2296 2297
/* undo any changes intel_sdvo_select_i2c_bus() did to sdvo->i2c */
static void
intel_sdvo_unselect_i2c_bus(struct intel_sdvo *sdvo)
{
	intel_gmbus_force_bit(sdvo->i2c, false);
C
Chris Wilson 已提交
2298 2299
}

2300
static bool
2301
intel_sdvo_is_hdmi_connector(struct intel_sdvo *intel_sdvo, int device)
2302
{
2303
	return intel_sdvo_check_supp_encode(intel_sdvo);
2304 2305
}

2306
static u8
2307
intel_sdvo_get_slave_addr(struct drm_device *dev, struct intel_sdvo *sdvo)
2308 2309 2310 2311
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct sdvo_device_mapping *my_mapping, *other_mapping;

2312
	if (sdvo->is_sdvob) {
2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336
		my_mapping = &dev_priv->sdvo_mappings[0];
		other_mapping = &dev_priv->sdvo_mappings[1];
	} else {
		my_mapping = &dev_priv->sdvo_mappings[1];
		other_mapping = &dev_priv->sdvo_mappings[0];
	}

	/* If the BIOS described our SDVO device, take advantage of it. */
	if (my_mapping->slave_addr)
		return my_mapping->slave_addr;

	/* If the BIOS only described a different SDVO device, use the
	 * address that it isn't using.
	 */
	if (other_mapping->slave_addr) {
		if (other_mapping->slave_addr == 0x70)
			return 0x72;
		else
			return 0x70;
	}

	/* No SDVO device info is found for another DVO port,
	 * so use mapping assumption we had before BIOS parsing.
	 */
2337
	if (sdvo->is_sdvob)
2338 2339 2340 2341 2342
		return 0x70;
	else
		return 0x72;
}

2343
static void
2344 2345
intel_sdvo_connector_init(struct intel_sdvo_connector *connector,
			  struct intel_sdvo *encoder)
2346
{
2347 2348 2349 2350
	drm_connector_init(encoder->base.base.dev,
			   &connector->base.base,
			   &intel_sdvo_connector_funcs,
			   connector->base.base.connector_type);
2351

2352 2353
	drm_connector_helper_add(&connector->base.base,
				 &intel_sdvo_connector_helper_funcs);
2354

2355
	connector->base.base.interlace_allowed = 1;
2356 2357
	connector->base.base.doublescan_allowed = 0;
	connector->base.base.display_info.subpixel_order = SubPixelHorizontalRGB;
2358
	connector->base.get_hw_state = intel_sdvo_connector_get_hw_state;
2359

2360 2361
	intel_connector_attach_encoder(&connector->base, &encoder->base);
	drm_sysfs_connector_add(&connector->base.base);
2362
}
2363

2364
static void
2365 2366
intel_sdvo_add_hdmi_properties(struct intel_sdvo *intel_sdvo,
			       struct intel_sdvo_connector *connector)
2367 2368 2369
{
	struct drm_device *dev = connector->base.base.dev;

2370
	intel_attach_force_audio_property(&connector->base.base);
2371
	if (INTEL_INFO(dev)->gen >= 4 && IS_MOBILE(dev)) {
2372
		intel_attach_broadcast_rgb_property(&connector->base.base);
2373 2374
		intel_sdvo->color_range_auto = true;
	}
2375 2376
}

2377
static bool
C
Chris Wilson 已提交
2378
intel_sdvo_dvi_init(struct intel_sdvo *intel_sdvo, int device)
2379
{
2380
	struct drm_encoder *encoder = &intel_sdvo->base.base;
2381
	struct drm_connector *connector;
2382
	struct intel_encoder *intel_encoder = to_intel_encoder(encoder);
2383
	struct intel_connector *intel_connector;
2384
	struct intel_sdvo_connector *intel_sdvo_connector;
2385

2386 2387
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
2388 2389 2390
		return false;

	if (device == 0) {
C
Chris Wilson 已提交
2391
		intel_sdvo->controlled_output |= SDVO_OUTPUT_TMDS0;
2392
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_TMDS0;
2393
	} else if (device == 1) {
C
Chris Wilson 已提交
2394
		intel_sdvo->controlled_output |= SDVO_OUTPUT_TMDS1;
2395
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_TMDS1;
2396 2397
	}

2398
	intel_connector = &intel_sdvo_connector->base;
2399
	connector = &intel_connector->base;
2400 2401 2402
	if (intel_sdvo_get_hotplug_support(intel_sdvo) &
		intel_sdvo_connector->output_flag) {
		intel_sdvo->hotplug_active |= intel_sdvo_connector->output_flag;
2403 2404 2405 2406 2407
		/* Some SDVO devices have one-shot hotplug interrupts.
		 * Ensure that they get re-enabled when an interrupt happens.
		 */
		intel_encoder->hot_plug = intel_sdvo_enable_hotplug;
		intel_sdvo_enable_hotplug(intel_encoder);
2408
	} else {
2409
		intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT;
2410
	}
2411 2412 2413
	encoder->encoder_type = DRM_MODE_ENCODER_TMDS;
	connector->connector_type = DRM_MODE_CONNECTOR_DVID;

2414
	if (intel_sdvo_is_hdmi_connector(intel_sdvo, device)) {
2415
		connector->connector_type = DRM_MODE_CONNECTOR_HDMIA;
2416
		intel_sdvo->is_hdmi = true;
2417 2418
	}

2419
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2420
	if (intel_sdvo->is_hdmi)
2421
		intel_sdvo_add_hdmi_properties(intel_sdvo, intel_sdvo_connector);
2422 2423 2424 2425 2426

	return true;
}

static bool
C
Chris Wilson 已提交
2427
intel_sdvo_tv_init(struct intel_sdvo *intel_sdvo, int type)
2428
{
2429 2430 2431 2432
	struct drm_encoder *encoder = &intel_sdvo->base.base;
	struct drm_connector *connector;
	struct intel_connector *intel_connector;
	struct intel_sdvo_connector *intel_sdvo_connector;
2433

2434 2435 2436
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
		return false;
2437

2438
	intel_connector = &intel_sdvo_connector->base;
2439 2440 2441
	connector = &intel_connector->base;
	encoder->encoder_type = DRM_MODE_ENCODER_TVDAC;
	connector->connector_type = DRM_MODE_CONNECTOR_SVIDEO;
2442

2443 2444
	intel_sdvo->controlled_output |= type;
	intel_sdvo_connector->output_flag = type;
2445

2446
	intel_sdvo->is_tv = true;
2447

2448
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2449

2450
	if (!intel_sdvo_tv_create_property(intel_sdvo, intel_sdvo_connector, type))
2451
		goto err;
2452

2453
	if (!intel_sdvo_create_enhance_property(intel_sdvo, intel_sdvo_connector))
2454
		goto err;
2455

2456
	return true;
2457 2458

err:
2459
	intel_sdvo_destroy(connector);
2460
	return false;
2461 2462 2463
}

static bool
C
Chris Wilson 已提交
2464
intel_sdvo_analog_init(struct intel_sdvo *intel_sdvo, int device)
2465
{
2466 2467 2468 2469
	struct drm_encoder *encoder = &intel_sdvo->base.base;
	struct drm_connector *connector;
	struct intel_connector *intel_connector;
	struct intel_sdvo_connector *intel_sdvo_connector;
2470

2471 2472 2473
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
		return false;
2474

2475
	intel_connector = &intel_sdvo_connector->base;
2476
	connector = &intel_connector->base;
2477
	intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT;
2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488
	encoder->encoder_type = DRM_MODE_ENCODER_DAC;
	connector->connector_type = DRM_MODE_CONNECTOR_VGA;

	if (device == 0) {
		intel_sdvo->controlled_output |= SDVO_OUTPUT_RGB0;
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_RGB0;
	} else if (device == 1) {
		intel_sdvo->controlled_output |= SDVO_OUTPUT_RGB1;
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_RGB1;
	}

2489 2490
	intel_sdvo_connector_init(intel_sdvo_connector,
				  intel_sdvo);
2491
	return true;
2492 2493 2494
}

static bool
C
Chris Wilson 已提交
2495
intel_sdvo_lvds_init(struct intel_sdvo *intel_sdvo, int device)
2496
{
2497 2498 2499 2500
	struct drm_encoder *encoder = &intel_sdvo->base.base;
	struct drm_connector *connector;
	struct intel_connector *intel_connector;
	struct intel_sdvo_connector *intel_sdvo_connector;
2501

2502 2503 2504
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
		return false;
2505

2506 2507
	intel_connector = &intel_sdvo_connector->base;
	connector = &intel_connector->base;
2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518
	encoder->encoder_type = DRM_MODE_ENCODER_LVDS;
	connector->connector_type = DRM_MODE_CONNECTOR_LVDS;

	if (device == 0) {
		intel_sdvo->controlled_output |= SDVO_OUTPUT_LVDS0;
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_LVDS0;
	} else if (device == 1) {
		intel_sdvo->controlled_output |= SDVO_OUTPUT_LVDS1;
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_LVDS1;
	}

2519
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2520
	if (!intel_sdvo_create_enhance_property(intel_sdvo, intel_sdvo_connector))
2521 2522 2523 2524 2525
		goto err;

	return true;

err:
2526
	intel_sdvo_destroy(connector);
2527
	return false;
2528 2529 2530
}

static bool
C
Chris Wilson 已提交
2531
intel_sdvo_output_setup(struct intel_sdvo *intel_sdvo, uint16_t flags)
2532
{
C
Chris Wilson 已提交
2533 2534
	intel_sdvo->is_tv = false;
	intel_sdvo->is_lvds = false;
2535

2536
	/* SDVO requires XXX1 function may not exist unless it has XXX0 function.*/
2537

2538
	if (flags & SDVO_OUTPUT_TMDS0)
C
Chris Wilson 已提交
2539
		if (!intel_sdvo_dvi_init(intel_sdvo, 0))
2540 2541 2542
			return false;

	if ((flags & SDVO_TMDS_MASK) == SDVO_TMDS_MASK)
C
Chris Wilson 已提交
2543
		if (!intel_sdvo_dvi_init(intel_sdvo, 1))
2544 2545 2546
			return false;

	/* TV has no XXX1 function block */
2547
	if (flags & SDVO_OUTPUT_SVID0)
C
Chris Wilson 已提交
2548
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_SVID0))
2549 2550 2551
			return false;

	if (flags & SDVO_OUTPUT_CVBS0)
C
Chris Wilson 已提交
2552
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_CVBS0))
2553
			return false;
2554

2555 2556 2557 2558
	if (flags & SDVO_OUTPUT_YPRPB0)
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_YPRPB0))
			return false;

2559
	if (flags & SDVO_OUTPUT_RGB0)
C
Chris Wilson 已提交
2560
		if (!intel_sdvo_analog_init(intel_sdvo, 0))
2561 2562 2563
			return false;

	if ((flags & SDVO_RGB_MASK) == SDVO_RGB_MASK)
C
Chris Wilson 已提交
2564
		if (!intel_sdvo_analog_init(intel_sdvo, 1))
2565 2566 2567
			return false;

	if (flags & SDVO_OUTPUT_LVDS0)
C
Chris Wilson 已提交
2568
		if (!intel_sdvo_lvds_init(intel_sdvo, 0))
2569 2570 2571
			return false;

	if ((flags & SDVO_LVDS_MASK) == SDVO_LVDS_MASK)
C
Chris Wilson 已提交
2572
		if (!intel_sdvo_lvds_init(intel_sdvo, 1))
2573
			return false;
2574

2575
	if ((flags & SDVO_OUTPUT_MASK) == 0) {
2576 2577
		unsigned char bytes[2];

C
Chris Wilson 已提交
2578 2579
		intel_sdvo->controlled_output = 0;
		memcpy(bytes, &intel_sdvo->caps.output_flags, 2);
D
Dave Airlie 已提交
2580
		DRM_DEBUG_KMS("%s: Unknown SDVO output type (0x%02x%02x)\n",
C
Chris Wilson 已提交
2581
			      SDVO_NAME(intel_sdvo),
D
Dave Airlie 已提交
2582
			      bytes[0], bytes[1]);
2583
		return false;
2584
	}
J
Jesse Barnes 已提交
2585
	intel_sdvo->base.crtc_mask = (1 << 0) | (1 << 1) | (1 << 2);
2586

2587
	return true;
2588 2589
}

2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601
static void intel_sdvo_output_cleanup(struct intel_sdvo *intel_sdvo)
{
	struct drm_device *dev = intel_sdvo->base.base.dev;
	struct drm_connector *connector, *tmp;

	list_for_each_entry_safe(connector, tmp,
				 &dev->mode_config.connector_list, head) {
		if (intel_attached_encoder(connector) == &intel_sdvo->base)
			intel_sdvo_destroy(connector);
	}
}

2602 2603 2604
static bool intel_sdvo_tv_create_property(struct intel_sdvo *intel_sdvo,
					  struct intel_sdvo_connector *intel_sdvo_connector,
					  int type)
2605
{
2606
	struct drm_device *dev = intel_sdvo->base.base.dev;
2607 2608 2609
	struct intel_sdvo_tv_format format;
	uint32_t format_map, i;

2610 2611
	if (!intel_sdvo_set_target_output(intel_sdvo, type))
		return false;
2612

2613
	BUILD_BUG_ON(sizeof(format) != 6);
2614 2615 2616 2617
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_SUPPORTED_TV_FORMATS,
				  &format, sizeof(format)))
		return false;
2618

2619
	memcpy(&format_map, &format, min(sizeof(format_map), sizeof(format)));
2620 2621

	if (format_map == 0)
2622
		return false;
2623

2624
	intel_sdvo_connector->format_supported_num = 0;
2625
	for (i = 0 ; i < TV_FORMAT_NUM; i++)
2626 2627
		if (format_map & (1 << i))
			intel_sdvo_connector->tv_format_supported[intel_sdvo_connector->format_supported_num++] = i;
2628 2629


2630
	intel_sdvo_connector->tv_format =
2631 2632
			drm_property_create(dev, DRM_MODE_PROP_ENUM,
					    "mode", intel_sdvo_connector->format_supported_num);
2633
	if (!intel_sdvo_connector->tv_format)
2634
		return false;
2635

2636
	for (i = 0; i < intel_sdvo_connector->format_supported_num; i++)
2637
		drm_property_add_enum(
2638
				intel_sdvo_connector->tv_format, i,
2639
				i, tv_format_names[intel_sdvo_connector->tv_format_supported[i]]);
2640

2641
	intel_sdvo->tv_format_index = intel_sdvo_connector->tv_format_supported[0];
2642
	drm_object_attach_property(&intel_sdvo_connector->base.base.base,
2643
				      intel_sdvo_connector->tv_format, 0);
2644
	return true;
2645 2646 2647

}

2648 2649 2650 2651 2652 2653 2654 2655
#define ENHANCEMENT(name, NAME) do { \
	if (enhancements.name) { \
		if (!intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_MAX_##NAME, &data_value, 4) || \
		    !intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_##NAME, &response, 2)) \
			return false; \
		intel_sdvo_connector->max_##name = data_value[0]; \
		intel_sdvo_connector->cur_##name = response; \
		intel_sdvo_connector->name = \
2656
			drm_property_create_range(dev, 0, #name, 0, data_value[0]); \
2657
		if (!intel_sdvo_connector->name) return false; \
2658
		drm_object_attach_property(&connector->base, \
2659 2660 2661 2662 2663
					      intel_sdvo_connector->name, \
					      intel_sdvo_connector->cur_##name); \
		DRM_DEBUG_KMS(#name ": max %d, default %d, current %d\n", \
			      data_value[0], data_value[1], response); \
	} \
2664
} while (0)
2665 2666 2667 2668 2669

static bool
intel_sdvo_create_enhance_property_tv(struct intel_sdvo *intel_sdvo,
				      struct intel_sdvo_connector *intel_sdvo_connector,
				      struct intel_sdvo_enhancements_reply enhancements)
2670
{
2671
	struct drm_device *dev = intel_sdvo->base.base.dev;
2672
	struct drm_connector *connector = &intel_sdvo_connector->base.base;
2673 2674
	uint16_t response, data_value[2];

2675 2676 2677 2678 2679 2680
	/* when horizontal overscan is supported, Add the left/right  property */
	if (enhancements.overscan_h) {
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_MAX_OVERSCAN_H,
					  &data_value, 4))
			return false;
2681

2682 2683 2684 2685
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_OVERSCAN_H,
					  &response, 2))
			return false;
2686

2687 2688 2689 2690
		intel_sdvo_connector->max_hscan = data_value[0];
		intel_sdvo_connector->left_margin = data_value[0] - response;
		intel_sdvo_connector->right_margin = intel_sdvo_connector->left_margin;
		intel_sdvo_connector->left =
2691
			drm_property_create_range(dev, 0, "left_margin", 0, data_value[0]);
2692 2693
		if (!intel_sdvo_connector->left)
			return false;
2694

2695
		drm_object_attach_property(&connector->base,
2696 2697
					      intel_sdvo_connector->left,
					      intel_sdvo_connector->left_margin);
2698

2699
		intel_sdvo_connector->right =
2700
			drm_property_create_range(dev, 0, "right_margin", 0, data_value[0]);
2701 2702
		if (!intel_sdvo_connector->right)
			return false;
2703

2704
		drm_object_attach_property(&connector->base,
2705 2706 2707 2708 2709 2710
					      intel_sdvo_connector->right,
					      intel_sdvo_connector->right_margin);
		DRM_DEBUG_KMS("h_overscan: max %d, "
			      "default %d, current %d\n",
			      data_value[0], data_value[1], response);
	}
2711

2712 2713 2714 2715 2716
	if (enhancements.overscan_v) {
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_MAX_OVERSCAN_V,
					  &data_value, 4))
			return false;
2717

2718 2719 2720 2721
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_OVERSCAN_V,
					  &response, 2))
			return false;
2722

2723 2724 2725 2726
		intel_sdvo_connector->max_vscan = data_value[0];
		intel_sdvo_connector->top_margin = data_value[0] - response;
		intel_sdvo_connector->bottom_margin = intel_sdvo_connector->top_margin;
		intel_sdvo_connector->top =
2727 2728
			drm_property_create_range(dev, 0,
					    "top_margin", 0, data_value[0]);
2729 2730
		if (!intel_sdvo_connector->top)
			return false;
2731

2732
		drm_object_attach_property(&connector->base,
2733 2734
					      intel_sdvo_connector->top,
					      intel_sdvo_connector->top_margin);
2735

2736
		intel_sdvo_connector->bottom =
2737 2738
			drm_property_create_range(dev, 0,
					    "bottom_margin", 0, data_value[0]);
2739 2740
		if (!intel_sdvo_connector->bottom)
			return false;
2741

2742
		drm_object_attach_property(&connector->base,
2743 2744 2745 2746 2747 2748
					      intel_sdvo_connector->bottom,
					      intel_sdvo_connector->bottom_margin);
		DRM_DEBUG_KMS("v_overscan: max %d, "
			      "default %d, current %d\n",
			      data_value[0], data_value[1], response);
	}
2749

2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761
	ENHANCEMENT(hpos, HPOS);
	ENHANCEMENT(vpos, VPOS);
	ENHANCEMENT(saturation, SATURATION);
	ENHANCEMENT(contrast, CONTRAST);
	ENHANCEMENT(hue, HUE);
	ENHANCEMENT(sharpness, SHARPNESS);
	ENHANCEMENT(brightness, BRIGHTNESS);
	ENHANCEMENT(flicker_filter, FLICKER_FILTER);
	ENHANCEMENT(flicker_filter_adaptive, FLICKER_FILTER_ADAPTIVE);
	ENHANCEMENT(flicker_filter_2d, FLICKER_FILTER_2D);
	ENHANCEMENT(tv_chroma_filter, TV_CHROMA_FILTER);
	ENHANCEMENT(tv_luma_filter, TV_LUMA_FILTER);
2762

2763 2764 2765 2766 2767 2768 2769
	if (enhancements.dot_crawl) {
		if (!intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_DOT_CRAWL, &response, 2))
			return false;

		intel_sdvo_connector->max_dot_crawl = 1;
		intel_sdvo_connector->cur_dot_crawl = response & 0x1;
		intel_sdvo_connector->dot_crawl =
2770
			drm_property_create_range(dev, 0, "dot_crawl", 0, 1);
2771 2772 2773
		if (!intel_sdvo_connector->dot_crawl)
			return false;

2774
		drm_object_attach_property(&connector->base,
2775 2776 2777 2778 2779
					      intel_sdvo_connector->dot_crawl,
					      intel_sdvo_connector->cur_dot_crawl);
		DRM_DEBUG_KMS("dot crawl: current %d\n", response);
	}

2780 2781
	return true;
}
2782

2783 2784 2785 2786 2787
static bool
intel_sdvo_create_enhance_property_lvds(struct intel_sdvo *intel_sdvo,
					struct intel_sdvo_connector *intel_sdvo_connector,
					struct intel_sdvo_enhancements_reply enhancements)
{
2788
	struct drm_device *dev = intel_sdvo->base.base.dev;
2789 2790
	struct drm_connector *connector = &intel_sdvo_connector->base.base;
	uint16_t response, data_value[2];
2791

2792
	ENHANCEMENT(brightness, BRIGHTNESS);
2793

2794 2795 2796
	return true;
}
#undef ENHANCEMENT
2797

2798 2799 2800 2801 2802 2803 2804
static bool intel_sdvo_create_enhance_property(struct intel_sdvo *intel_sdvo,
					       struct intel_sdvo_connector *intel_sdvo_connector)
{
	union {
		struct intel_sdvo_enhancements_reply reply;
		uint16_t response;
	} enhancements;
2805

2806 2807
	BUILD_BUG_ON(sizeof(enhancements) != 2);

2808 2809 2810 2811
	enhancements.response = 0;
	intel_sdvo_get_value(intel_sdvo,
			     SDVO_CMD_GET_SUPPORTED_ENHANCEMENTS,
			     &enhancements, sizeof(enhancements));
2812 2813 2814
	if (enhancements.response == 0) {
		DRM_DEBUG_KMS("No enhancement is supported\n");
		return true;
2815
	}
2816

2817 2818
	if (IS_TV(intel_sdvo_connector))
		return intel_sdvo_create_enhance_property_tv(intel_sdvo, intel_sdvo_connector, enhancements.reply);
2819
	else if (IS_LVDS(intel_sdvo_connector))
2820 2821 2822
		return intel_sdvo_create_enhance_property_lvds(intel_sdvo, intel_sdvo_connector, enhancements.reply);
	else
		return true;
C
Chris Wilson 已提交
2823 2824 2825 2826 2827 2828 2829
}

static int intel_sdvo_ddc_proxy_xfer(struct i2c_adapter *adapter,
				     struct i2c_msg *msgs,
				     int num)
{
	struct intel_sdvo *sdvo = adapter->algo_data;
2830

C
Chris Wilson 已提交
2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859
	if (!intel_sdvo_set_control_bus_switch(sdvo, sdvo->ddc_bus))
		return -EIO;

	return sdvo->i2c->algo->master_xfer(sdvo->i2c, msgs, num);
}

static u32 intel_sdvo_ddc_proxy_func(struct i2c_adapter *adapter)
{
	struct intel_sdvo *sdvo = adapter->algo_data;
	return sdvo->i2c->algo->functionality(sdvo->i2c);
}

static const struct i2c_algorithm intel_sdvo_ddc_proxy = {
	.master_xfer	= intel_sdvo_ddc_proxy_xfer,
	.functionality	= intel_sdvo_ddc_proxy_func
};

static bool
intel_sdvo_init_ddc_proxy(struct intel_sdvo *sdvo,
			  struct drm_device *dev)
{
	sdvo->ddc.owner = THIS_MODULE;
	sdvo->ddc.class = I2C_CLASS_DDC;
	snprintf(sdvo->ddc.name, I2C_NAME_SIZE, "SDVO DDC proxy");
	sdvo->ddc.dev.parent = &dev->pdev->dev;
	sdvo->ddc.algo_data = sdvo;
	sdvo->ddc.algo = &intel_sdvo_ddc_proxy;

	return i2c_add_adapter(&sdvo->ddc) == 0;
2860 2861
}

2862
bool intel_sdvo_init(struct drm_device *dev, uint32_t sdvo_reg, bool is_sdvob)
J
Jesse Barnes 已提交
2863
{
2864
	struct drm_i915_private *dev_priv = dev->dev_private;
2865
	struct intel_encoder *intel_encoder;
C
Chris Wilson 已提交
2866
	struct intel_sdvo *intel_sdvo;
J
Jesse Barnes 已提交
2867
	int i;
C
Chris Wilson 已提交
2868 2869
	intel_sdvo = kzalloc(sizeof(struct intel_sdvo), GFP_KERNEL);
	if (!intel_sdvo)
2870
		return false;
J
Jesse Barnes 已提交
2871

2872
	intel_sdvo->sdvo_reg = sdvo_reg;
2873 2874
	intel_sdvo->is_sdvob = is_sdvob;
	intel_sdvo->slave_addr = intel_sdvo_get_slave_addr(dev, intel_sdvo) >> 1;
2875
	intel_sdvo_select_i2c_bus(dev_priv, intel_sdvo, sdvo_reg);
2876 2877
	if (!intel_sdvo_init_ddc_proxy(intel_sdvo, dev))
		goto err_i2c_bus;
C
Chris Wilson 已提交
2878

2879
	/* encoder type will be decided later */
C
Chris Wilson 已提交
2880
	intel_encoder = &intel_sdvo->base;
2881
	intel_encoder->type = INTEL_OUTPUT_SDVO;
2882
	drm_encoder_init(dev, &intel_encoder->base, &intel_sdvo_enc_funcs, 0);
J
Jesse Barnes 已提交
2883 2884 2885

	/* Read the regs to test if we can talk to the device */
	for (i = 0; i < 0x40; i++) {
2886 2887 2888
		u8 byte;

		if (!intel_sdvo_read_byte(intel_sdvo, i, &byte)) {
2889 2890
			DRM_DEBUG_KMS("No SDVO device found on %s\n",
				      SDVO_NAME(intel_sdvo));
2891
			goto err;
J
Jesse Barnes 已提交
2892 2893 2894
		}
	}

2895
	intel_encoder->compute_config = intel_sdvo_compute_config;
2896
	intel_encoder->disable = intel_disable_sdvo;
2897
	intel_encoder->mode_set = intel_sdvo_mode_set;
2898
	intel_encoder->enable = intel_enable_sdvo;
2899
	intel_encoder->get_hw_state = intel_sdvo_get_hw_state;
2900
	intel_encoder->get_config = intel_sdvo_get_config;
2901

2902
	/* In default case sdvo lvds is false */
2903
	if (!intel_sdvo_get_capabilities(intel_sdvo, &intel_sdvo->caps))
2904
		goto err;
J
Jesse Barnes 已提交
2905

C
Chris Wilson 已提交
2906 2907
	if (intel_sdvo_output_setup(intel_sdvo,
				    intel_sdvo->caps.output_flags) != true) {
2908 2909
		DRM_DEBUG_KMS("SDVO output failed to setup on %s\n",
			      SDVO_NAME(intel_sdvo));
2910 2911
		/* Output_setup can leave behind connectors! */
		goto err_output;
J
Jesse Barnes 已提交
2912 2913
	}

2914 2915 2916 2917 2918 2919 2920 2921
	/* Only enable the hotplug irq if we need it, to work around noisy
	 * hotplug lines.
	 */
	if (intel_sdvo->hotplug_active) {
		intel_encoder->hpd_pin =
			intel_sdvo->is_sdvob ?  HPD_SDVO_B : HPD_SDVO_C;
	}

D
Daniel Vetter 已提交
2922 2923 2924 2925 2926 2927 2928 2929 2930 2931
	/*
	 * Cloning SDVO with anything is often impossible, since the SDVO
	 * encoder can request a special input timing mode. And even if that's
	 * not the case we have evidence that cloning a plain unscaled mode with
	 * VGA doesn't really work. Furthermore the cloning flags are way too
	 * simplistic anyway to express such constraints, so just give up on
	 * cloning for SDVO encoders.
	 */
	intel_sdvo->base.cloneable = false;

C
Chris Wilson 已提交
2932
	intel_sdvo_select_ddc_bus(dev_priv, intel_sdvo, sdvo_reg);
2933

J
Jesse Barnes 已提交
2934
	/* Set the input timing to the screen. Assume always input 0. */
2935
	if (!intel_sdvo_set_target_input(intel_sdvo))
2936
		goto err_output;
J
Jesse Barnes 已提交
2937

2938 2939 2940
	if (!intel_sdvo_get_input_pixel_clock_range(intel_sdvo,
						    &intel_sdvo->pixel_clock_min,
						    &intel_sdvo->pixel_clock_max))
2941
		goto err_output;
J
Jesse Barnes 已提交
2942

2943
	DRM_DEBUG_KMS("%s device VID/DID: %02X:%02X.%02X, "
2944 2945 2946
			"clock range %dMHz - %dMHz, "
			"input 1: %c, input 2: %c, "
			"output 1: %c, output 2: %c\n",
C
Chris Wilson 已提交
2947 2948 2949 2950 2951 2952 2953
			SDVO_NAME(intel_sdvo),
			intel_sdvo->caps.vendor_id, intel_sdvo->caps.device_id,
			intel_sdvo->caps.device_rev_id,
			intel_sdvo->pixel_clock_min / 1000,
			intel_sdvo->pixel_clock_max / 1000,
			(intel_sdvo->caps.sdvo_inputs_mask & 0x1) ? 'Y' : 'N',
			(intel_sdvo->caps.sdvo_inputs_mask & 0x2) ? 'Y' : 'N',
2954
			/* check currently supported outputs */
C
Chris Wilson 已提交
2955
			intel_sdvo->caps.output_flags &
J
Jesse Barnes 已提交
2956
			(SDVO_OUTPUT_TMDS0 | SDVO_OUTPUT_RGB0) ? 'Y' : 'N',
C
Chris Wilson 已提交
2957
			intel_sdvo->caps.output_flags &
J
Jesse Barnes 已提交
2958
			(SDVO_OUTPUT_TMDS1 | SDVO_OUTPUT_RGB1) ? 'Y' : 'N');
2959
	return true;
J
Jesse Barnes 已提交
2960

2961 2962 2963
err_output:
	intel_sdvo_output_cleanup(intel_sdvo);

2964
err:
2965
	drm_encoder_cleanup(&intel_encoder->base);
C
Chris Wilson 已提交
2966
	i2c_del_adapter(&intel_sdvo->ddc);
2967 2968
err_i2c_bus:
	intel_sdvo_unselect_i2c_bus(intel_sdvo);
C
Chris Wilson 已提交
2969
	kfree(intel_sdvo);
J
Jesse Barnes 已提交
2970

2971
	return false;
J
Jesse Barnes 已提交
2972
}