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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

963 964
static bool intel_sdvo_set_avi_infoframe(struct intel_sdvo *intel_sdvo,
					 const struct drm_display_mode *adjusted_mode)
965 966 967
{
	struct dip_infoframe avi_if = {
		.type = DIP_TYPE_AVI,
968
		.ver = DIP_VERSION_AVI,
969 970
		.len = DIP_LEN_AVI,
	};
971
	uint8_t sdvo_data[4 + sizeof(avi_if.body.avi)];
972
	struct intel_crtc *intel_crtc = to_intel_crtc(intel_sdvo->base.base.crtc);
973

974
	if (intel_sdvo->rgb_quant_range_selectable) {
975
		if (intel_crtc->config.limited_color_range)
976 977 978 979 980
			avi_if.body.avi.ITC_EC_Q_SC |= DIP_AVI_RGB_QUANT_RANGE_LIMITED;
		else
			avi_if.body.avi.ITC_EC_Q_SC |= DIP_AVI_RGB_QUANT_RANGE_FULL;
	}

981 982
	avi_if.body.avi.VIC = drm_match_cea_mode(adjusted_mode);

983 984
	intel_dip_infoframe_csum(&avi_if);

985 986 987 988 989 990
	/* sdvo spec says that the ecc is handled by the hw, and it looks like
	 * we must not send the ecc field, either. */
	memcpy(sdvo_data, &avi_if, 3);
	sdvo_data[3] = avi_if.checksum;
	memcpy(&sdvo_data[4], &avi_if.body, sizeof(avi_if.body.avi));

991 992 993
	return intel_sdvo_write_infoframe(intel_sdvo, SDVO_HBUF_INDEX_AVI_IF,
					  SDVO_HBUF_TX_VSYNC,
					  sdvo_data, sizeof(sdvo_data));
994 995
}

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

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

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

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

1017 1018 1019
	if (!intel_sdvo_set_target_output(intel_sdvo,
					  intel_sdvo->attached_output))
		return false;
1020

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

1025 1026 1027
	return true;
}

1028 1029
/* 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. */
1030
static bool
1031
intel_sdvo_get_preferred_input_mode(struct intel_sdvo *intel_sdvo,
1032
				    const struct drm_display_mode *mode,
1033
				    struct drm_display_mode *adjusted_mode)
1034
{
1035 1036
	struct intel_sdvo_dtd input_dtd;

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

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

1047
	if (!intel_sdvo_get_preferred_input_timing(intel_sdvo,
1048
						   &input_dtd))
1049
		return false;
1050

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

1054 1055
	return true;
}
1056

1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
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;
}

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

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

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

1096 1097 1098 1099 1100 1101 1102 1103
	/* 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;
1104

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

1114 1115 1116
		(void) intel_sdvo_get_preferred_input_mode(intel_sdvo,
							   mode,
							   adjusted_mode);
1117
	}
1118 1119

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

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

1137
	if (intel_sdvo->color_range)
1138
		pipe_config->limited_color_range = true;
1139

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

1144 1145 1146
	return true;
}

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

	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 已提交
1171
	in_out.in0 = intel_sdvo->attached_output;
1172 1173
	in_out.in1 = 0;

1174 1175 1176
	intel_sdvo_set_value(intel_sdvo,
			     SDVO_CMD_SET_IN_OUT_MAP,
			     &in_out, sizeof(in_out));
1177

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

1183 1184 1185 1186 1187 1188
	/* 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);
1189 1190 1191
	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 已提交
1192 1193

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

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

1205 1206 1207
	if (intel_sdvo->is_tv &&
	    !intel_sdvo_set_tv_format(intel_sdvo))
		return;
1208

1209 1210 1211 1212
	/* 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);
1213 1214
	if (intel_sdvo->is_tv || intel_sdvo->is_lvds)
		input_dtd.part2.sdvo_flags = intel_sdvo->dtd_sdvo_flags;
1215 1216 1217
	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 已提交
1218

1219
	switch (intel_crtc->config.pixel_multiplier) {
1220
	default:
1221
		WARN(1, "unknown pixel mutlipler specified\n");
1222 1223 1224
	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 已提交
1225
	}
1226 1227
	if (!intel_sdvo_set_clock_rate_mult(intel_sdvo, rate))
		return;
J
Jesse Barnes 已提交
1228 1229

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

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

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

1259
	if (INTEL_INFO(dev)->gen >= 4) {
1260 1261 1262
		/* 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 已提交
1263
	} else {
1264 1265
		sdvox |= (intel_crtc->config.pixel_multiplier - 1)
			<< SDVO_PORT_MULTIPLY_SHIFT;
J
Jesse Barnes 已提交
1266 1267
	}

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

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

	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 已提交
1293
	struct drm_i915_private *dev_priv = dev->dev_private;
1294
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1295
	u16 active_outputs = 0;
1296 1297 1298
	u32 tmp;

	tmp = I915_READ(intel_sdvo->sdvo_reg);
1299
	intel_sdvo_get_active_outputs(intel_sdvo, &active_outputs);
1300

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

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

	return true;
}

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

	ret = intel_sdvo_get_input_timing(intel_sdvo, &dtd);
	if (!ret) {
1326 1327
		/* Some sdvo encoders are not spec compliant and don't
		 * implement the mandatory get_timings function. */
