[linux-2.6-block.git] / drivers / gpu / drm / i915 / intel_dvo.c

/*
 * Copyright 2006 Dave Airlie <airlied@linux.ie>
 * Copyright © 2006-2007 Intel Corporation
 *
 * 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>
#include <linux/slab.h>
#include <drm/drmP.h>
#include <drm/drm_crtc.h>
#include "intel_drv.h"
#include <drm/i915_drm.h>
#include "i915_drv.h"
#include "dvo.h"

#define SIL164_ADDR	0x38
#define CH7xxx_ADDR	0x76
#define TFP410_ADDR	0x38
#define NS2501_ADDR     0x38

static const struct intel_dvo_device intel_dvo_devices[] = {
	{
		.type = INTEL_DVO_CHIP_TMDS,
		.name = "sil164",
		.dvo_reg = DVOC,
		.slave_addr = SIL164_ADDR,
		.dev_ops = &sil164_ops,
	},
	{
		.type = INTEL_DVO_CHIP_TMDS,
		.name = "ch7xxx",
		.dvo_reg = DVOC,
		.slave_addr = CH7xxx_ADDR,
		.dev_ops = &ch7xxx_ops,
	},
	{
		.type = INTEL_DVO_CHIP_LVDS,
		.name = "ivch",
		.dvo_reg = DVOA,
		.slave_addr = 0x02, /* Might also be 0x44, 0x84, 0xc4 */
		.dev_ops = &ivch_ops,
	},
	{
		.type = INTEL_DVO_CHIP_TMDS,
		.name = "tfp410",
		.dvo_reg = DVOC,
		.slave_addr = TFP410_ADDR,
		.dev_ops = &tfp410_ops,
	},
	{
		.type = INTEL_DVO_CHIP_LVDS,
		.name = "ch7017",
		.dvo_reg = DVOC,
		.slave_addr = 0x75,
		.gpio = GMBUS_PORT_DPB,
		.dev_ops = &ch7017_ops,
	},
	{
	        .type = INTEL_DVO_CHIP_TMDS,
		.name = "ns2501",
		.dvo_reg = DVOC,
		.slave_addr = NS2501_ADDR,
		.dev_ops = &ns2501_ops,
       }
};

struct intel_dvo {
	struct intel_encoder base;

	struct intel_dvo_device dev;

	struct drm_display_mode *panel_fixed_mode;
	bool panel_wants_dither;
};

static struct intel_dvo *enc_to_intel_dvo(struct drm_encoder *encoder)
{
	return container_of(encoder, struct intel_dvo, base.base);
}

static struct intel_dvo *intel_attached_dvo(struct drm_connector *connector)
{
	return container_of(intel_attached_encoder(connector),
			    struct intel_dvo, base);
}

static bool intel_dvo_connector_get_hw_state(struct intel_connector *connector)
{
	struct intel_dvo *intel_dvo = intel_attached_dvo(&connector->base);

	return intel_dvo->dev.dev_ops->get_hw_state(&intel_dvo->dev);
}

static bool intel_dvo_get_hw_state(struct intel_encoder *encoder,
				   enum pipe *pipe)
{
	struct drm_device *dev = encoder->base.dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_dvo *intel_dvo = enc_to_intel_dvo(&encoder->base);
	u32 tmp;

	tmp = I915_READ(intel_dvo->dev.dvo_reg);

	if (!(tmp & DVO_ENABLE))
		return false;

	*pipe = PORT_TO_PIPE(tmp);

	return true;
}

static void intel_disable_dvo(struct intel_encoder *encoder)
{
	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
	struct intel_dvo *intel_dvo = enc_to_intel_dvo(&encoder->base);
	u32 dvo_reg = intel_dvo->dev.dvo_reg;
	u32 temp = I915_READ(dvo_reg);

	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, false);
	I915_WRITE(dvo_reg, temp & ~DVO_ENABLE);
	I915_READ(dvo_reg);
}

static void intel_enable_dvo(struct intel_encoder *encoder)
{
	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
	struct intel_dvo *intel_dvo = enc_to_intel_dvo(&encoder->base);
	u32 dvo_reg = intel_dvo->dev.dvo_reg;
	u32 temp = I915_READ(dvo_reg);

	I915_WRITE(dvo_reg, temp | DVO_ENABLE);
	I915_READ(dvo_reg);
	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, true);
}

static void intel_dvo_dpms(struct drm_connector *connector, int mode)
{
	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
	struct drm_crtc *crtc;

	/* 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_dvo->base.base.crtc;
	if (!crtc) {
		intel_dvo->base.connectors_active = false;
		return;
	}

	if (mode == DRM_MODE_DPMS_ON) {
		intel_dvo->base.connectors_active = true;

		intel_crtc_update_dpms(crtc);

		intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, true);
	} else {
		intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, false);

		intel_dvo->base.connectors_active = false;

		intel_crtc_update_dpms(crtc);
	}

	intel_modeset_check_state(connector->dev);
}

static int intel_dvo_mode_valid(struct drm_connector *connector,
				struct drm_display_mode *mode)
{
	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);

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

	/* XXX: Validate clock range */

	if (intel_dvo->panel_fixed_mode) {
		if (mode->hdisplay > intel_dvo->panel_fixed_mode->hdisplay)
			return MODE_PANEL;
		if (mode->vdisplay > intel_dvo->panel_fixed_mode->vdisplay)
			return MODE_PANEL;
	}

	return intel_dvo->dev.dev_ops->mode_valid(&intel_dvo->dev, mode);
}

