intel_sdvo.c 89.6 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
	while ((status == SDVO_CMD_STATUS_PENDING ||
			status == SDVO_CMD_STATUS_TARGET_NOT_SPECIFIED) && --retry) {
543 544 545 546 547
		if (retry < 10)
			msleep(15);
		else
			udelay(15);

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

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

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

562 563 564 565 566 567
	/* 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 已提交
568
		DRM_LOG_KMS(" %02X", ((u8 *)response)[i]);
569 570 571
	}
	DRM_LOG_KMS("\n");
	return true;
J
Jesse Barnes 已提交
572

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

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

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

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

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

605 606 607 608 609
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 已提交
610

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

614 615 616 617 618 619
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 已提交
620 621 622 623 624 625 626 627
}

/**
 * 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 已提交
628
static bool intel_sdvo_get_trained_inputs(struct intel_sdvo *intel_sdvo, bool *input_1, bool *input_2)
J
Jesse Barnes 已提交
629 630 631
{
	struct intel_sdvo_get_trained_inputs_response response;

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

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

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

650 651 652 653 654 655 656 657
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 已提交
658
static bool intel_sdvo_set_encoder_power_state(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
659 660
					       int mode)
{
661
	u8 state = SDVO_ENCODER_STATE_ON;
J
Jesse Barnes 已提交
662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677

	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;
	}

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

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

688
	BUILD_BUG_ON(sizeof(clocks) != 4);
689 690 691
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_INPUT_PIXEL_CLOCK_RANGE,
				  &clocks, sizeof(clocks)))
J
Jesse Barnes 已提交
692 693 694 695 696 697 698 699
		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 已提交
700
static bool intel_sdvo_set_target_output(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
701 702
					 u16 outputs)
{
703 704 705
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_TARGET_OUTPUT,
				    &outputs, sizeof(outputs));
J
Jesse Barnes 已提交
706 707
}

C
Chris Wilson 已提交
708
static bool intel_sdvo_set_timing(struct intel_sdvo *intel_sdvo, u8 cmd,
J
Jesse Barnes 已提交
709 710
				  struct intel_sdvo_dtd *dtd)
{
711 712
	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 已提交
713 714
}

715 716 717 718 719 720 721
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 已提交
722
static bool intel_sdvo_set_input_timing(struct intel_sdvo *intel_sdvo,
J
Jesse Barnes 已提交
723 724
					 struct intel_sdvo_dtd *dtd)
{
C
Chris Wilson 已提交
725
	return intel_sdvo_set_timing(intel_sdvo,
J
Jesse Barnes 已提交
726 727 728
				     SDVO_CMD_SET_INPUT_TIMINGS_PART1, dtd);
}

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

736 737 738 739 740 741 742
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);
}

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

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

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

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

C
Chris Wilson 已提交
767
static bool intel_sdvo_get_preferred_input_timing(struct intel_sdvo *intel_sdvo,
768 769
						  struct intel_sdvo_dtd *dtd)
{
770 771
	BUILD_BUG_ON(sizeof(dtd->part1) != 8);
	BUILD_BUG_ON(sizeof(dtd->part2) != 8);
772 773 774 775
	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));
776
}
J
Jesse Barnes 已提交
777

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

783
static void intel_sdvo_get_dtd_from_mode(struct intel_sdvo_dtd *dtd,
784
					 const struct drm_display_mode *mode)
J
Jesse Barnes 已提交
785
{
786 787 788
	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;
789
	int mode_clock;
J
Jesse Barnes 已提交
790

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

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

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

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

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

808 809 810
	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 已提交
811
		((h_blank_len >> 8) & 0xf);
812 813 814
	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 已提交
815 816
		((v_blank_len >> 8) & 0xf);

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

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

	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,
839
					 const struct intel_sdvo_dtd *dtd)
840 841 842 843
{
	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;
844
	mode->hsync_start += (dtd->part2.sync_off_width_high & 0xc0) << 2;
845 846 847 848 849 850 851 852 853
	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;
854
	mode->vsync_start += (dtd->part2.sync_off_width_high & 0x0c) << 2;
855 856 857 858 859 860 861 862 863
	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;

864
	mode->flags &= ~(DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC);
865 866 867
	if (dtd->part2.dtd_flags & DTD_FLAG_INTERLACE)
		mode->flags |= DRM_MODE_FLAG_INTERLACE;
	if (dtd->part2.dtd_flags & DTD_FLAG_HSYNC_POSITIVE)
868
		mode->flags |= DRM_MODE_FLAG_PHSYNC;
869 870
	else
		mode->flags |= DRM_MODE_FLAG_NHSYNC;
871
	if (dtd->part2.dtd_flags & DTD_FLAG_VSYNC_POSITIVE)
872
		mode->flags |= DRM_MODE_FLAG_PVSYNC;
873 874
	else
		mode->flags |= DRM_MODE_FLAG_NVSYNC;
875 876
}

877
static bool intel_sdvo_check_supp_encode(struct intel_sdvo *intel_sdvo)
878
{
879
	struct intel_sdvo_encode encode;
880

881
	BUILD_BUG_ON(sizeof(encode) != 2);
882 883 884
	return intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_SUPP_ENCODE,
				  &encode, sizeof(encode));
885 886
}

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

C
Chris Wilson 已提交
893
static bool intel_sdvo_set_colorimetry(struct intel_sdvo *intel_sdvo,
894 895
				       uint8_t mode)
{
896
	return intel_sdvo_set_value(intel_sdvo, SDVO_CMD_SET_COLORIMETRY, &mode, 1);
897 898 899
}

#if 0
C
Chris Wilson 已提交
900
static void intel_sdvo_dump_hdmi_buf(struct intel_sdvo *intel_sdvo)
901 902 903 904 905 906 907 908
{
	int i, j;
	uint8_t set_buf_index[2];
	uint8_t av_split;
	uint8_t buf_size;
	uint8_t buf[48];
	uint8_t *pos;

909
	intel_sdvo_get_value(encoder, SDVO_CMD_GET_HBUF_AV_SPLIT, &av_split, 1);
910 911 912

	for (i = 0; i <= av_split; i++) {
		set_buf_index[0] = i; set_buf_index[1] = 0;
913
		intel_sdvo_write_cmd(encoder, SDVO_CMD_SET_HBUF_INDEX,
914
				     set_buf_index, 2);
915 916
		intel_sdvo_write_cmd(encoder, SDVO_CMD_GET_HBUF_INFO, NULL, 0);
		intel_sdvo_read_response(encoder, &buf_size, 1);
917 918 919

		pos = buf;
		for (j = 0; j <= buf_size; j += 8) {
920
			intel_sdvo_write_cmd(encoder, SDVO_CMD_GET_HBUF_DATA,
921
					     NULL, 0);
922
			intel_sdvo_read_response(encoder, pos, 8);
923 924 925 926 927 928
			pos += 8;
		}
	}
}
#endif

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 963 964 965 966 967
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);
}

968 969
static bool intel_sdvo_set_avi_infoframe(struct intel_sdvo *intel_sdvo,
					 const struct drm_display_mode *adjusted_mode)
970
{
971 972 973 974 975 976 977 978 979 980 981 982 983
	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;
	}
984

985
	if (intel_sdvo->rgb_quant_range_selectable) {
986
		if (intel_crtc->config.limited_color_range)
987 988
			frame.avi.quantization_range =
				HDMI_QUANTIZATION_RANGE_LIMITED;
989
		else
990 991
			frame.avi.quantization_range =
				HDMI_QUANTIZATION_RANGE_FULL;
992 993
	}

994 995 996
	len = hdmi_infoframe_pack(&frame, sdvo_data, sizeof(sdvo_data));
	if (len < 0)
		return false;
997

998 999 1000
	return intel_sdvo_write_infoframe(intel_sdvo, SDVO_HBUF_INDEX_AVI_IF,
					  SDVO_HBUF_TX_VSYNC,
					  sdvo_data, sizeof(sdvo_data));
1001 1002
}

1003
static bool intel_sdvo_set_tv_format(struct intel_sdvo *intel_sdvo)
Z
Zhenyu Wang 已提交
1004
{
1005
	struct intel_sdvo_tv_format format;
1006
	uint32_t format_map;
1007

1008
	format_map = 1 << intel_sdvo->tv_format_index;
1009
	memset(&format, 0, sizeof(format));
1010
	memcpy(&format, &format_map, min(sizeof(format), sizeof(format_map)));
1011

1012 1013 1014 1015
	BUILD_BUG_ON(sizeof(format) != 6);
	return intel_sdvo_set_value(intel_sdvo,
				    SDVO_CMD_SET_TV_FORMAT,
				    &format, sizeof(format));
Z
Zhenyu Wang 已提交
1016 1017
}

1018 1019
static bool
intel_sdvo_set_output_timings_from_mode(struct intel_sdvo *intel_sdvo,
1020
					const struct drm_display_mode *mode)
1021
{
1022
	struct intel_sdvo_dtd output_dtd;
J
Jesse Barnes 已提交
1023

1024 1025 1026
	if (!intel_sdvo_set_target_output(intel_sdvo,
					  intel_sdvo->attached_output))
		return false;
1027

1028 1029 1030
	intel_sdvo_get_dtd_from_mode(&output_dtd, mode);
	if (!intel_sdvo_set_output_timing(intel_sdvo, &output_dtd))
		return false;
1031

1032 1033 1034
	return true;
}

1035 1036
/* 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. */
1037
static bool
1038
intel_sdvo_get_preferred_input_mode(struct intel_sdvo *intel_sdvo,
1039
				    const struct drm_display_mode *mode,
1040
				    struct drm_display_mode *adjusted_mode)
1041
{
1042 1043
	struct intel_sdvo_dtd input_dtd;

1044 1045 1046
	/* Reset the input timing to the screen. Assume always input 0. */
	if (!intel_sdvo_set_target_input(intel_sdvo))
		return false;
1047

1048 1049 1050 1051 1052
	if (!intel_sdvo_create_preferred_input_timing(intel_sdvo,
						      mode->clock / 10,
						      mode->hdisplay,
						      mode->vdisplay))
		return false;
1053

1054
	if (!intel_sdvo_get_preferred_input_timing(intel_sdvo,
1055
						   &input_dtd))
1056
		return false;
1057

1058
	intel_sdvo_get_mode_from_dtd(adjusted_mode, &input_dtd);
1059
	intel_sdvo->dtd_sdvo_flags = input_dtd.part2.sdvo_flags;
J
Jesse Barnes 已提交
1060

1061 1062
	return true;
}
1063

1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089
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;
}