1328
		DRM_DEBUG_DRIVER("failed to retrieve SDVO DTD\n");
1329 1330 1331 1332 1333 1334
		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;
1335

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

	pipe_config->adjusted_mode.flags |= flags;

1344 1345 1346 1347 1348 1349 1350
	/*
	 * 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.
	 */
1351 1352 1353 1354 1355 1356
	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;
	}
1357

1358
	/* Cross check the port pixel multiplier with the sdvo encoder state. */
1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371
	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;
		}
1372
	}
1373

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

1379 1380 1381
static void intel_disable_sdvo(struct intel_encoder *encoder)
{
	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
1382
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1383 1384 1385 1386 1387 1388 1389 1390 1391
	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) {
1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415
		/* 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);
			}
		}

1416 1417 1418 1419 1420 1421 1422 1423
		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;
1424
	struct intel_sdvo *intel_sdvo = to_sdvo(encoder);
1425
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->base.crtc);
J
Jesse Barnes 已提交
1426
	u32 temp;
1427 1428 1429 1430 1431
	bool input1, input2;
	int i;
	u8 status;

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

1438
		intel_sdvo_write_sdvox(intel_sdvo, temp | SDVO_ENABLE);
1439
	}
1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458
	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);
}

1459
/* Special dpms function to support cloning between dvo/sdvo/crt. */
1460
static void intel_sdvo_dpms(struct drm_connector *connector, int mode)
J
Jesse Barnes 已提交
1461
{
1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
	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 已提交
1480

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

1488 1489 1490
		intel_sdvo->base.connectors_active = false;

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

		intel_crtc_update_dpms(crtc);
J
Jesse Barnes 已提交
1495 1496

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

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

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

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

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

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

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

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

J
Jesse Barnes 已提交
1526 1527 1528
	return MODE_OK;
}

C
Chris Wilson 已提交
1529
static bool intel_sdvo_get_capabilities(struct intel_sdvo *intel_sdvo, struct intel_sdvo_caps *caps)
J
Jesse Barnes 已提交
1530
{
1531
	BUILD_BUG_ON(sizeof(*caps) != 8);
C
Chris Wilson 已提交
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
	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 已提交
1564 1565
}

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

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

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

1580
	return hotplug;
J
Jesse Barnes 已提交
1581 1582
}

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

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

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

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

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

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

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

C
Chris Wilson 已提交
1623
	edid = intel_sdvo_get_edid(connector);
1624

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

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

	/*
	 * 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.
1649
	 */
1650 1651
	if (edid == NULL)
		edid = intel_sdvo_get_analog_edid(connector);
1652

1653
	status = connector_status_unknown;
1654
	if (edid != NULL) {
1655
		/* DDC bus is shared, match EDID to connector type */
1656 1657
		if (edid->input & DRM_EDID_INPUT_DIGITAL) {
			status = connector_status_connected;
1658 1659 1660
			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);
1661 1662
				intel_sdvo->rgb_quant_range_selectable =
					drm_rgb_quant_range_selectable(edid);
1663
			}