static bool intel_dvo_mode_fixup(struct drm_encoder *encoder,
				 const struct drm_display_mode *mode,
				 struct drm_display_mode *adjusted_mode)
{
	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);

	/* If we have timings from the BIOS for the panel, put them in
	 * to the adjusted mode.  The CRTC will be set up for this mode,
	 * with the panel scaling set up to source from the H/VDisplay
	 * of the original mode.
	 */
	if (intel_dvo->panel_fixed_mode != NULL) {
#define C(x) adjusted_mode->x = intel_dvo->panel_fixed_mode->x
		C(hdisplay);
		C(hsync_start);
		C(hsync_end);
		C(htotal);
		C(vdisplay);
		C(vsync_start);
		C(vsync_end);
		C(vtotal);
		C(clock);
#undef C
	}

	if (intel_dvo->dev.dev_ops->mode_fixup)
		return intel_dvo->dev.dev_ops->mode_fixup(&intel_dvo->dev, mode, adjusted_mode);

	return true;
}

static void intel_dvo_mode_set(struct drm_encoder *encoder,
			       struct drm_display_mode *mode,
			       struct drm_display_mode *adjusted_mode)
{
	struct drm_device *dev = encoder->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
	int pipe = intel_crtc->pipe;
	u32 dvo_val;
	u32 dvo_reg = intel_dvo->dev.dvo_reg, dvo_srcdim_reg;
	int dpll_reg = DPLL(pipe);

	switch (dvo_reg) {
	case DVOA:
	default:
		dvo_srcdim_reg = DVOA_SRCDIM;
		break;
	case DVOB:
		dvo_srcdim_reg = DVOB_SRCDIM;
		break;
	case DVOC:
		dvo_srcdim_reg = DVOC_SRCDIM;
		break;
	}

	intel_dvo->dev.dev_ops->mode_set(&intel_dvo->dev, mode, adjusted_mode);

	/* Save the data order, since I don't know what it should be set to. */
	dvo_val = I915_READ(dvo_reg) &
		  (DVO_PRESERVE_MASK | DVO_DATA_ORDER_GBRG);
	dvo_val |= DVO_DATA_ORDER_FP | DVO_BORDER_ENABLE |
		   DVO_BLANK_ACTIVE_HIGH;

	if (pipe == 1)
		dvo_val |= DVO_PIPE_B_SELECT;
	dvo_val |= DVO_PIPE_STALL;
	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
		dvo_val |= DVO_HSYNC_ACTIVE_HIGH;
	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
		dvo_val |= DVO_VSYNC_ACTIVE_HIGH;

	I915_WRITE(dpll_reg, I915_READ(dpll_reg) | DPLL_DVO_HIGH_SPEED);

	/*I915_WRITE(DVOB_SRCDIM,
	  (adjusted_mode->hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
	  (adjusted_mode->VDisplay << DVO_SRCDIM_VERTICAL_SHIFT));*/
	I915_WRITE(dvo_srcdim_reg,
		   (adjusted_mode->hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
		   (adjusted_mode->vdisplay << DVO_SRCDIM_VERTICAL_SHIFT));
	/*I915_WRITE(DVOB, dvo_val);*/
	I915_WRITE(dvo_reg, dvo_val);
}

/**
 * Detect the output connection on our DVO device.
 *
 * Unimplemented.
 */
static enum drm_connector_status
intel_dvo_detect(struct drm_connector *connector, bool force)
{
	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
	return intel_dvo->dev.dev_ops->detect(&intel_dvo->dev);
}

static int intel_dvo_get_modes(struct drm_connector *connector)
{
	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
	struct drm_i915_private *dev_priv = connector->dev->dev_private;

	/* We should probably have an i2c driver get_modes function for those
	 * devices which will have a fixed set of modes determined by the chip
	 * (TV-out, for example), but for now with just TMDS and LVDS,
	 * that's not the case.
	 */
	intel_ddc_get_modes(connector,
			    intel_gmbus_get_adapter(dev_priv, GMBUS_PORT_DPC));
	if (!list_empty(&connector->probed_modes))
		return 1;

	if (intel_dvo->panel_fixed_mode != NULL) {
		struct drm_display_mode *mode;
		mode = drm_mode_duplicate(connector->dev, intel_dvo->panel_fixed_mode);
		if (mode) {
			drm_mode_probed_add(connector, mode);
			return 1;
		}
	}

	return 0;
}

static void intel_dvo_destroy(struct drm_connector *connector)
{
	drm_sysfs_connector_remove(connector);
	drm_connector_cleanup(connector);
	kfree(connector);
}

static const struct drm_encoder_helper_funcs intel_dvo_helper_funcs = {
	.mode_fixup = intel_dvo_mode_fixup,
	.mode_set = intel_dvo_mode_set,
};

static const struct drm_connector_funcs intel_dvo_connector_funcs = {
	.dpms = intel_dvo_dpms,
	.detect = intel_dvo_detect,
	.destroy = intel_dvo_destroy,
	.fill_modes = drm_helper_probe_single_connector_modes,
};

static const struct drm_connector_helper_funcs intel_dvo_connector_helper_funcs = {
	.mode_valid = intel_dvo_mode_valid,
	.get_modes = intel_dvo_get_modes,
	.best_encoder = intel_best_encoder,
};

static void intel_dvo_enc_destroy(struct drm_encoder *encoder)
{
	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);