1090 1091
static bool intel_sdvo_compute_config(struct intel_encoder *encoder,
				      struct intel_crtc_config *pipe_config)
1092
{
1093
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1094 1095
	struct drm_display_mode *adjusted_mode = &pipe_config->adjusted_mode;
	struct drm_display_mode *mode = &pipe_config->requested_mode;
1096

1097 1098 1099
	DRM_DEBUG_KMS("forcing bpc to 8 for SDVO\n");
	pipe_config->pipe_bpp = 8*3;

1100 1101 1102
	if (HAS_PCH_SPLIT(encoder->base.dev))
		pipe_config->has_pch_encoder = true;

1103 1104 1105 1106 1107 1108 1109 1110
	/* 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;
1111

1112 1113 1114
		(void) intel_sdvo_get_preferred_input_mode(intel_sdvo,
							   mode,
							   adjusted_mode);
1115
		pipe_config->sdvo_tv_clock = true;
C
Chris Wilson 已提交
1116
	} else if (intel_sdvo->is_lvds) {
1117
		if (!intel_sdvo_set_output_timings_from_mode(intel_sdvo,
1118
							     intel_sdvo->sdvo_lvds_fixed_mode))
1119
			return false;
1120

1121 1122 1123
		(void) intel_sdvo_get_preferred_input_mode(intel_sdvo,
							   mode,
							   adjusted_mode);
1124
	}
1125 1126

	/* Make the CRTC code factor in the SDVO pixel multiplier.  The
1127
	 * SDVO device will factor out the multiplier during mode_set.
1128
	 */
1129 1130 1131
	pipe_config->pixel_multiplier =
		intel_sdvo_get_pixel_multiplier(adjusted_mode);
	adjusted_mode->clock *= pipe_config->pixel_multiplier;
1132

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

1144
	if (intel_sdvo->color_range)
1145
		pipe_config->limited_color_range = true;
1146

1147 1148 1149 1150
	/* Clock computation needs to happen after pixel multiplier. */
	if (intel_sdvo->is_tv)
		i9xx_adjust_sdvo_tv_clock(pipe_config);

1151 1152 1153
	return true;
}

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

	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 已提交
1177
	in_out.in0 = intel_sdvo->attached_output;
1178 1179
	in_out.in1 = 0;

1180 1181 1182
	intel_sdvo_set_value(intel_sdvo,
			     SDVO_CMD_SET_IN_OUT_MAP,
			     &in_out, sizeof(in_out));
1183

1184 1185 1186 1187
	/* Set the output timings to the screen */
	if (!intel_sdvo_set_target_output(intel_sdvo,
					  intel_sdvo->attached_output))
		return;
1188

1189 1190 1191 1192 1193 1194
	/* 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);
1195 1196 1197
	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 已提交
1198 1199

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

1203 1204 1205 1206
	if (intel_sdvo->has_hdmi_monitor) {
		intel_sdvo_set_encode(intel_sdvo, SDVO_ENCODE_HDMI);
		intel_sdvo_set_colorimetry(intel_sdvo,
					   SDVO_COLORIMETRY_RGB256);
1207
		intel_sdvo_set_avi_infoframe(intel_sdvo, adjusted_mode);
1208 1209
	} else
		intel_sdvo_set_encode(intel_sdvo, SDVO_ENCODE_DVI);
Z
Zhenyu Wang 已提交
1210

1211 1212 1213
	if (intel_sdvo->is_tv &&
	    !intel_sdvo_set_tv_format(intel_sdvo))
		return;
1214

1215 1216 1217 1218
	/* 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);
1219 1220
	input_dtd.part1.clock /= crtc->config.pixel_multiplier;

1221 1222
	if (intel_sdvo->is_tv || intel_sdvo->is_lvds)
		input_dtd.part2.sdvo_flags = intel_sdvo->dtd_sdvo_flags;
1223 1224 1225
	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 已提交
1226

1227
	switch (crtc->config.pixel_multiplier) {
1228
	default:
1229
		WARN(1, "unknown pixel mutlipler specified\n");
1230 1231 1232
	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 已提交
1233
	}
1234 1235
	if (!intel_sdvo_set_clock_rate_mult(intel_sdvo, rate))
		return;
J
Jesse Barnes 已提交
1236 1237

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

	if (INTEL_PCH_TYPE(dev) >= PCH_CPT)
1260
		sdvox |= SDVO_PIPE_SEL_CPT(crtc->pipe);
1261
	else
1262
		sdvox |= SDVO_PIPE_SEL(crtc->pipe);
1263

1264
	if (intel_sdvo->has_hdmi_audio)
1265
		sdvox |= SDVO_AUDIO_ENABLE;
J
Jesse Barnes 已提交
1266

1267
	if (INTEL_INFO(dev)->gen >= 4) {
1268 1269 1270
		/* 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 已提交
1271
	} else {
1272
		sdvox |= (crtc->config.pixel_multiplier - 1)
1273
			<< SDVO_PORT_MULTIPLY_SHIFT;
J
Jesse Barnes 已提交
1274 1275
	}

1276 1277
	if (input_dtd.part2.sdvo_flags & SDVO_NEED_TO_STALL &&
	    INTEL_INFO(dev)->gen < 5)
1278
		sdvox |= SDVO_STALL_SELECT;
C
Chris Wilson 已提交
1279
	intel_sdvo_write_sdvox(intel_sdvo, sdvox);
J
Jesse Barnes 已提交
1280 1281
}

1282
static bool intel_sdvo_connector_get_hw_state(struct intel_connector *connector)
J
Jesse Barnes 已提交
1283
{
1284 1285 1286
	struct intel_sdvo_connector *intel_sdvo_connector =
		to_intel_sdvo_connector(&connector->base);
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(&connector->base);
1287
	u16 active_outputs = 0;
1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300

	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 已提交
1301
	struct drm_i915_private *dev_priv = dev->dev_private;
1302
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1303
	u16 active_outputs = 0;
1304 1305 1306
	u32 tmp;

	tmp = I915_READ(intel_sdvo->sdvo_reg);
1307
	intel_sdvo_get_active_outputs(intel_sdvo, &active_outputs);
1308

1309
	if (!(tmp & SDVO_ENABLE) && (active_outputs == 0))
1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
		return false;

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

	return true;
}

1320 1321 1322
static void intel_sdvo_get_config(struct intel_encoder *encoder,
				  struct intel_crtc_config *pipe_config)
{
1323 1324
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
1325
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1326
	struct intel_sdvo_dtd dtd;
1327 1328 1329
	int encoder_pixel_multiplier = 0;
	u32 flags = 0, sdvox;
	u8 val;
1330 1331 1332 1333
	bool ret;

	ret = intel_sdvo_get_input_timing(intel_sdvo, &dtd);
	if (!ret) {
1334 1335
		/* Some sdvo encoders are not spec compliant and don't
		 * implement the mandatory get_timings function. */