1664 1665
		} else
			status = connector_status_disconnected;
1666 1667
		kfree(edid);
	}
1668 1669 1670

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

1675
	return status;
1676 1677
}

1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689
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;
}

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

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

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

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

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

C
Chris Wilson 已提交
1713
	intel_sdvo->attached_output = response;
1714

1715 1716
	intel_sdvo->has_hdmi_monitor = false;
	intel_sdvo->has_hdmi_audio = false;
1717
	intel_sdvo->rgb_quant_range_selectable = false;
1718

1719
	if ((intel_sdvo_connector->output_flag & response) == 0)
1720
		ret = connector_status_disconnected;
1721
	else if (IS_TMDS(intel_sdvo_connector))
1722
		ret = intel_sdvo_tmds_sink_detect(connector);
1723 1724 1725 1726 1727 1728 1729 1730
	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) {
1731 1732
			if (intel_sdvo_connector_matches_edid(intel_sdvo_connector,
							      edid))
1733
				ret = connector_status_connected;
1734 1735 1736
			else
				ret = connector_status_disconnected;

1737 1738 1739 1740
			kfree(edid);
		} else
			ret = connector_status_connected;
	}
1741 1742 1743

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

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

	return ret;
J
Jesse Barnes 已提交
1754 1755
}

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

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

1763 1764 1765 1766 1767
	/*
	 * 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.
1768
	 */
1769 1770 1771
	if (edid == NULL)
		edid = intel_sdvo_get_analog_edid(connector);

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

1779
		kfree(edid);
1780 1781 1782 1783 1784 1785 1786 1787
	}
}

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

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

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

1862 1863
	if (!intel_sdvo_set_target_output(intel_sdvo, intel_sdvo->attached_output))
		return;
1864

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

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

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

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

1904 1905 1906 1907 1908 1909 1910
	/*
	 * 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);

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

1916
			intel_sdvo->is_lvds = true;
1917 1918 1919 1920
			break;
		}
	}

1921 1922
}

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

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

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

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

1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972
	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);
1973 1974
	if (intel_sdvo_connector->dot_crawl)
		drm_property_destroy(dev, intel_sdvo_connector->dot_crawl);
1975 1976
	if (intel_sdvo_connector->brightness)
		drm_property_destroy(dev, intel_sdvo_connector->brightness);
1977 1978
}

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

1983
	if (intel_sdvo_connector->tv_format)
1984
		drm_property_destroy(connector->dev,
1985
				     intel_sdvo_connector->tv_format);
1986

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

1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004
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);
2005
	kfree(edid);
2006 2007 2008 2009

	return has_audio;
}

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

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

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

		if (i == intel_sdvo_connector->force_audio)
2031 2032
			return 0;

2033
		intel_sdvo_connector->force_audio = i;
2034

2035
		if (i == HDMI_AUDIO_AUTO)
2036 2037
			has_audio = intel_sdvo_detect_hdmi_audio(connector);
		else
2038
			has_audio = (i == HDMI_AUDIO_ON);
2039

2040
		if (has_audio == intel_sdvo->has_hdmi_audio)
2041 2042
			return 0;

2043
		intel_sdvo->has_hdmi_audio = has_audio;
2044 2045 2046
		goto done;
	}

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

2051 2052 2053 2054 2055 2056 2057 2058 2059 2060
		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;
2061 2062 2063
			/* 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;
2064 2065 2066 2067
			break;
		default:
			return -EINVAL;
		}
2068 2069 2070 2071 2072

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

2073 2074 2075
		goto done;
	}

2076 2077 2078 2079 2080 2081 2082 2083 2084 2085
#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) {
2086 2087 2088
		if (val >= TV_FORMAT_NUM)
			return -EINVAL;

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

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

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

2115 2116 2117 2118
			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;
2119
			cmd = SDVO_CMD_SET_OVERSCAN_H;
2120 2121
			goto set_value;
		} else if (intel_sdvo_connector->top == property) {
2122
			drm_object_property_set_value(&connector->base,
2123
							 intel_sdvo_connector->bottom, val);
2124
			if (intel_sdvo_connector->top_margin == temp_value)
2125
				return 0;
2126

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

2139 2140 2141
			intel_sdvo_connector->top_margin = temp_value;
			intel_sdvo_connector->bottom_margin = temp_value;
			temp_value = intel_sdvo_connector->max_vscan -
2142
				intel_sdvo_connector->top_margin;
2143
			cmd = SDVO_CMD_SET_OVERSCAN_V;
2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157
			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)
2158
		CHECK_PROPERTY(dot_crawl, DOT_CRAWL)
2159
	}
2160

2161
	return -EINVAL; /* unknown property */