	if (intel_dvo->dev.dev_ops->destroy)
		intel_dvo->dev.dev_ops->destroy(&intel_dvo->dev);

	kfree(intel_dvo->panel_fixed_mode);

	intel_encoder_destroy(encoder);
}

static const struct drm_encoder_funcs intel_dvo_enc_funcs = {
	.destroy = intel_dvo_enc_destroy,
};

/**
 * Attempts to get a fixed panel timing for LVDS (currently only the i830).
 *
 * Other chips with DVO LVDS will need to extend this to deal with the LVDS
 * chip being on DVOB/C and having multiple pipes.
 */
static struct drm_display_mode *
intel_dvo_get_current_mode(struct drm_connector *connector)
{
	struct drm_device *dev = connector->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
	uint32_t dvo_val = I915_READ(intel_dvo->dev.dvo_reg);
	struct drm_display_mode *mode = NULL;

	/* If the DVO port is active, that'll be the LVDS, so we can pull out
	 * its timings to get how the BIOS set up the panel.
	 */
	if (dvo_val & DVO_ENABLE) {
		struct drm_crtc *crtc;
		int pipe = (dvo_val & DVO_PIPE_B_SELECT) ? 1 : 0;

		crtc = intel_get_crtc_for_pipe(dev, pipe);
		if (crtc) {
			mode = intel_crtc_mode_get(dev, crtc);
			if (mode) {
				mode->type |= DRM_MODE_TYPE_PREFERRED;
				if (dvo_val & DVO_HSYNC_ACTIVE_HIGH)
					mode->flags |= DRM_MODE_FLAG_PHSYNC;
				if (dvo_val & DVO_VSYNC_ACTIVE_HIGH)
					mode->flags |= DRM_MODE_FLAG_PVSYNC;
			}
		}
	}

	return mode;
}

void intel_dvo_init(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct intel_encoder *intel_encoder;
	struct intel_dvo *intel_dvo;
	struct intel_connector *intel_connector;
	int i;
	int encoder_type = DRM_MODE_ENCODER_NONE;

	intel_dvo = kzalloc(sizeof(struct intel_dvo), GFP_KERNEL);
	if (!intel_dvo)
		return;

	intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
	if (!intel_connector) {
		kfree(intel_dvo);
		return;
	}

	intel_encoder = &intel_dvo->base;
	drm_encoder_init(dev, &intel_encoder->base,
			 &intel_dvo_enc_funcs, encoder_type);

	intel_encoder->disable = intel_disable_dvo;
	intel_encoder->enable = intel_enable_dvo;
	intel_encoder->get_hw_state = intel_dvo_get_hw_state;
	intel_connector->get_hw_state = intel_dvo_connector_get_hw_state;

	/* Now, try to find a controller */
	for (i = 0; i < ARRAY_SIZE(intel_dvo_devices); i++) {
		struct drm_connector *connector = &intel_connector->base;
		const struct intel_dvo_device *dvo = &intel_dvo_devices[i];
		struct i2c_adapter *i2c;
		int gpio;

		/* Allow the I2C driver info to specify the GPIO to be used in
		 * special cases, but otherwise default to what's defined
		 * in the spec.
		 */
		if (intel_gmbus_is_port_valid(dvo->gpio))
			gpio = dvo->gpio;
		else if (dvo->type == INTEL_DVO_CHIP_LVDS)
			gpio = GMBUS_PORT_SSC;
		else
			gpio = GMBUS_PORT_DPB;

		/* Set up the I2C bus necessary for the chip we're probing.
		 * It appears that everything is on GPIOE except for panels
		 * on i830 laptops, which are on GPIOB (DVOA).
		 */
		i2c = intel_gmbus_get_adapter(dev_priv, gpio);

		intel_dvo->dev = *dvo;
		if (!dvo->dev_ops->init(&intel_dvo->dev, i2c))
			continue;

		intel_encoder->type = INTEL_OUTPUT_DVO;
		intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
		switch (dvo->type) {
		case INTEL_DVO_CHIP_TMDS:
			intel_encoder->cloneable = true;
			drm_connector_init(dev, connector,
					   &intel_dvo_connector_funcs,
					   DRM_MODE_CONNECTOR_DVII);
			encoder_type = DRM_MODE_ENCODER_TMDS;
			break;
		case INTEL_DVO_CHIP_LVDS:
			intel_encoder->cloneable = false;
			drm_connector_init(dev, connector,
					   &intel_dvo_connector_funcs,
					   DRM_MODE_CONNECTOR_LVDS);
			encoder_type = DRM_MODE_ENCODER_LVDS;
			break;
		}

		drm_connector_helper_add(connector,
					 &intel_dvo_connector_helper_funcs);
		connector->display_info.subpixel_order = SubPixelHorizontalRGB;
		connector->interlace_allowed = false;
		connector->doublescan_allowed = false;

		drm_encoder_helper_add(&intel_encoder->base,
				       &intel_dvo_helper_funcs);

		intel_connector_attach_encoder(intel_connector, intel_encoder);
		if (dvo->type == INTEL_DVO_CHIP_LVDS) {
			/* For our LVDS chipsets, we should hopefully be able
			 * to dig the fixed panel mode out of the BIOS data.
			 * However, it's in a different format from the BIOS
			 * data on chipsets with integrated LVDS (stored in AIM
			 * headers, likely), so for now, just get the current
			 * mode being output through DVO.
			 */
			intel_dvo->panel_fixed_mode =
				intel_dvo_get_current_mode(connector);
			intel_dvo->panel_wants_dither = true;
		}

		drm_sysfs_connector_add(connector);
		return;
	}

	drm_encoder_cleanup(&intel_encoder->base);
	kfree(intel_dvo);
	kfree(intel_connector);
}
Commit	Line	Data
79e53945 JB	1	/*
	2	* Copyright 2006 Dave Airlie <airlied@linux.ie>
	3	* Copyright © 2006-2007 Intel Corporation
	4	*
	5	* Permission is hereby granted, free of charge, to any person obtaining a
	6	* copy of this software and associated documentation files (the "Software"),
	7	* to deal in the Software without restriction, including without limitation
	8	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	9	* and/or sell copies of the Software, and to permit persons to whom the
	10	* Software is furnished to do so, subject to the following conditions:
	11	*
	12	* The above copyright notice and this permission notice (including the next
	13	* paragraph) shall be included in all copies or substantial portions of the
	14	* Software.
	15	*
	16	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	17	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	18	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	19	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	20	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
	21	* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
	22	* DEALINGS IN THE SOFTWARE.
	23	*
	24	* Authors:
	25	* Eric Anholt <eric@anholt.net>
	26	*/
	27	#include <linux/i2c.h>