1336
		DRM_DEBUG_DRIVER("failed to retrieve SDVO DTD\n");
1337 1338 1339 1340 1341 1342
		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;
1343

1344 1345 1346 1347
		if (dtd.part2.dtd_flags & DTD_FLAG_VSYNC_POSITIVE)
			flags |= DRM_MODE_FLAG_PVSYNC;
		else
			flags |= DRM_MODE_FLAG_NVSYNC;
1348 1349 1350 1351
	}

	pipe_config->adjusted_mode.flags |= flags;

1352 1353 1354 1355 1356 1357 1358
	/*
	 * 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.
	 */
1359 1360 1361 1362 1363 1364
	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;
	}
1365

1366
	/* Cross check the port pixel multiplier with the sdvo encoder state. */
1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
	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;
		}
1380
	}
1381

1382 1383 1384
	WARN(encoder_pixel_multiplier != pipe_config->pixel_multiplier,
	     "SDVO pixel multiplier mismatch, port: %i, encoder: %i\n",
	     pipe_config->pixel_multiplier, encoder_pixel_multiplier);
1385 1386
}

1387 1388 1389
static void intel_disable_sdvo(struct intel_encoder *encoder)
{
	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
1390
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1391 1392 1393 1394 1395 1396 1397 1398 1399
	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) {
1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
		/* 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);
			}
		}

1424 1425 1426 1427 1428 1429 1430 1431
		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;
1432
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1433
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
J
Jesse Barnes 已提交
1434
	u32 temp;
1435 1436 1437 1438 1439
	bool input1, input2;
	int i;
	u8 status;

	temp = I915_READ(intel_sdvo->sdvo_reg);
1440 1441
	if ((temp & SDVO_ENABLE) == 0) {
		/* HW workaround for IBX, we need to move the port
1442 1443 1444
		 * to transcoder A before disabling it, so restore it here. */
		if (HAS_PCH_IBX(dev))
			temp |= SDVO_PIPE_SEL(intel_crtc->pipe);
1445

1446
		intel_sdvo_write_sdvox(intel_sdvo, temp | SDVO_ENABLE);
1447
	}
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466
	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);
}

1467
/* Special dpms function to support cloning between dvo/sdvo/crt. */
1468
static void intel_sdvo_dpms(struct drm_connector *connector, int mode)
J
Jesse Barnes 已提交
1469
{
1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487
	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 已提交
1488

1489 1490
	/* We set active outputs manually below in case pipe dpms doesn't change
	 * due to cloning. */
J
Jesse Barnes 已提交
1491
	if (mode != DRM_MODE_DPMS_ON) {
C
Chris Wilson 已提交
1492
		intel_sdvo_set_active_outputs(intel_sdvo, 0);
J
Jesse Barnes 已提交
1493
		if (0)
C
Chris Wilson 已提交
1494
			intel_sdvo_set_encoder_power_state(intel_sdvo, mode);
J
Jesse Barnes 已提交
1495

1496 1497 1498
		intel_sdvo->base.connectors_active = false;

		intel_crtc_update_dpms(crtc);
J
Jesse Barnes 已提交
1499
	} else {
1500 1501 1502
		intel_sdvo->base.connectors_active = true;

		intel_crtc_update_dpms(crtc);
J
Jesse Barnes 已提交
1503 1504

		if (0)
C
Chris Wilson 已提交
1505 1506
			intel_sdvo_set_encoder_power_state(intel_sdvo, mode);
		intel_sdvo_set_active_outputs(intel_sdvo, intel_sdvo->attached_output);
J
Jesse Barnes 已提交
1507
	}
1508

1509
	intel_modeset_check_state(connector->dev);
J
Jesse Barnes 已提交
1510 1511 1512 1513 1514
}

static int intel_sdvo_mode_valid(struct drm_connector *connector,
				 struct drm_display_mode *mode)
{
1515
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
J
Jesse Barnes 已提交
1516 1517 1518 1519

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

C
Chris Wilson 已提交
1520
	if (intel_sdvo->pixel_clock_min > mode->clock)
J
Jesse Barnes 已提交
1521 1522
		return MODE_CLOCK_LOW;

C
Chris Wilson 已提交
1523
	if (intel_sdvo->pixel_clock_max < mode->clock)
J
Jesse Barnes 已提交
1524 1525
		return MODE_CLOCK_HIGH;

1526
	if (intel_sdvo->is_lvds) {
C
Chris Wilson 已提交
1527
		if (mode->hdisplay > intel_sdvo->sdvo_lvds_fixed_mode->hdisplay)
1528 1529
			return MODE_PANEL;

C
Chris Wilson 已提交
1530
		if (mode->vdisplay > intel_sdvo->sdvo_lvds_fixed_mode->vdisplay)
1531 1532 1533
			return MODE_PANEL;
	}

J
Jesse Barnes 已提交
1534 1535 1536
	return MODE_OK;
}

C
Chris Wilson 已提交
1537
static bool intel_sdvo_get_capabilities(struct intel_sdvo *intel_sdvo, struct intel_sdvo_caps *caps)
J
Jesse Barnes 已提交
1538
{
1539
	BUILD_BUG_ON(sizeof(*caps) != 8);
C
Chris Wilson 已提交
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 1566 1567 1568 1569 1570 1571
	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 已提交
1572 1573
}

1574
static uint16_t intel_sdvo_get_hotplug_support(struct intel_sdvo *intel_sdvo)
J
Jesse Barnes 已提交
1575
{
1576
	struct drm_device *dev = intel_sdvo->base.base.dev;
1577
	uint16_t hotplug;
J
Jesse Barnes 已提交
1578

1579 1580 1581
	/* HW Erratum: SDVO Hotplug is broken on all i945G chips, there's noise
	 * on the line. */
	if (IS_I945G(dev) || IS_I945GM(dev))
1582
		return 0;
1583

1584 1585 1586
	if (!intel_sdvo_get_value(intel_sdvo, SDVO_CMD_GET_HOT_PLUG_SUPPORT,
					&hotplug, sizeof(hotplug)))
		return 0;
1587

1588
	return hotplug;
J
Jesse Barnes 已提交
1589 1590
}

1591
static void intel_sdvo_enable_hotplug(struct intel_encoder *encoder)
J
Jesse Barnes 已提交
1592
{
1593
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
J
Jesse Barnes 已提交
1594

1595 1596
	intel_sdvo_write_cmd(intel_sdvo, SDVO_CMD_SET_ACTIVE_HOT_PLUG,
			&intel_sdvo->hotplug_active, 2);
J
Jesse Barnes 已提交
1597 1598
}

1599
static bool
C
Chris Wilson 已提交
1600
intel_sdvo_multifunc_encoder(struct intel_sdvo *intel_sdvo)
1601
{
1602
	/* Is there more than one type of output? */
1603
	return hweight16(intel_sdvo->caps.output_flags) > 1;
1604 1605
}