2162

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


2168
done:
2169 2170
	if (intel_sdvo->base.base.crtc)
		intel_crtc_restore_mode(intel_sdvo->base.base.crtc);
2171

2172
	return 0;
2173
#undef CHECK_PROPERTY
2174 2175
}

J
Jesse Barnes 已提交
2176
static const struct drm_connector_funcs intel_sdvo_connector_funcs = {
2177
	.dpms = intel_sdvo_dpms,
J
Jesse Barnes 已提交
2178 2179
	.detect = intel_sdvo_detect,
	.fill_modes = drm_helper_probe_single_connector_modes,
2180
	.set_property = intel_sdvo_set_property,
J
Jesse Barnes 已提交
2181 2182 2183 2184 2185 2186
	.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,
2187
	.best_encoder = intel_best_encoder,
J
Jesse Barnes 已提交
2188 2189
};

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

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

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

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

2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240
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 已提交
2241

2242 2243 2244 2245 2246 2247 2248 2249
/**
 * 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
2250
intel_sdvo_select_ddc_bus(struct drm_i915_private *dev_priv,
C
Chris Wilson 已提交
2251
			  struct intel_sdvo *sdvo, u32 reg)
2252
{
2253
	struct sdvo_device_mapping *mapping;
2254

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

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

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

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

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

2283 2284 2285 2286 2287 2288
	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 已提交
2289 2290
}

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

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

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

2310
	if (sdvo->is_sdvob) {
2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334
		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.
	 */
2335
	if (sdvo->is_sdvob)
2336 2337 2338 2339 2340
		return 0x70;
	else
		return 0x72;
}

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

2350 2351
	drm_connector_helper_add(&connector->base.base,
				 &intel_sdvo_connector_helper_funcs);
2352

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

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

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

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

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

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

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

2396
	intel_connector = &intel_sdvo_connector->base;
2397
	connector = &intel_connector->base;
2398 2399 2400
	if (intel_sdvo_get_hotplug_support(intel_sdvo) &
		intel_sdvo_connector->output_flag) {
		intel_sdvo->hotplug_active |= intel_sdvo_connector->output_flag;
2401 2402 2403 2404 2405
		/* 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);
2406
	} else {
2407
		intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT;
2408
	}
2409 2410 2411
	encoder->encoder_type = DRM_MODE_ENCODER_TMDS;
	connector->connector_type = DRM_MODE_CONNECTOR_DVID;

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

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

	return true;
}

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

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

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

2441 2442
	intel_sdvo->controlled_output |= type;
	intel_sdvo_connector->output_flag = type;
2443

2444
	intel_sdvo->is_tv = true;
2445

2446
	intel_sdvo_connector_init(intel_sdvo_connector, intel_sdvo);
2447

2448
	if (!intel_sdvo_tv_create_property(intel_sdvo, intel_sdvo_connector, type))
2449
		goto err;
2450

2451
	if (!intel_sdvo_create_enhance_property(intel_sdvo, intel_sdvo_connector))
2452
		goto err;
2453

2454
	return true;
2455 2456

err:
2457
	intel_sdvo_destroy(connector);
2458
	return false;
2459 2460 2461
}

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

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

2473
	intel_connector = &intel_sdvo_connector->base;
2474
	connector = &intel_connector->base;
2475
	intel_connector->polled = DRM_CONNECTOR_POLL_CONNECT;
2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486
	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;
	}

2487 2488
	intel_sdvo_connector_init(intel_sdvo_connector,
				  intel_sdvo);
2489
	return true;
2490 2491 2492
}

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

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

2504 2505
	intel_connector = &intel_sdvo_connector->base;
	connector = &intel_connector->base;
2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516
	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;
	}

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

	return true;

err:
2524
	intel_sdvo_destroy(connector);
2525
	return false;
2526 2527 2528
}

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

2534
	/* SDVO requires XXX1 function may not exist unless it has XXX0 function.*/
2535

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

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

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

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

2553 2554 2555 2556
	if (flags & SDVO_OUTPUT_YPRPB0)
		if (!intel_sdvo_tv_init(intel_sdvo, SDVO_OUTPUT_YPRPB0))
			return false;

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

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

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

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

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

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

2585
	return true;
2586 2587
}