5a0e3ad6	28	#include <linux/slab.h>
760285e7 DH	29	#include <drm/drmP.h>
760285e7 DH	30	#include <drm/drm_crtc.h>
79e53945	31	#include "intel_drv.h"
760285e7	32	#include <drm/i915_drm.h>
79e53945 JB	33	#include "i915_drv.h"
	34	#include "dvo.h"
	35
	36	#define SIL164_ADDR 0x38
	37	#define CH7xxx_ADDR 0x76
	38	#define TFP410_ADDR 0x38
7434a255	39	#define NS2501_ADDR 0x38
79e53945	40
ea5b213a	41	static const struct intel_dvo_device intel_dvo_devices[] = {
79e53945 JB	42	{
	43	.type = INTEL_DVO_CHIP_TMDS,
	44	.name = "sil164",
	45	.dvo_reg = DVOC,
	46	.slave_addr = SIL164_ADDR,
	47	.dev_ops = &sil164_ops,
	48	},
	49	{
	50	.type = INTEL_DVO_CHIP_TMDS,
	51	.name = "ch7xxx",
	52	.dvo_reg = DVOC,
	53	.slave_addr = CH7xxx_ADDR,
	54	.dev_ops = &ch7xxx_ops,
	55	},
	56	{
	57	.type = INTEL_DVO_CHIP_LVDS,
	58	.name = "ivch",
	59	.dvo_reg = DVOA,
	60	.slave_addr = 0x02, /* Might also be 0x44, 0x84, 0xc4 */
	61	.dev_ops = &ivch_ops,
	62	},
	63	{
	64	.type = INTEL_DVO_CHIP_TMDS,
	65	.name = "tfp410",
	66	.dvo_reg = DVOC,
	67	.slave_addr = TFP410_ADDR,
	68	.dev_ops = &tfp410_ops,
	69	},
	70	{
	71	.type = INTEL_DVO_CHIP_LVDS,
	72	.name = "ch7017",
	73	.dvo_reg = DVOC,
	74	.slave_addr = 0x75,
a6b17b43	75	.gpio = GMBUS_PORT_DPB,
79e53945	76	.dev_ops = &ch7017_ops,
7434a255 TR	77	},
	78	{
	79	.type = INTEL_DVO_CHIP_TMDS,
	80	.name = "ns2501",
	81	.dvo_reg = DVOC,
	82	.slave_addr = NS2501_ADDR,
	83	.dev_ops = &ns2501_ops,
	84	}
79e53945 JB	85	};
79e53945 JB	86
ea5b213a CW	87	struct intel_dvo {
	88	struct intel_encoder base;
	89
	90	struct intel_dvo_device dev;
	91
	92	struct drm_display_mode *panel_fixed_mode;
	93	bool panel_wants_dither;
	94	};
	95
	96	static struct intel_dvo enc_to_intel_dvo(struct drm_encoder encoder)
	97	{
4ef69c7a	98	return container_of(encoder, struct intel_dvo, base.base);
ea5b213a CW	99	}
ea5b213a CW	100
df0e9248 CW	101	static struct intel_dvo intel_attached_dvo(struct drm_connector connector)
	102	{
	103	return container_of(intel_attached_encoder(connector),
	104	struct intel_dvo, base);
	105	}
	106