1606
static struct edid *
C
Chris Wilson 已提交
1607
intel_sdvo_get_edid(struct drm_connector *connector)
1608
{
C
Chris Wilson 已提交
1609 1610
	struct intel_sdvo *sdvo = intel_attached_sdvo(connector);
	return drm_get_edid(connector, &sdvo->ddc);
1611 1612
}

1613 1614 1615 1616
/* Mac mini hack -- use the same DDC as the analog connector */
static struct edid *
intel_sdvo_get_analog_edid(struct drm_connector *connector)
{
1617
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
1618

1619
	return drm_get_edid(connector,
1620
			    intel_gmbus_get_adapter(dev_priv,
1621
						    dev_priv->vbt.crt_ddc_pin));
1622 1623
}

1624
static enum drm_connector_status
1625
intel_sdvo_tmds_sink_detect(struct drm_connector *connector)
1626
{
1627
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
1628 1629
	enum drm_connector_status status;
	struct edid *edid;
1630

C
Chris Wilson 已提交
1631
	edid = intel_sdvo_get_edid(connector);
1632

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

1636 1637 1638 1639
		/*
		 * Don't use the 1 as the argument of DDC bus switch to get
		 * the EDID. It is used for SDVO SPD ROM.
		 */
1640
		for (ddc = intel_sdvo->ddc_bus >> 1; ddc > 1; ddc >>= 1) {
C
Chris Wilson 已提交
1641 1642 1643
			intel_sdvo->ddc_bus = ddc;
			edid = intel_sdvo_get_edid(connector);
			if (edid)
1644 1645
				break;
		}
C
Chris Wilson 已提交
1646 1647 1648 1649 1650 1651
		/*
		 * 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;
1652
	}
1653 1654 1655 1656

	/*
	 * 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.
1657
	 */
1658 1659
	if (edid == NULL)
		edid = intel_sdvo_get_analog_edid(connector);
1660

1661
	status = connector_status_unknown;
1662
	if (edid != NULL) {
1663
		/* DDC bus is shared, match EDID to connector type */
1664 1665
		if (edid->input & DRM_EDID_INPUT_DIGITAL) {
			status = connector_status_connected;
1666 1667 1668
			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);
1669 1670
				intel_sdvo->rgb_quant_range_selectable =
					drm_rgb_quant_range_selectable(edid);
1671
			}
1672 1673
		} else
			status = connector_status_disconnected;
1674 1675
		kfree(edid);
	}
1676 1677 1678

	if (status == connector_status_connected) {
		struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1679 1680
		if (intel_sdvo_connector->force_audio != HDMI_AUDIO_AUTO)
			intel_sdvo->has_hdmi_audio = (intel_sdvo_connector->force_audio == HDMI_AUDIO_ON);
1681 1682
	}

1683
	return status;
1684 1685
}

1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697
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;
}

1698
static enum drm_connector_status
1699
intel_sdvo_detect(struct drm_connector *connector, bool force)
J
Jesse Barnes 已提交
1700
{
1701
	uint16_t response;
1702
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
1703
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1704
	enum drm_connector_status ret;
J
Jesse Barnes 已提交
1705

1706 1707 1708
	DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
		      connector->base.id, drm_get_connector_name(connector));

1709 1710 1711
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_ATTACHED_DISPLAYS,
				  &response, 2))
1712
		return connector_status_unknown;
J
Jesse Barnes 已提交
1713

C
Chris Wilson 已提交
1714 1715 1716
	DRM_DEBUG_KMS("SDVO response %d %d [%x]\n",
		      response & 0xff, response >> 8,
		      intel_sdvo_connector->output_flag);
1717

1718
	if (response == 0)
J
Jesse Barnes 已提交
1719
		return connector_status_disconnected;
1720

C
Chris Wilson 已提交
1721
	intel_sdvo->attached_output = response;
1722

1723 1724
	intel_sdvo->has_hdmi_monitor = false;
	intel_sdvo->has_hdmi_audio = false;
1725
	intel_sdvo->rgb_quant_range_selectable = false;
1726

1727
	if ((intel_sdvo_connector->output_flag & response) == 0)
1728
		ret = connector_status_disconnected;
1729
	else if (IS_TMDS(intel_sdvo_connector))
1730
		ret = intel_sdvo_tmds_sink_detect(connector);
1731 1732 1733 1734 1735 1736 1737 1738
	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) {
1739 1740
			if (intel_sdvo_connector_matches_edid(intel_sdvo_connector,
							      edid))
1741
				ret = connector_status_connected;
1742 1743 1744
			else
				ret = connector_status_disconnected;

1745 1746 1747 1748
			kfree(edid);
		} else
			ret = connector_status_connected;
	}
1749 1750 1751

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

1755
		if (response & SDVO_TV_MASK)
C
Chris Wilson 已提交
1756
			intel_sdvo->is_tv = true;
1757
		if (response & SDVO_LVDS_MASK)
1758
			intel_sdvo->is_lvds = intel_sdvo->sdvo_lvds_fixed_mode != NULL;
1759
	}
1760 1761

	return ret;
J
Jesse Barnes 已提交
1762 1763
}

1764
static void intel_sdvo_get_ddc_modes(struct drm_connector *connector)
J
Jesse Barnes 已提交
1765
{
1766
	struct edid *edid;
J
Jesse Barnes 已提交
1767 1768

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

1771 1772 1773 1774 1775
	/*
	 * 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.
1776
	 */
1777 1778 1779
	if (edid == NULL)
		edid = intel_sdvo_get_analog_edid(connector);

1780
	if (edid != NULL) {
1781 1782
		if (intel_sdvo_connector_matches_edid(to_intel_sdvo_connector(connector),
						      edid)) {
1783 1784 1785
			drm_mode_connector_update_edid_property(connector, edid);
			drm_add_edid_modes(connector, edid);
		}
1786

1787
		kfree(edid);
1788 1789 1790 1791 1792 1793 1794 1795
	}
}

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

static void intel_sdvo_get_tv_modes(struct drm_connector *connector)
{
1858
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
Z
Zhenyu Wang 已提交
1859
	struct intel_sdvo_sdtv_resolution_request tv_res;
1860 1861
	uint32_t reply = 0, format_map = 0;
	int i;
1862 1863 1864 1865

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

1870 1871
	if (!intel_sdvo_set_target_output(intel_sdvo, intel_sdvo->attached_output))
		return;
1872

1873
	BUILD_BUG_ON(sizeof(tv_res) != 3);
C
Chris Wilson 已提交
1874 1875
	if (!intel_sdvo_write_cmd(intel_sdvo,
				  SDVO_CMD_GET_SDTV_RESOLUTION_SUPPORT,
1876 1877 1878
				  &tv_res, sizeof(tv_res)))
		return;
	if (!intel_sdvo_read_response(intel_sdvo, &reply, 3))
1879 1880 1881
		return;

	for (i = 0; i < ARRAY_SIZE(sdvo_tv_modes); i++)
Z
Zhenyu Wang 已提交
1882 1883 1884
		if (reply & (1 << i)) {
			struct drm_display_mode *nmode;
			nmode = drm_mode_duplicate(connector->dev,
1885
						   &sdvo_tv_modes[i]);
Z
Zhenyu Wang 已提交
1886 1887 1888
			if (nmode)
				drm_mode_probed_add(connector, nmode);
		}
1889 1890
}