2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599
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);
	}
}

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

2608 2609
	if (!intel_sdvo_set_target_output(intel_sdvo, type))
		return false;
2610

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

2617
	memcpy(&format_map, &format, min(sizeof(format_map), sizeof(format)));
2618 2619

	if (format_map == 0)
2620
		return false;
2621

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


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

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

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

}

2646 2647 2648 2649 2650 2651 2652 2653
#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 = \
2654
			drm_property_create_range(dev, 0, #name, 0, data_value[0]); \
2655
		if (!intel_sdvo_connector->name) return false; \
2656
		drm_object_attach_property(&connector->base, \
2657 2658 2659 2660 2661
					      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); \
	} \
2662
} while (0)
2663 2664 2665 2666 2667

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)
2668
{
2669
	struct drm_device *dev = intel_sdvo->base.base.dev;
2670
	struct drm_connector *connector = &intel_sdvo_connector->base.base;
2671 2672
	uint16_t response, data_value[2];

2673 2674 2675 2676 2677 2678
	/* 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;
2679

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

2685 2686 2687 2688
		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 =
2689
			drm_property_create_range(dev, 0, "left_margin", 0, data_value[0]);
2690 2691
		if (!intel_sdvo_connector->left)
			return false;
2692

2693
		drm_object_attach_property(&connector->base,
2694 2695
					      intel_sdvo_connector->left,
					      intel_sdvo_connector->left_margin);
2696

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

2702
		drm_object_attach_property(&connector->base,
2703 2704 2705 2706 2707 2708
					      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);
	}
2709

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

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

2721 2722 2723 2724
		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 =
2725 2726
			drm_property_create_range(dev, 0,
					    "top_margin", 0, data_value[0]);
2727 2728
		if (!intel_sdvo_connector->top)
			return false;
2729

2730
		drm_object_attach_property(&connector->base,
2731 2732
					      intel_sdvo_connector->top,
					      intel_sdvo_connector->top_margin);
2733

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

2740
		drm_object_attach_property(&connector->base,
2741 2742 2743 2744 2745 2746
					      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);
	}
2747

2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759
	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);
2760

2761 2762 2763 2764 2765 2766 2767
	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 =
2768
			drm_property_create_range(dev, 0, "dot_crawl", 0, 1);
2769 2770 2771
		if (!intel_sdvo_connector->dot_crawl)
			return false;

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

2778 2779
	return true;
}
2780

2781 2782 2783 2784 2785
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)
{
2786
	struct drm_device *dev = intel_sdvo->base.base.dev;
2787 2788
	struct drm_connector *connector = &intel_sdvo_connector->base.base;
	uint16_t response, data_value[2];
2789

2790
	ENHANCEMENT(brightness, BRIGHTNESS);
2791

2792 2793 2794
	return true;
}
#undef ENHANCEMENT
2795

2796 2797 2798 2799 2800 2801 2802
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;
2803

2804 2805
	BUILD_BUG_ON(sizeof(enhancements) != 2);

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

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

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

C
Chris Wilson 已提交
2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857
	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;
2858 2859
}

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

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

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

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

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

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

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

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

2912 2913 2914 2915 2916 2917 2918 2919
	/* 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 已提交
2920 2921 2922 2923 2924 2925 2926 2927 2928 2929
	/*
	 * 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 已提交
2930
	intel_sdvo_select_ddc_bus(dev_priv, intel_sdvo, sdvo_reg);
2931

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

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

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

2959 2960 2961
err_output:
	intel_sdvo_output_cleanup(intel_sdvo);

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

2969
	return false;
J
Jesse Barnes 已提交
2970
}