732ce74f	107	static bool intel_dvo_connector_get_hw_state(struct intel_connector *connector)
79e53945	108	{
732ce74f DV	109	struct intel_dvo *intel_dvo = intel_attached_dvo(&connector->base);
	110
	111	return intel_dvo->dev.dev_ops->get_hw_state(&intel_dvo->dev);
	112	}
	113
	114	static bool intel_dvo_get_hw_state(struct intel_encoder *encoder,
	115	enum pipe *pipe)
	116	{
	117	struct drm_device *dev = encoder->base.dev;
	118	struct drm_i915_private *dev_priv = dev->dev_private;
	119	struct intel_dvo *intel_dvo = enc_to_intel_dvo(&encoder->base);
	120	u32 tmp;
	121
	122	tmp = I915_READ(intel_dvo->dev.dvo_reg);
	123
	124	if (!(tmp & DVO_ENABLE))
	125	return false;
	126
	127	*pipe = PORT_TO_PIPE(tmp);
	128
	129	return true;
	130	}
	131
19c63fa8 DV	132	static void intel_disable_dvo(struct intel_encoder *encoder)
	133	{
	134	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
	135	struct intel_dvo *intel_dvo = enc_to_intel_dvo(&encoder->base);
	136	u32 dvo_reg = intel_dvo->dev.dvo_reg;
	137	u32 temp = I915_READ(dvo_reg);
	138
	139	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, false);
	140	I915_WRITE(dvo_reg, temp & ~DVO_ENABLE);
	141	I915_READ(dvo_reg);
	142	}
	143
	144	static void intel_enable_dvo(struct intel_encoder *encoder)
	145	{
	146	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
	147	struct intel_dvo *intel_dvo = enc_to_intel_dvo(&encoder->base);
ea5b213a	148	u32 dvo_reg = intel_dvo->dev.dvo_reg;
79e53945 JB	149	u32 temp = I915_READ(dvo_reg);
79e53945 JB	150
19c63fa8 DV	151	I915_WRITE(dvo_reg, temp \| DVO_ENABLE);
	152	I915_READ(dvo_reg);
	153	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, true);
	154	}
	155
b2cabb0e	156	static void intel_dvo_dpms(struct drm_connector *connector, int mode)
79e53945	157	{
b2cabb0e DV	158	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
	159	struct drm_crtc *crtc;
	160
	161	/* dvo supports only 2 dpms states. */
	162	if (mode != DRM_MODE_DPMS_ON)
	163	mode = DRM_MODE_DPMS_OFF;
	164
	165	if (mode == connector->dpms)
	166	return;
	167
	168	connector->dpms = mode;
	169
	170	/* Only need to change hw state when actually enabled */
	171	crtc = intel_dvo->base.base.crtc;
	172	if (!crtc) {
	173	intel_dvo->base.connectors_active = false;
	174	return;
	175	}
79e53945 JB	176
79e53945 JB	177	if (mode == DRM_MODE_DPMS_ON) {
b2cabb0e DV	178	intel_dvo->base.connectors_active = true;
	179
	180	intel_crtc_update_dpms(crtc);
	181
fac3274c	182	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, true);
79e53945	183	} else {
fac3274c	184	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, false);
b2cabb0e DV	185
	186	intel_dvo->base.connectors_active = false;
	187
	188	intel_crtc_update_dpms(crtc);