1891 1892
static void intel_sdvo_get_lvds_modes(struct drm_connector *connector)
{
1893
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
1894
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
1895
	struct drm_display_mode *newmode;
1896 1897

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

1912 1913 1914 1915 1916 1917 1918
	/*
	 * 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);

1919 1920
	list_for_each_entry(newmode, &connector->probed_modes, head) {
		if (newmode->type & DRM_MODE_TYPE_PREFERRED) {
C
Chris Wilson 已提交
1921
			intel_sdvo->sdvo_lvds_fixed_mode =
1922
				drm_mode_duplicate(connector->dev, newmode);
1923

1924
			intel_sdvo->is_lvds = true;
1925 1926 1927 1928
			break;
		}
	}

1929 1930
}

1931 1932
static int intel_sdvo_get_modes(struct drm_connector *connector)
{
1933
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1934

1935
	if (IS_TV(intel_sdvo_connector))
1936
		intel_sdvo_get_tv_modes(connector);
1937
	else if (IS_LVDS(intel_sdvo_connector))
1938
		intel_sdvo_get_lvds_modes(connector);
1939 1940 1941
	else
		intel_sdvo_get_ddc_modes(connector);

1942
	return !list_empty(&connector->probed_modes);
J
Jesse Barnes 已提交
1943 1944
}

1945 1946
static void
intel_sdvo_destroy_enhance_property(struct drm_connector *connector)
1947
{
1948
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
1949 1950
	struct drm_device *dev = connector->dev;

1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980
	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);
1981 1982
	if (intel_sdvo_connector->dot_crawl)
		drm_property_destroy(dev, intel_sdvo_connector->dot_crawl);
1983 1984
	if (intel_sdvo_connector->brightness)
		drm_property_destroy(dev, intel_sdvo_connector->brightness);
1985 1986
}

J
Jesse Barnes 已提交
1987 1988
static void intel_sdvo_destroy(struct drm_connector *connector)
{
1989
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
J
Jesse Barnes 已提交
1990

1991
	if (intel_sdvo_connector->tv_format)
1992
		drm_property_destroy(connector->dev,
1993
				     intel_sdvo_connector->tv_format);
1994

1995
	intel_sdvo_destroy_enhance_property(connector);
J
Jesse Barnes 已提交
1996 1997
	drm_sysfs_connector_remove(connector);
	drm_connector_cleanup(connector);
1998
	kfree(intel_sdvo_connector);
J
Jesse Barnes 已提交
1999 2000
}

2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012
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);
2013
	kfree(edid);
2014 2015 2016 2017

	return has_audio;
}

2018 2019 2020 2021 2022
static int
intel_sdvo_set_property(struct drm_connector *connector,
			struct drm_property *property,
			uint64_t val)
{
2023
	struct intel_sdvo *intel_sdvo = intel_attached_sdvo(connector);
2024
	struct intel_sdvo_connector *intel_sdvo_connector = to_intel_sdvo_connector(connector);
2025
	struct drm_i915_private *dev_priv = connector->dev->dev_private;
2026
	uint16_t temp_value;
2027 2028
	uint8_t cmd;
	int ret;
2029

2030
	ret = drm_object_property_set_value(&connector->base, property, val);
2031 2032
	if (ret)
		return ret;
2033

2034
	if (property == dev_priv->force_audio_property) {
2035 2036 2037 2038
		int i = val;
		bool has_audio;

		if (i == intel_sdvo_connector->force_audio)
2039 2040
			return 0;

2041
		intel_sdvo_connector->force_audio = i;
2042

2043
		if (i == HDMI_AUDIO_AUTO)
2044 2045
			has_audio = intel_sdvo_detect_hdmi_audio(connector);
		else
2046
			has_audio = (i == HDMI_AUDIO_ON);
2047

2048
		if (has_audio == intel_sdvo->has_hdmi_audio)
2049 2050
			return 0;

2051
		intel_sdvo->has_hdmi_audio = has_audio;
2052 2053 2054
		goto done;
	}

2055
	if (property == dev_priv->broadcast_rgb_property) {
2056 2057 2058
		bool old_auto = intel_sdvo->color_range_auto;
		uint32_t old_range = intel_sdvo->color_range;

2059 2060 2061 2062 2063 2064 2065 2066 2067 2068
		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;
2069 2070 2071
			/* 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;
2072 2073 2074 2075
			break;
		default:
			return -EINVAL;
		}
2076 2077 2078 2079 2080

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

2081 2082 2083
		goto done;
	}

2084 2085 2086 2087 2088 2089 2090 2091 2092 2093
#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) {
2094 2095 2096
		if (val >= TV_FORMAT_NUM)
			return -EINVAL;

2097
		if (intel_sdvo->tv_format_index ==
2098
		    intel_sdvo_connector->tv_format_supported[val])
2099
			return 0;
2100

2101
		intel_sdvo->tv_format_index = intel_sdvo_connector->tv_format_supported[val];
2102
		goto done;
2103
	} else if (IS_TV_OR_LVDS(intel_sdvo_connector)) {
2104
		temp_value = val;
2105
		if (intel_sdvo_connector->left == property) {
2106
			drm_object_property_set_value(&connector->base,
2107
							 intel_sdvo_connector->right, val);
2108
			if (intel_sdvo_connector->left_margin == temp_value)
2109
				return 0;
2110

2111 2112 2113
			intel_sdvo_connector->left_margin = temp_value;
			intel_sdvo_connector->right_margin = temp_value;
			temp_value = intel_sdvo_connector->max_hscan -
2114
				intel_sdvo_connector->left_margin;
2115
			cmd = SDVO_CMD_SET_OVERSCAN_H;
2116 2117
			goto set_value;
		} else if (intel_sdvo_connector->right == property) {
2118
			drm_object_property_set_value(&connector->base,
2119
							 intel_sdvo_connector->left, val);
2120
			if (intel_sdvo_connector->right_margin == temp_value)
2121
				return 0;
2122

2123 2124 2125 2126
			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;
2127
			cmd = SDVO_CMD_SET_OVERSCAN_H;
2128 2129
			goto set_value;
		} else if (intel_sdvo_connector->top == property) {
2130
			drm_object_property_set_value(&connector->base,
2131
							 intel_sdvo_connector->bottom, val);
2132
			if (intel_sdvo_connector->top_margin == temp_value)
2133
				return 0;
2134

2135 2136 2137
			intel_sdvo_connector->top_margin = temp_value;
			intel_sdvo_connector->bottom_margin = temp_value;
			temp_value = intel_sdvo_connector->max_vscan -
2138
				intel_sdvo_connector->top_margin;
2139
			cmd = SDVO_CMD_SET_OVERSCAN_V;
2140 2141
			goto set_value;
		} else if (intel_sdvo_connector->bottom == property) {
2142
			drm_object_property_set_value(&connector->base,
2143
							 intel_sdvo_connector->top, val);
2144
			if (intel_sdvo_connector->bottom_margin == temp_value)
2145 2146
				return 0;

2147 2148 2149
			intel_sdvo_connector->top_margin = temp_value;
			intel_sdvo_connector->bottom_margin = temp_value;
			temp_value = intel_sdvo_connector->max_vscan -
2150
				intel_sdvo_connector->top_margin;
2151
			cmd = SDVO_CMD_SET_OVERSCAN_V;
2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165
			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)
2166
		CHECK_PROPERTY(dot_crawl, DOT_CRAWL)
2167
	}
2168

2169
	return -EINVAL; /* unknown property */
2170

2171 2172 2173
set_value:
	if (!intel_sdvo_set_value(intel_sdvo, cmd, &temp_value, 2))
		return -EIO;
2174 2175


2176
done:
2177 2178
	if (intel_sdvo->base.base.crtc)
		intel_crtc_restore_mode(intel_sdvo->base.base.crtc);
2179

2180
	return 0;
2181
#undef CHECK_PROPERTY
2182 2183
}

J
Jesse Barnes 已提交
2184
static const struct drm_connector_funcs intel_sdvo_connector_funcs = {
2185
	.dpms = intel_sdvo_dpms,
J
Jesse Barnes 已提交
2186 2187
	.detect = intel_sdvo_detect,
	.fill_modes = drm_helper_probe_single_connector_modes,
2188
	.set_property = intel_sdvo_set_property,
J
Jesse Barnes 已提交
2189 2190 2191 2192 2193 2194
	.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,
2195
	.best_encoder = intel_best_encoder,
J
Jesse Barnes 已提交
2196 2197
};