79e53945	189	}
0a91ca29	190
b980514c	191	intel_modeset_check_state(connector->dev);
79e53945 JB	192	}
79e53945 JB	193
79e53945 JB	194	static int intel_dvo_mode_valid(struct drm_connector *connector,
	195	struct drm_display_mode *mode)
	196	{
df0e9248	197	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
79e53945 JB	198
	199	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
	200	return MODE_NO_DBLESCAN;
	201
	202	/* XXX: Validate clock range */
	203
ea5b213a CW	204	if (intel_dvo->panel_fixed_mode) {
ea5b213a CW	205	if (mode->hdisplay > intel_dvo->panel_fixed_mode->hdisplay)
79e53945	206	return MODE_PANEL;
ea5b213a	207	if (mode->vdisplay > intel_dvo->panel_fixed_mode->vdisplay)
79e53945 JB	208	return MODE_PANEL;
	209	}
	210
ea5b213a	211	return intel_dvo->dev.dev_ops->mode_valid(&intel_dvo->dev, mode);
79e53945 JB	212	}
	213
	214	static bool intel_dvo_mode_fixup(struct drm_encoder *encoder,
e811f5ae	215	const struct drm_display_mode *mode,
79e53945 JB	216	struct drm_display_mode *adjusted_mode)
79e53945 JB	217	{
ea5b213a	218	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
79e53945 JB	219
	220	/* If we have timings from the BIOS for the panel, put them in
	221	* to the adjusted mode. The CRTC will be set up for this mode,
	222	* with the panel scaling set up to source from the H/VDisplay
	223	* of the original mode.
	224	*/
ea5b213a CW	225	if (intel_dvo->panel_fixed_mode != NULL) {
ea5b213a CW	226	#define C(x) adjusted_mode->x = intel_dvo->panel_fixed_mode->x
79e53945 JB	227	C(hdisplay);
	228	C(hsync_start);
	229	C(hsync_end);
	230	C(htotal);
	231	C(vdisplay);
	232	C(vsync_start);
	233	C(vsync_end);
	234	C(vtotal);
	235	C(clock);
79e53945 JB	236	#undef C
	237	}
	238
ea5b213a CW	239	if (intel_dvo->dev.dev_ops->mode_fixup)
ea5b213a CW	240	return intel_dvo->dev.dev_ops->mode_fixup(&intel_dvo->dev, mode, adjusted_mode);
79e53945 JB	241
	242	return true;
	243	}
	244
	245	static void intel_dvo_mode_set(struct drm_encoder *encoder,
	246	struct drm_display_mode *mode,
	247	struct drm_display_mode *adjusted_mode)
	248	{
	249	struct drm_device *dev = encoder->dev;
	250	struct drm_i915_private *dev_priv = dev->dev_private;
	251	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
ea5b213a	252	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
79e53945 JB	253	int pipe = intel_crtc->pipe;
79e53945 JB	254	u32 dvo_val;
ea5b213a	255	u32 dvo_reg = intel_dvo->dev.dvo_reg, dvo_srcdim_reg;
9db4a9c7	256	int dpll_reg = DPLL(pipe);
79e53945 JB	257
	258	switch (dvo_reg) {
	259	case DVOA:
	260	default:
	261	dvo_srcdim_reg = DVOA_SRCDIM;
	262	break;
	263	case DVOB:
	264	dvo_srcdim_reg = DVOB_SRCDIM;
	265	break;
	266	case DVOC:
	267	dvo_srcdim_reg = DVOC_SRCDIM;
	268	break;
	269	}
	270
ea5b213a	271	intel_dvo->dev.dev_ops->mode_set(&intel_dvo->dev, mode, adjusted_mode);
79e53945 JB	272
	273	/* Save the data order, since I don't know what it should be set to. */
	274	dvo_val = I915_READ(dvo_reg) &
	275	(DVO_PRESERVE_MASK \| DVO_DATA_ORDER_GBRG);
	276	dvo_val \|= DVO_DATA_ORDER_FP \| DVO_BORDER_ENABLE \|
	277	DVO_BLANK_ACTIVE_HIGH;
	278
	279	if (pipe == 1)
	280	dvo_val \|= DVO_PIPE_B_SELECT;
	281	dvo_val \|= DVO_PIPE_STALL;
	282	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
	283	dvo_val \|= DVO_HSYNC_ACTIVE_HIGH;
	284	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
	285	dvo_val \|= DVO_VSYNC_ACTIVE_HIGH;
	286
	287	I915_WRITE(dpll_reg, I915_READ(dpll_reg) \| DPLL_DVO_HIGH_SPEED);
	288
	289	/*I915_WRITE(DVOB_SRCDIM,
	290	(adjusted_mode->hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) \|
	291	(adjusted_mode->VDisplay << DVO_SRCDIM_VERTICAL_SHIFT));*/
	292	I915_WRITE(dvo_srcdim_reg,
	293	(adjusted_mode->hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) \|
	294	(adjusted_mode->vdisplay << DVO_SRCDIM_VERTICAL_SHIFT));
	295	/I915_WRITE(DVOB, dvo_val);/
	296	I915_WRITE(dvo_reg, dvo_val);
	297	}
	298
	299	/**
	300	* Detect the output connection on our DVO device.
	301	*
	302	* Unimplemented.
	303	*/
7b334fcb	304	static enum drm_connector_status
930a9e28	305	intel_dvo_detect(struct drm_connector *connector, bool force)
79e53945	306	{
df0e9248	307	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
ea5b213a	308	return intel_dvo->dev.dev_ops->detect(&intel_dvo->dev);
79e53945 JB	309	}
	310
	311	static int intel_dvo_get_modes(struct drm_connector *connector)
	312	{
df0e9248	313	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
f899fc64	314	struct drm_i915_private *dev_priv = connector->dev->dev_private;
79e53945 JB	315
	316	/* We should probably have an i2c driver get_modes function for those
	317	* devices which will have a fixed set of modes determined by the chip
	318	* (TV-out, for example), but for now with just TMDS and LVDS,
	319	* that's not the case.
	320	*/
f899fc64	321	intel_ddc_get_modes(connector,
3bd7d909	322	intel_gmbus_get_adapter(dev_priv, GMBUS_PORT_DPC));
79e53945 JB	323	if (!list_empty(&connector->probed_modes))
	324	return 1;
	325
ea5b213a	326	if (intel_dvo->panel_fixed_mode != NULL) {
79e53945	327	struct drm_display_mode *mode;
ea5b213a	328	mode = drm_mode_duplicate(connector->dev, intel_dvo->panel_fixed_mode);
79e53945 JB	329	if (mode) {
	330	drm_mode_probed_add(connector, mode);
	331	return 1;
	332	}
	333	}
ea5b213a	334
79e53945 JB	335	return 0;
	336	}
	337