2198
static void intel_sdvo_enc_destroy(struct drm_encoder *encoder)
J
Jesse Barnes 已提交
2199
{
2200
	struct intel_sdvo *intel_sdvo = to_sdvo(to_intel_encoder(encoder));
2201

C
Chris Wilson 已提交
2202
	if (intel_sdvo->sdvo_lvds_fixed_mode != NULL)
2203
		drm_mode_destroy(encoder->dev,
C
Chris Wilson 已提交
2204
				 intel_sdvo->sdvo_lvds_fixed_mode);
2205

C
Chris Wilson 已提交
2206
	i2c_del_adapter(&intel_sdvo->ddc);
C
Chris Wilson 已提交
2207
	intel_encoder_destroy(encoder);
J
Jesse Barnes 已提交
2208 2209 2210 2211 2212 2213
}

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

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 2243 2244 2245 2246 2247 2248
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 已提交
2249

2250 2251 2252 2253 2254 2255 2256 2257
/**
 * 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
2258
intel_sdvo_select_ddc_bus(struct drm_i915_private *dev_priv,
C
Chris Wilson 已提交
2259
			  struct intel_sdvo *sdvo, u32 reg)
2260
{
2261
	struct sdvo_device_mapping *mapping;
2262

2263
	if (sdvo->is_sdvob)
2264 2265 2266
		mapping = &(dev_priv->sdvo_mappings[0]);
	else
		mapping = &(dev_priv->sdvo_mappings[1]);
2267

2268 2269 2270 2271
	if (mapping->initialized)
		sdvo->ddc_bus = 1 << ((mapping->ddc_pin & 0xf0) >> 4);
	else
		intel_sdvo_guess_ddc_bus(sdvo);
2272 2273
}

C
Chris Wilson 已提交
2274 2275 2276 2277 2278
static void
intel_sdvo_select_i2c_bus(struct drm_i915_private *dev_priv,
			  struct intel_sdvo *sdvo, u32 reg)
{
	struct sdvo_device_mapping *mapping;
2279
	u8 pin;
C
Chris Wilson 已提交
2280

2281
	if (sdvo->is_sdvob)
C
Chris Wilson 已提交
2282 2283 2284 2285
		mapping = &dev_priv->sdvo_mappings[0];
	else
		mapping = &dev_priv->sdvo_mappings[1];

2286
	if (mapping->initialized && intel_gmbus_is_port_valid(mapping->i2c_pin))
C
Chris Wilson 已提交
2287
		pin = mapping->i2c_pin;
2288 2289
	else
		pin = GMBUS_PORT_DPB;
C
Chris Wilson 已提交
2290

2291 2292 2293 2294 2295 2296
	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 已提交
2297 2298
}

2299 2300 2301 2302 2303
/* 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 已提交
2304 2305
}

2306
static bool
2307
intel_sdvo_is_hdmi_connector(struct intel_sdvo *intel_sdvo, int device)
2308
{
2309
	return intel_sdvo_check_supp_encode(intel_sdvo);
2310 2311
}

2312
static u8
2313
intel_sdvo_get_slave_addr(struct drm_device *dev, struct intel_sdvo *sdvo)
2314 2315 2316 2317
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct sdvo_device_mapping *my_mapping, *other_mapping;

2318
	if (sdvo->is_sdvob) {
2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342
		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.
	 */
2343
	if (sdvo->is_sdvob)
2344 2345 2346 2347 2348
		return 0x70;
	else
		return 0x72;
}

2349
static void
2350 2351
intel_sdvo_connector_init(struct intel_sdvo_connector *connector,
			  struct intel_sdvo *encoder)
2352
{
2353 2354 2355 2356
	drm_connector_init(encoder->base.base.dev,
			   &connector->base.base,
			   &intel_sdvo_connector_funcs,
			   connector->base.base.connector_type);
2357

2358 2359
	drm_connector_helper_add(&connector->base.base,
				 &intel_sdvo_connector_helper_funcs);
2360

2361
	connector->base.base.interlace_allowed = 1;
2362 2363
	connector->base.base.doublescan_allowed = 0;
	connector->base.base.display_info.subpixel_order = SubPixelHorizontalRGB;
2364
	connector->base.get_hw_state = intel_sdvo_connector_get_hw_state;
2365

2366 2367
	intel_connector_attach_encoder(&connector->base, &encoder->base);
	drm_sysfs_connector_add(&connector->base.base);
2368
}
2369

2370
static void
2371 2372
intel_sdvo_add_hdmi_properties(struct intel_sdvo *intel_sdvo,
			       struct intel_sdvo_connector *connector)
2373 2374 2375
{
	struct drm_device *dev = connector->base.base.dev;

2376
	intel_attach_force_audio_property(&connector->base.base);
2377
	if (INTEL_INFO(dev)->gen >= 4 && IS_MOBILE(dev)) {
2378
		intel_attach_broadcast_rgb_property(&connector->base.base);
2379 2380
		intel_sdvo->color_range_auto = true;
	}
2381 2382
}

2383
static bool
C
Chris Wilson 已提交
2384
intel_sdvo_dvi_init(struct intel_sdvo *intel_sdvo, int device)
2385
{
2386
	struct drm_encoder *encoder = &intel_sdvo->base.base;
2387
	struct drm_connector *connector;
2388
	struct intel_encoder *intel_encoder = to_intel_encoder(encoder);
2389
	struct intel_connector *intel_connector;
2390
	struct intel_sdvo_connector *intel_sdvo_connector;
2391

2392 2393
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
2394 2395 2396
		return false;

	if (device == 0) {
C
Chris Wilson 已提交
2397
		intel_sdvo->controlled_output |= SDVO_OUTPUT_TMDS0;
2398
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_TMDS0;
2399
	} else if (device == 1) {
C
Chris Wilson 已提交
2400
		intel_sdvo->controlled_output |= SDVO_OUTPUT_TMDS1;
2401
		intel_sdvo_connector->output_flag = SDVO_OUTPUT_TMDS1;
2402 2403
	}

2404
	intel_connector = &intel_sdvo_connector->base;
2405
	connector = &intel_connector->base;
2406 2407 2408
	if (intel_sdvo_get_hotplug_support(intel_sdvo) &
		intel_sdvo_connector->output_flag) {
		intel_sdvo->hotplug_active |= intel_sdvo_connector->output_flag;
2409 2410 2411 2412 2413
		/* 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);
2414
	} else {
2415
		intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT;
2416
	}
2417 2418 2419
	encoder->encoder_type = DRM_MODE_ENCODER_TMDS;
	connector->connector_type = DRM_MODE_CONNECTOR_DVID;

2420
	if (intel_sdvo_is_hdmi_connector(intel_sdvo, device)) {
2421
		connector->connector_type = DRM_MODE_CONNECTOR_HDMIA;
2422
		intel_sdvo->is_hdmi = true;
2423 2424
	}

2425
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2426
	if (intel_sdvo->is_hdmi)
2427
		intel_sdvo_add_hdmi_properties(intel_sdvo, intel_sdvo_connector);
2428 2429 2430 2431 2432

	return true;
}

static bool
C
Chris Wilson 已提交
2433
intel_sdvo_tv_init(struct intel_sdvo *intel_sdvo, int type)
2434
{
2435 2436 2437 2438
	struct drm_encoder *encoder = &intel_sdvo->base.base;
	struct drm_connector *connector;
	struct intel_connector *intel_connector;
	struct intel_sdvo_connector *intel_sdvo_connector;
2439

2440 2441 2442
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
		return false;
2443

2444
	intel_connector = &intel_sdvo_connector->base;
2445 2446 2447
	connector = &intel_connector->base;
	encoder->encoder_type = DRM_MODE_ENCODER_TVDAC;
	connector->connector_type = DRM_MODE_CONNECTOR_SVIDEO;
2448

2449 2450
	intel_sdvo->controlled_output |= type;
	intel_sdvo_connector->output_flag = type;
2451

2452
	intel_sdvo->is_tv = true;
2453

2454
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2455

2456
	if (!intel_sdvo_tv_create_property(intel_sdvo, intel_sdvo_connector, type))
2457
		goto err;
2458

2459
	if (!intel_sdvo_create_enhance_property(intel_sdvo, intel_sdvo_connector))
2460
		goto err;
2461

2462
	return true;
2463 2464

err:
2465
	intel_sdvo_destroy(connector);
2466
	return false;
2467 2468 2469
}

static bool
C
Chris Wilson 已提交
2470
intel_sdvo_analog_init(struct intel_sdvo *intel_sdvo, int device)
2471
{
2472 2473 2474 2475
	struct drm_encoder *encoder = &intel_sdvo->base.base;
	struct drm_connector *connector;
	struct intel_connector *intel_connector;
	struct intel_sdvo_connector *intel_sdvo_connector;
2476

2477 2478 2479
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
		return false;
2480

2481
	intel_connector = &intel_sdvo_connector->base;
2482
	connector = &intel_connector->base;
2483
	intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT;
2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494
	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;
	}

2495 2496
	intel_sdvo_connector_init(intel_sdvo_connector,
				  intel_sdvo);
2497
	return true;
2498 2499 2500
}

static bool
C
Chris Wilson 已提交
2501
intel_sdvo_lvds_init(struct intel_sdvo *intel_sdvo, int device)
2502
{
2503 2504 2505 2506
	struct drm_encoder *encoder = &intel_sdvo->base.base;
	struct drm_connector *connector;
	struct intel_connector *intel_connector;
	struct intel_sdvo_connector *intel_sdvo_connector;
2507

2508 2509 2510
	intel_sdvo_connector = kzalloc(sizeof(struct intel_sdvo_connector), GFP_KERNEL);
	if (!intel_sdvo_connector)
		return false;
2511

2512 2513
	intel_connector = &intel_sdvo_connector->base;
	connector = &intel_connector->base;
2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524
	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;
	}

2525
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2526
	if (!intel_sdvo_create_enhance_property(intel_sdvo, intel_sdvo_connector))
2527 2528 2529 2530 2531
		goto err;

	return true;

err:
2532
	intel_sdvo_destroy(connector);
2533
	return false;
2534 2535 2536
}

static bool
C
Chris Wilson 已提交
2537
intel_sdvo_output_setup(struct intel_sdvo *intel_sdvo, uint16_t flags)
2538
{
C
Chris Wilson 已提交
2539 2540
	intel_sdvo->is_tv = false;
	intel_sdvo->is_lvds = false;
2541

2542
	/* SDVO requires XXX1 function may not exist unless it has XXX0 function.*/
2543

2544
	if (flags & SDVO_OUTPUT_TMDS0)
C
Chris Wilson 已提交
2545
		if (!intel_sdvo_dvi_init(intel_sdvo, 0))
2546 2547 2548
			return false;

	if ((flags & SDVO_TMDS_MASK) == SDVO_TMDS_MASK)
C
Chris Wilson 已提交
2549
		if (!intel_sdvo_dvi_init(intel_sdvo, 1))
2550 2551 2552
			return false;

	/* TV has no XXX1 function block */
2553
	if (flags & SDVO_OUTPUT_SVID0)
C
Chris Wilson 已提交
2554
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_SVID0))
2555 2556 2557
			return false;

	if (flags & SDVO_OUTPUT_CVBS0)
C
Chris Wilson 已提交
2558
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_CVBS0))
2559
			return false;
2560

2561 2562 2563 2564
	if (flags & SDVO_OUTPUT_YPRPB0)
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_YPRPB0))
			return false;

2565
	if (flags & SDVO_OUTPUT_RGB0)
C
Chris Wilson 已提交
2566
		if (!intel_sdvo_analog_init(intel_sdvo, 0))
2567 2568 2569
			return false;

	if ((flags & SDVO_RGB_MASK) == SDVO_RGB_MASK)
C
Chris Wilson 已提交
2570
		if (!intel_sdvo_analog_init(intel_sdvo, 1))
2571 2572 2573
			return false;

	if (flags & SDVO_OUTPUT_LVDS0)
C
Chris Wilson 已提交
2574
		if (!intel_sdvo_lvds_init(intel_sdvo, 0))
2575 2576 2577
			return false;

	if ((flags & SDVO_LVDS_MASK) == SDVO_LVDS_MASK)
C
Chris Wilson 已提交
2578
		if (!intel_sdvo_lvds_init(intel_sdvo, 1))
2579
			return false;
2580

2581
	if ((flags & SDVO_OUTPUT_MASK) == 0) {
2582 2583
		unsigned char bytes[2];

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

2593
	return true;
2594 2595
}

2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607
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);
	}
}

2608 2609 2610
static bool intel_sdvo_tv_create_property(struct intel_sdvo *intel_sdvo,
					  struct intel_sdvo_connector *intel_sdvo_connector,
					  int type)
2611
{
2612
	struct drm_device *dev = intel_sdvo->base.base.dev;
2613 2614 2615
	struct intel_sdvo_tv_format format;
	uint32_t format_map, i;

2616 2617
	if (!intel_sdvo_set_target_output(intel_sdvo, type))
		return false;
2618

2619
	BUILD_BUG_ON(sizeof(format) != 6);
2620 2621 2622 2623
	if (!intel_sdvo_get_value(intel_sdvo,
				  SDVO_CMD_GET_SUPPORTED_TV_FORMATS,
				  &format, sizeof(format)))
		return false;
2624

2625
	memcpy(&format_map, &format, min(sizeof(format_map), sizeof(format)));
2626 2627

	if (format_map == 0)
2628
		return false;
2629

2630
	intel_sdvo_connector->format_supported_num = 0;
2631
	for (i = 0 ; i < TV_FORMAT_NUM; i++)
2632 2633
		if (format_map & (1 << i))
			intel_sdvo_connector->tv_format_supported[intel_sdvo_connector->format_supported_num++] = i;
2634 2635


2636
	intel_sdvo_connector->tv_format =
2637 2638
			drm_property_create(dev, DRM_MODE_PROP_ENUM,
					    "mode", intel_sdvo_connector->format_supported_num);
2639
	if (!intel_sdvo_connector->tv_format)
2640
		return false;
2641

2642
	for (i = 0; i < intel_sdvo_connector->format_supported_num; i++)
2643
		drm_property_add_enum(
2644
				intel_sdvo_connector->tv_format, i,
2645
				i, tv_format_names[intel_sdvo_connector->tv_format_supported[i]]);
2646

2647
	intel_sdvo->tv_format_index = intel_sdvo_connector->tv_format_supported[0];
2648
	drm_object_attach_property(&intel_sdvo_connector->base.base.base,
2649
				      intel_sdvo_connector->tv_format, 0);
2650
	return true;
2651 2652 2653

}

2654 2655 2656 2657 2658 2659 2660 2661
#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 = \
2662
			drm_property_create_range(dev, 0, #name, 0, data_value[0]); \
2663
		if (!intel_sdvo_connector->name) return false; \
2664
		drm_object_attach_property(&connector->base, \
2665 2666 2667 2668 2669
					      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); \
	} \