ea5b213a	338	static void intel_dvo_destroy(struct drm_connector *connector)
79e53945	339	{
79e53945 JB	340	drm_sysfs_connector_remove(connector);
79e53945 JB	341	drm_connector_cleanup(connector);
599be16c	342	kfree(connector);
79e53945	343	}
79e53945 JB	344
79e53945 JB	345	static const struct drm_encoder_helper_funcs intel_dvo_helper_funcs = {
79e53945	346	.mode_fixup = intel_dvo_mode_fixup,
79e53945	347	.mode_set = intel_dvo_mode_set,
79e53945 JB	348	};
	349
	350	static const struct drm_connector_funcs intel_dvo_connector_funcs = {
b2cabb0e	351	.dpms = intel_dvo_dpms,
79e53945 JB	352	.detect = intel_dvo_detect,
	353	.destroy = intel_dvo_destroy,
	354	.fill_modes = drm_helper_probe_single_connector_modes,
	355	};
	356
	357	static const struct drm_connector_helper_funcs intel_dvo_connector_helper_funcs = {
	358	.mode_valid = intel_dvo_mode_valid,
	359	.get_modes = intel_dvo_get_modes,
df0e9248	360	.best_encoder = intel_best_encoder,
79e53945 JB	361	};
79e53945 JB	362
b358d0a6	363	static void intel_dvo_enc_destroy(struct drm_encoder *encoder)
79e53945	364	{
ea5b213a CW	365	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
	366
	367	if (intel_dvo->dev.dev_ops->destroy)
	368	intel_dvo->dev.dev_ops->destroy(&intel_dvo->dev);
	369
	370	kfree(intel_dvo->panel_fixed_mode);
	371
	372	intel_encoder_destroy(encoder);
79e53945 JB	373	}
	374
	375	static const struct drm_encoder_funcs intel_dvo_enc_funcs = {
	376	.destroy = intel_dvo_enc_destroy,
	377	};
	378
79e53945 JB	379	/**
	380	* Attempts to get a fixed panel timing for LVDS (currently only the i830).
	381	*
	382	* Other chips with DVO LVDS will need to extend this to deal with the LVDS
	383	* chip being on DVOB/C and having multiple pipes.
	384	*/
	385	static struct drm_display_mode *
ea5b213a	386	intel_dvo_get_current_mode(struct drm_connector *connector)
79e53945 JB	387	{
	388	struct drm_device *dev = connector->dev;
	389	struct drm_i915_private *dev_priv = dev->dev_private;
df0e9248	390	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
ea5b213a	391	uint32_t dvo_val = I915_READ(intel_dvo->dev.dvo_reg);
79e53945 JB	392	struct drm_display_mode *mode = NULL;
	393
	394	/* If the DVO port is active, that'll be the LVDS, so we can pull out
	395	* its timings to get how the BIOS set up the panel.
	396	*/
	397	if (dvo_val & DVO_ENABLE) {
	398	struct drm_crtc *crtc;
	399	int pipe = (dvo_val & DVO_PIPE_B_SELECT) ? 1 : 0;
	400
f875c15a	401	crtc = intel_get_crtc_for_pipe(dev, pipe);
79e53945 JB	402	if (crtc) {
79e53945 JB	403	mode = intel_crtc_mode_get(dev, crtc);
79e53945 JB	404	if (mode) {
	405	mode->type \|= DRM_MODE_TYPE_PREFERRED;
	406	if (dvo_val & DVO_HSYNC_ACTIVE_HIGH)
	407	mode->flags \|= DRM_MODE_FLAG_PHSYNC;
	408	if (dvo_val & DVO_VSYNC_ACTIVE_HIGH)
	409	mode->flags \|= DRM_MODE_FLAG_PVSYNC;
	410	}
	411	}
	412	}
ea5b213a	413
79e53945 JB	414	return mode;
	415	}
	416
	417	void intel_dvo_init(struct drm_device *dev)
	418	{
f899fc64	419	struct drm_i915_private *dev_priv = dev->dev_private;
21d40d37	420	struct intel_encoder *intel_encoder;
ea5b213a	421	struct intel_dvo *intel_dvo;
599be16c	422	struct intel_connector *intel_connector;
79e53945	423	int i;
79e53945	424	int encoder_type = DRM_MODE_ENCODER_NONE;
ea5b213a CW	425
	426	intel_dvo = kzalloc(sizeof(struct intel_dvo), GFP_KERNEL);
	427	if (!intel_dvo)
79e53945 JB	428	return;
79e53945 JB	429
599be16c ZW	430	intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
599be16c ZW	431	if (!intel_connector) {
ea5b213a	432	kfree(intel_dvo);
599be16c ZW	433	return;
	434	}
	435
ea5b213a	436	intel_encoder = &intel_dvo->base;
373a3cf7 CW	437	drm_encoder_init(dev, &intel_encoder->base,
373a3cf7 CW	438	&intel_dvo_enc_funcs, encoder_type);
ea5b213a	439
19c63fa8 DV	440	intel_encoder->disable = intel_disable_dvo;
19c63fa8 DV	441	intel_encoder->enable = intel_enable_dvo;
732ce74f DV	442	intel_encoder->get_hw_state = intel_dvo_get_hw_state;
732ce74f DV	443	intel_connector->get_hw_state = intel_dvo_connector_get_hw_state;
19c63fa8	444
79e53945 JB	445	/* Now, try to find a controller */
79e53945 JB	446	for (i = 0; i < ARRAY_SIZE(intel_dvo_devices); i++) {
599be16c	447	struct drm_connector *connector = &intel_connector->base;
ea5b213a	448	const struct intel_dvo_device *dvo = &intel_dvo_devices[i];
f899fc64	449	struct i2c_adapter *i2c;
79e53945 JB	450	int gpio;
79e53945 JB	451
79e53945 JB	452	/* Allow the I2C driver info to specify the GPIO to be used in
	453	* special cases, but otherwise default to what's defined
	454	* in the spec.
	455	*/
3bd7d909	456	if (intel_gmbus_is_port_valid(dvo->gpio))
79e53945 JB	457	gpio = dvo->gpio;
79e53945 JB	458	else if (dvo->type == INTEL_DVO_CHIP_LVDS)
f573c660	459	gpio = GMBUS_PORT_SSC;
79e53945	460	else
a6b17b43	461	gpio = GMBUS_PORT_DPB;
79e53945 JB	462
	463	/* Set up the I2C bus necessary for the chip we're probing.
	464	* It appears that everything is on GPIOE except for panels
	465	* on i830 laptops, which are on GPIOB (DVOA).
	466	*/
3bd7d909	467	i2c = intel_gmbus_get_adapter(dev_priv, gpio);
79e53945	468
ea5b213a	469	intel_dvo->dev = *dvo;
f573c660	470	if (!dvo->dev_ops->init(&intel_dvo->dev, i2c))
79e53945 JB	471	continue;
79e53945 JB	472
21d40d37 EA	473	intel_encoder->type = INTEL_OUTPUT_DVO;
21d40d37 EA	474	intel_encoder->crtc_mask = (1 << 0) \| (1 << 1);
79e53945 JB	475	switch (dvo->type) {
79e53945 JB	476	case INTEL_DVO_CHIP_TMDS:
66a9278e	477	intel_encoder->cloneable = true;
79e53945 JB	478	drm_connector_init(dev, connector,
	479	&intel_dvo_connector_funcs,
	480	DRM_MODE_CONNECTOR_DVII);
	481	encoder_type = DRM_MODE_ENCODER_TMDS;
	482	break;
	483	case INTEL_DVO_CHIP_LVDS:
66a9278e	484	intel_encoder->cloneable = false;
79e53945 JB	485	drm_connector_init(dev, connector,
	486	&intel_dvo_connector_funcs,
	487	DRM_MODE_CONNECTOR_LVDS);
	488	encoder_type = DRM_MODE_ENCODER_LVDS;
	489	break;
	490	}
	491
	492	drm_connector_helper_add(connector,
	493	&intel_dvo_connector_helper_funcs);
	494	connector->display_info.subpixel_order = SubPixelHorizontalRGB;
	495	connector->interlace_allowed = false;
	496	connector->doublescan_allowed = false;
	497
4ef69c7a	498	drm_encoder_helper_add(&intel_encoder->base,
79e53945 JB	499	&intel_dvo_helper_funcs);
79e53945 JB	500
df0e9248	501	intel_connector_attach_encoder(intel_connector, intel_encoder);
79e53945 JB	502	if (dvo->type == INTEL_DVO_CHIP_LVDS) {
	503	/* For our LVDS chipsets, we should hopefully be able
	504	* to dig the fixed panel mode out of the BIOS data.
	505	* However, it's in a different format from the BIOS
	506	* data on chipsets with integrated LVDS (stored in AIM
	507	* headers, likely), so for now, just get the current
	508	* mode being output through DVO.
	509	*/
ea5b213a	510	intel_dvo->panel_fixed_mode =
79e53945	511	intel_dvo_get_current_mode(connector);
ea5b213a	512	intel_dvo->panel_wants_dither = true;
79e53945 JB	513	}
	514
	515	drm_sysfs_connector_add(connector);
	516	return;
	517	}
	518
373a3cf7	519	drm_encoder_cleanup(&intel_encoder->base);
ea5b213a	520	kfree(intel_dvo);
599be16c	521	kfree(intel_connector);
79e53945	522	}