2670
} while (0)
2671 2672 2673 2674 2675

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)
2676
{
2677
	struct drm_device *dev = intel_sdvo->base.base.dev;
2678
	struct drm_connector *connector = &intel_sdvo_connector->base.base;
2679 2680
	uint16_t response, data_value[2];

2681 2682 2683 2684 2685 2686
	/* 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;
2687

2688 2689 2690 2691
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_OVERSCAN_H,
					  &response, 2))
			return false;
2692

2693 2694 2695 2696
		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 =
2697
			drm_property_create_range(dev, 0, "left_margin", 0, data_value[0]);
2698 2699
		if (!intel_sdvo_connector->left)
			return false;
2700

2701
		drm_object_attach_property(&connector->base,
2702 2703
					      intel_sdvo_connector->left,
					      intel_sdvo_connector->left_margin);
2704

2705
		intel_sdvo_connector->right =
2706
			drm_property_create_range(dev, 0, "right_margin", 0, data_value[0]);
2707 2708
		if (!intel_sdvo_connector->right)
			return false;
2709

2710
		drm_object_attach_property(&connector->base,
2711 2712 2713 2714 2715 2716
					      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);
	}
2717

2718 2719 2720 2721 2722
	if (enhancements.overscan_v) {
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_MAX_OVERSCAN_V,
					  &data_value, 4))
			return false;
2723

2724 2725 2726 2727
		if (!intel_sdvo_get_value(intel_sdvo,
					  SDVO_CMD_GET_OVERSCAN_V,
					  &response, 2))
			return false;
2728

2729 2730 2731 2732
		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 =
2733 2734
			drm_property_create_range(dev, 0,
					    "top_margin", 0, data_value[0]);
2735 2736
		if (!intel_sdvo_connector->top)
			return false;
2737

2738
		drm_object_attach_property(&connector->base,
2739 2740
					      intel_sdvo_connector->top,
					      intel_sdvo_connector->top_margin);
2741

2742
		intel_sdvo_connector->bottom =
2743 2744
			drm_property_create_range(dev, 0,
					    "bottom_margin", 0, data_value[0]);
2745 2746
		if (!intel_sdvo_connector->bottom)
			return false;
2747

2748
		drm_object_attach_property(&connector->base,
2749 2750 2751 2752 2753 2754
					      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);
	}
2755

2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767
	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);
2768

2769 2770 2771 2772 2773 2774 2775
	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 =
2776
			drm_property_create_range(dev, 0, "dot_crawl", 0, 1);
2777 2778 2779
		if (!intel_sdvo_connector->dot_crawl)
			return false;

2780
		drm_object_attach_property(&connector->base,
2781 2782 2783 2784 2785
					      intel_sdvo_connector->dot_crawl,
					      intel_sdvo_connector->cur_dot_crawl);
		DRM_DEBUG_KMS("dot crawl: current %d\n", response);
	}

2786 2787
	return true;
}
2788

2789 2790 2791 2792 2793
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)
{
2794
	struct drm_device *dev = intel_sdvo->base.base.dev;
2795 2796
	struct drm_connector *connector = &intel_sdvo_connector->base.base;
	uint16_t response, data_value[2];
2797

2798
	ENHANCEMENT(brightness, BRIGHTNESS);
2799

2800 2801 2802
	return true;
}
#undef ENHANCEMENT
2803

2804 2805 2806 2807 2808 2809 2810
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;
2811

2812 2813
	BUILD_BUG_ON(sizeof(enhancements) != 2);

2814 2815 2816 2817
	enhancements.response = 0;
	intel_sdvo_get_value(intel_sdvo,
			     SDVO_CMD_GET_SUPPORTED_ENHANCEMENTS,
			     &enhancements, sizeof(enhancements));
2818 2819 2820
	if (enhancements.response == 0) {
		DRM_DEBUG_KMS("No enhancement is supported\n");
		return true;
2821
	}
2822

2823 2824
	if (IS_TV(intel_sdvo_connector))
		return intel_sdvo_create_enhance_property_tv(intel_sdvo, intel_sdvo_connector, enhancements.reply);
2825
	else if (IS_LVDS(intel_sdvo_connector))
2826 2827 2828
		return intel_sdvo_create_enhance_property_lvds(intel_sdvo, intel_sdvo_connector, enhancements.reply);
	else
		return true;
C
Chris Wilson 已提交
2829 2830 2831 2832 2833 2834 2835
}

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

C
Chris Wilson 已提交
2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865
	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;
2866 2867
}

2868
bool intel_sdvo_init(struct drm_device *dev, uint32_t sdvo_reg, bool is_sdvob)
J
Jesse Barnes 已提交
2869
{
2870
	struct drm_i915_private *dev_priv = dev->dev_private;
2871
	struct intel_encoder *intel_encoder;
C
Chris Wilson 已提交
2872
	struct intel_sdvo *intel_sdvo;
J
Jesse Barnes 已提交
2873
	int i;
C
Chris Wilson 已提交
2874 2875
	intel_sdvo = kzalloc(sizeof(struct intel_sdvo), GFP_KERNEL);
	if (!intel_sdvo)
2876
		return false;
J
Jesse Barnes 已提交
2877

2878
	intel_sdvo->sdvo_reg = sdvo_reg;
2879 2880
	intel_sdvo->is_sdvob = is_sdvob;
	intel_sdvo->slave_addr = intel_sdvo_get_slave_addr(dev, intel_sdvo) >> 1;
2881
	intel_sdvo_select_i2c_bus(dev_priv, intel_sdvo, sdvo_reg);
2882 2883
	if (!intel_sdvo_init_ddc_proxy(intel_sdvo, dev))
		goto err_i2c_bus;
C
Chris Wilson 已提交
2884

2885
	/* encoder type will be decided later */
C
Chris Wilson 已提交
2886
	intel_encoder = &intel_sdvo->base;
2887
	intel_encoder->type = INTEL_OUTPUT_SDVO;
2888
	drm_encoder_init(dev, &intel_encoder->base, &intel_sdvo_enc_funcs, 0);
J
Jesse Barnes 已提交
2889 2890 2891

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

		if (!intel_sdvo_read_byte(intel_sdvo, i, &byte)) {
2895 2896
			DRM_DEBUG_KMS("No SDVO device found on %s\n",
				      SDVO_NAME(intel_sdvo));
2897
			goto err;
J
Jesse Barnes 已提交
2898 2899 2900
		}
	}

2901
	intel_encoder->compute_config = intel_sdvo_compute_config;
2902
	intel_encoder->disable = intel_disable_sdvo;
2903
	intel_encoder->mode_set = intel_sdvo_mode_set;
2904
	intel_encoder->enable = intel_enable_sdvo;
2905
	intel_encoder->get_hw_state = intel_sdvo_get_hw_state;
2906
	intel_encoder->get_config = intel_sdvo_get_config;
2907

2908
	/* In default case sdvo lvds is false */
2909
	if (!intel_sdvo_get_capabilities(intel_sdvo, &intel_sdvo->caps))
2910
		goto err;
J
Jesse Barnes 已提交
2911

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

2920 2921 2922 2923 2924 2925 2926 2927
	/* 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 已提交
2928 2929 2930 2931 2932 2933 2934 2935 2936 2937
	/*
	 * 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 已提交
2938
	intel_sdvo_select_ddc_bus(dev_priv, intel_sdvo, sdvo_reg);
2939

J
Jesse Barnes 已提交
2940
	/* Set the input timing to the screen. Assume always input 0. */
2941
	if (!intel_sdvo_set_target_input(intel_sdvo))
2942
		goto err_output;
J
Jesse Barnes 已提交
2943

2944 2945 2946
	if (!intel_sdvo_get_input_pixel_clock_range(intel_sdvo,
						    &intel_sdvo->pixel_clock_min,
						    &intel_sdvo->pixel_clock_max))
2947
		goto err_output;
J
Jesse Barnes 已提交
2948

2949
	DRM_DEBUG_KMS("%s device VID/DID: %02X:%02X.%02X, "
2950 2951 2952
			"clock range %dMHz - %dMHz, "
			"input 1: %c, input 2: %c, "
			"output 1: %c, output 2: %c\n",
C
Chris Wilson 已提交
2953 2954 2955 2956 2957 2958 2959
			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',
2960
			/* check currently supported outputs */
C
Chris Wilson 已提交
2961
			intel_sdvo->caps.output_flags &
J
Jesse Barnes 已提交
2962
			(SDVO_OUTPUT_TMDS0 | SDVO_OUTPUT_RGB0) ? 'Y' : 'N',
C
Chris Wilson 已提交
2963
			intel_sdvo->caps.output_flags &
J
Jesse Barnes 已提交
2964
			(SDVO_OUTPUT_TMDS1 | SDVO_OUTPUT_RGB1) ? 'Y' : 'N');
2965
	return true;
J
Jesse Barnes 已提交
2966

2967 2968 2969
err_output:
	intel_sdvo_output_cleanup(intel_sdvo);

2970
err:
2971
	drm_encoder_cleanup(&intel_encoder->base);
C
Chris Wilson 已提交
2972
	i2c_del_adapter(&intel_sdvo->ddc);
2973 2974
err_i2c_bus:
	intel_sdvo_unselect_i2c_bus(intel_sdvo);
C
Chris Wilson 已提交
2975
	kfree(intel_sdvo);
J
Jesse Barnes 已提交
2976

2977
	return false;
J
Jesse Barnes 已提交
2978
}