Linux Audio

Check our new training course

Loading...
v3.1
  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>
 28#include <linux/slab.h>
 29#include "drmP.h"
 30#include "drm.h"
 31#include "drm_crtc.h"
 32#include "intel_drv.h"
 33#include "i915_drm.h"
 34#include "i915_drv.h"
 35#include "dvo.h"
 36
 37#define SIL164_ADDR	0x38
 38#define CH7xxx_ADDR	0x76
 39#define TFP410_ADDR	0x38
 
 40
 41static const struct intel_dvo_device intel_dvo_devices[] = {
 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,
 75		.gpio = GMBUS_PORT_DPB,
 76		.dev_ops = &ch7017_ops,
 77	}
 
 
 
 
 
 
 
 
 78};
 79
 80struct intel_dvo {
 81	struct intel_encoder base;
 82
 83	struct intel_dvo_device dev;
 84
 85	struct drm_display_mode *panel_fixed_mode;
 
 86	bool panel_wants_dither;
 87};
 88
 89static struct intel_dvo *enc_to_intel_dvo(struct drm_encoder *encoder)
 90{
 91	return container_of(encoder, struct intel_dvo, base.base);
 92}
 93
 94static struct intel_dvo *intel_attached_dvo(struct drm_connector *connector)
 95{
 96	return container_of(intel_attached_encoder(connector),
 97			    struct intel_dvo, base);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 98}
 99
100static void intel_dvo_dpms(struct drm_encoder *encoder, int mode)
 
101{
102	struct drm_i915_private *dev_priv = encoder->dev->dev_private;
103	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
104	u32 dvo_reg = intel_dvo->dev.dvo_reg;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
105	u32 temp = I915_READ(dvo_reg);
106
107	if (mode == DRM_MODE_DPMS_ON) {
108		I915_WRITE(dvo_reg, temp | DVO_ENABLE);
109		I915_READ(dvo_reg);
110		intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, mode);
111	} else {
112		intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, mode);
113		I915_WRITE(dvo_reg, temp & ~DVO_ENABLE);
114		I915_READ(dvo_reg);
115	}
116}
117
118static int intel_dvo_mode_valid(struct drm_connector *connector,
119				struct drm_display_mode *mode)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
120{
121	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
 
 
 
 
122
123	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
124		return MODE_NO_DBLESCAN;
125
126	/* XXX: Validate clock range */
127
128	if (intel_dvo->panel_fixed_mode) {
129		if (mode->hdisplay > intel_dvo->panel_fixed_mode->hdisplay)
130			return MODE_PANEL;
131		if (mode->vdisplay > intel_dvo->panel_fixed_mode->vdisplay)
132			return MODE_PANEL;
 
 
133	}
134
 
 
 
135	return intel_dvo->dev.dev_ops->mode_valid(&intel_dvo->dev, mode);
136}
137
138static bool intel_dvo_mode_fixup(struct drm_encoder *encoder,
139				 struct drm_display_mode *mode,
140				 struct drm_display_mode *adjusted_mode)
141{
142	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
 
 
 
143
144	/* If we have timings from the BIOS for the panel, put them in
145	 * to the adjusted mode.  The CRTC will be set up for this mode,
146	 * with the panel scaling set up to source from the H/VDisplay
147	 * of the original mode.
148	 */
149	if (intel_dvo->panel_fixed_mode != NULL) {
150#define C(x) adjusted_mode->x = intel_dvo->panel_fixed_mode->x
151		C(hdisplay);
152		C(hsync_start);
153		C(hsync_end);
154		C(htotal);
155		C(vdisplay);
156		C(vsync_start);
157		C(vsync_end);
158		C(vtotal);
159		C(clock);
160		drm_mode_set_crtcinfo(adjusted_mode, CRTC_INTERLACE_HALVE_V);
161#undef C
162	}
163
164	if (intel_dvo->dev.dev_ops->mode_fixup)
165		return intel_dvo->dev.dev_ops->mode_fixup(&intel_dvo->dev, mode, adjusted_mode);
166
167	return true;
168}
169
170static void intel_dvo_mode_set(struct drm_encoder *encoder,
171			       struct drm_display_mode *mode,
172			       struct drm_display_mode *adjusted_mode)
173{
174	struct drm_device *dev = encoder->dev;
175	struct drm_i915_private *dev_priv = dev->dev_private;
176	struct intel_crtc *intel_crtc = to_intel_crtc(encoder->crtc);
177	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
178	int pipe = intel_crtc->pipe;
 
179	u32 dvo_val;
180	u32 dvo_reg = intel_dvo->dev.dvo_reg, dvo_srcdim_reg;
181	int dpll_reg = DPLL(pipe);
182
183	switch (dvo_reg) {
184	case DVOA:
185	default:
186		dvo_srcdim_reg = DVOA_SRCDIM;
187		break;
188	case DVOB:
189		dvo_srcdim_reg = DVOB_SRCDIM;
190		break;
191	case DVOC:
192		dvo_srcdim_reg = DVOC_SRCDIM;
193		break;
194	}
195
196	intel_dvo->dev.dev_ops->mode_set(&intel_dvo->dev, mode, adjusted_mode);
197
198	/* Save the data order, since I don't know what it should be set to. */
199	dvo_val = I915_READ(dvo_reg) &
200		  (DVO_PRESERVE_MASK | DVO_DATA_ORDER_GBRG);
201	dvo_val |= DVO_DATA_ORDER_FP | DVO_BORDER_ENABLE |
202		   DVO_BLANK_ACTIVE_HIGH;
203
204	if (pipe == 1)
205		dvo_val |= DVO_PIPE_B_SELECT;
206	dvo_val |= DVO_PIPE_STALL;
207	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
208		dvo_val |= DVO_HSYNC_ACTIVE_HIGH;
209	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
210		dvo_val |= DVO_VSYNC_ACTIVE_HIGH;
211
212	I915_WRITE(dpll_reg, I915_READ(dpll_reg) | DPLL_DVO_HIGH_SPEED);
213
214	/*I915_WRITE(DVOB_SRCDIM,
215	  (adjusted_mode->hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
216	  (adjusted_mode->VDisplay << DVO_SRCDIM_VERTICAL_SHIFT));*/
217	I915_WRITE(dvo_srcdim_reg,
218		   (adjusted_mode->hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
219		   (adjusted_mode->vdisplay << DVO_SRCDIM_VERTICAL_SHIFT));
220	/*I915_WRITE(DVOB, dvo_val);*/
221	I915_WRITE(dvo_reg, dvo_val);
222}
223
224/**
225 * Detect the output connection on our DVO device.
226 *
227 * Unimplemented.
228 */
229static enum drm_connector_status
230intel_dvo_detect(struct drm_connector *connector, bool force)
231{
232	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
 
 
233	return intel_dvo->dev.dev_ops->detect(&intel_dvo->dev);
234}
235
236static int intel_dvo_get_modes(struct drm_connector *connector)
237{
238	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
239	struct drm_i915_private *dev_priv = connector->dev->dev_private;
 
 
240
241	/* We should probably have an i2c driver get_modes function for those
242	 * devices which will have a fixed set of modes determined by the chip
243	 * (TV-out, for example), but for now with just TMDS and LVDS,
244	 * that's not the case.
245	 */
246	intel_ddc_get_modes(connector,
247			    &dev_priv->gmbus[GMBUS_PORT_DPC].adapter);
248	if (!list_empty(&connector->probed_modes))
249		return 1;
250
251	if (intel_dvo->panel_fixed_mode != NULL) {
252		struct drm_display_mode *mode;
253		mode = drm_mode_duplicate(connector->dev, intel_dvo->panel_fixed_mode);
254		if (mode) {
255			drm_mode_probed_add(connector, mode);
256			return 1;
257		}
258	}
259
260	return 0;
261}
262
263static void intel_dvo_destroy(struct drm_connector *connector)
264{
265	drm_sysfs_connector_remove(connector);
266	drm_connector_cleanup(connector);
 
267	kfree(connector);
268}
269
270static const struct drm_encoder_helper_funcs intel_dvo_helper_funcs = {
271	.dpms = intel_dvo_dpms,
272	.mode_fixup = intel_dvo_mode_fixup,
273	.prepare = intel_encoder_prepare,
274	.mode_set = intel_dvo_mode_set,
275	.commit = intel_encoder_commit,
276};
277
278static const struct drm_connector_funcs intel_dvo_connector_funcs = {
279	.dpms = drm_helper_connector_dpms,
280	.detect = intel_dvo_detect,
281	.destroy = intel_dvo_destroy,
282	.fill_modes = drm_helper_probe_single_connector_modes,
 
 
 
283};
284
285static const struct drm_connector_helper_funcs intel_dvo_connector_helper_funcs = {
286	.mode_valid = intel_dvo_mode_valid,
287	.get_modes = intel_dvo_get_modes,
288	.best_encoder = intel_best_encoder,
289};
290
291static void intel_dvo_enc_destroy(struct drm_encoder *encoder)
292{
293	struct intel_dvo *intel_dvo = enc_to_intel_dvo(encoder);
294
295	if (intel_dvo->dev.dev_ops->destroy)
296		intel_dvo->dev.dev_ops->destroy(&intel_dvo->dev);
297
298	kfree(intel_dvo->panel_fixed_mode);
299
300	intel_encoder_destroy(encoder);
301}
302
303static const struct drm_encoder_funcs intel_dvo_enc_funcs = {
304	.destroy = intel_dvo_enc_destroy,
305};
306
307/**
308 * Attempts to get a fixed panel timing for LVDS (currently only the i830).
309 *
310 * Other chips with DVO LVDS will need to extend this to deal with the LVDS
311 * chip being on DVOB/C and having multiple pipes.
312 */
313static struct drm_display_mode *
314intel_dvo_get_current_mode(struct drm_connector *connector)
315{
316	struct drm_device *dev = connector->dev;
317	struct drm_i915_private *dev_priv = dev->dev_private;
318	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
319	uint32_t dvo_val = I915_READ(intel_dvo->dev.dvo_reg);
320	struct drm_display_mode *mode = NULL;
321
322	/* If the DVO port is active, that'll be the LVDS, so we can pull out
323	 * its timings to get how the BIOS set up the panel.
324	 */
325	if (dvo_val & DVO_ENABLE) {
326		struct drm_crtc *crtc;
327		int pipe = (dvo_val & DVO_PIPE_B_SELECT) ? 1 : 0;
328
329		crtc = intel_get_crtc_for_pipe(dev, pipe);
330		if (crtc) {
331			mode = intel_crtc_mode_get(dev, crtc);
332			if (mode) {
333				mode->type |= DRM_MODE_TYPE_PREFERRED;
334				if (dvo_val & DVO_HSYNC_ACTIVE_HIGH)
335					mode->flags |= DRM_MODE_FLAG_PHSYNC;
336				if (dvo_val & DVO_VSYNC_ACTIVE_HIGH)
337					mode->flags |= DRM_MODE_FLAG_PVSYNC;
338			}
339		}
340	}
341
342	return mode;
343}
344
345void intel_dvo_init(struct drm_device *dev)
346{
347	struct drm_i915_private *dev_priv = dev->dev_private;
348	struct intel_encoder *intel_encoder;
349	struct intel_dvo *intel_dvo;
350	struct intel_connector *intel_connector;
351	int i;
352	int encoder_type = DRM_MODE_ENCODER_NONE;
353
354	intel_dvo = kzalloc(sizeof(struct intel_dvo), GFP_KERNEL);
355	if (!intel_dvo)
356		return;
357
358	intel_connector = kzalloc(sizeof(struct intel_connector), GFP_KERNEL);
359	if (!intel_connector) {
360		kfree(intel_dvo);
361		return;
362	}
363
 
 
364	intel_encoder = &intel_dvo->base;
365	drm_encoder_init(dev, &intel_encoder->base,
366			 &intel_dvo_enc_funcs, encoder_type);
 
 
 
 
 
 
 
 
 
367
368	/* Now, try to find a controller */
369	for (i = 0; i < ARRAY_SIZE(intel_dvo_devices); i++) {
370		struct drm_connector *connector = &intel_connector->base;
371		const struct intel_dvo_device *dvo = &intel_dvo_devices[i];
372		struct i2c_adapter *i2c;
373		int gpio;
 
 
 
374
375		/* Allow the I2C driver info to specify the GPIO to be used in
376		 * special cases, but otherwise default to what's defined
377		 * in the spec.
378		 */
379		if (dvo->gpio != 0)
380			gpio = dvo->gpio;
381		else if (dvo->type == INTEL_DVO_CHIP_LVDS)
382			gpio = GMBUS_PORT_SSC;
383		else
384			gpio = GMBUS_PORT_DPB;
385
386		/* Set up the I2C bus necessary for the chip we're probing.
387		 * It appears that everything is on GPIOE except for panels
388		 * on i830 laptops, which are on GPIOB (DVOA).
389		 */
390		i2c = &dev_priv->gmbus[gpio].adapter;
391
392		intel_dvo->dev = *dvo;
393		if (!dvo->dev_ops->init(&intel_dvo->dev, i2c))
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
394			continue;
395
396		intel_encoder->type = INTEL_OUTPUT_DVO;
397		intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
398		switch (dvo->type) {
399		case INTEL_DVO_CHIP_TMDS:
400			intel_encoder->clone_mask =
401				(1 << INTEL_DVO_TMDS_CLONE_BIT) |
402				(1 << INTEL_ANALOG_CLONE_BIT);
403			drm_connector_init(dev, connector,
404					   &intel_dvo_connector_funcs,
405					   DRM_MODE_CONNECTOR_DVII);
406			encoder_type = DRM_MODE_ENCODER_TMDS;
407			break;
408		case INTEL_DVO_CHIP_LVDS:
409			intel_encoder->clone_mask =
410				(1 << INTEL_DVO_LVDS_CLONE_BIT);
411			drm_connector_init(dev, connector,
412					   &intel_dvo_connector_funcs,
413					   DRM_MODE_CONNECTOR_LVDS);
414			encoder_type = DRM_MODE_ENCODER_LVDS;
415			break;
416		}
417
418		drm_connector_helper_add(connector,
419					 &intel_dvo_connector_helper_funcs);
420		connector->display_info.subpixel_order = SubPixelHorizontalRGB;
421		connector->interlace_allowed = false;
422		connector->doublescan_allowed = false;
423
424		drm_encoder_helper_add(&intel_encoder->base,
425				       &intel_dvo_helper_funcs);
426
427		intel_connector_attach_encoder(intel_connector, intel_encoder);
428		if (dvo->type == INTEL_DVO_CHIP_LVDS) {
429			/* For our LVDS chipsets, we should hopefully be able
430			 * to dig the fixed panel mode out of the BIOS data.
431			 * However, it's in a different format from the BIOS
432			 * data on chipsets with integrated LVDS (stored in AIM
433			 * headers, likely), so for now, just get the current
434			 * mode being output through DVO.
435			 */
436			intel_dvo->panel_fixed_mode =
437				intel_dvo_get_current_mode(connector);
 
438			intel_dvo->panel_wants_dither = true;
439		}
440
441		drm_sysfs_connector_add(connector);
442		return;
443	}
444
445	drm_encoder_cleanup(&intel_encoder->base);
446	kfree(intel_dvo);
447	kfree(intel_connector);
448}
v4.6
  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>
 28#include <linux/slab.h>
 29#include <drm/drmP.h>
 30#include <drm/drm_atomic_helper.h>
 31#include <drm/drm_crtc.h>
 32#include "intel_drv.h"
 33#include <drm/i915_drm.h>
 34#include "i915_drv.h"
 35#include "dvo.h"
 36
 37#define SIL164_ADDR	0x38
 38#define CH7xxx_ADDR	0x76
 39#define TFP410_ADDR	0x38
 40#define NS2501_ADDR     0x38
 41
 42static const struct intel_dvo_device intel_dvo_devices[] = {
 43	{
 44		.type = INTEL_DVO_CHIP_TMDS,
 45		.name = "sil164",
 46		.dvo_reg = DVOC,
 47		.dvo_srcdim_reg = DVOC_SRCDIM,
 48		.slave_addr = SIL164_ADDR,
 49		.dev_ops = &sil164_ops,
 50	},
 51	{
 52		.type = INTEL_DVO_CHIP_TMDS,
 53		.name = "ch7xxx",
 54		.dvo_reg = DVOC,
 55		.dvo_srcdim_reg = DVOC_SRCDIM,
 56		.slave_addr = CH7xxx_ADDR,
 57		.dev_ops = &ch7xxx_ops,
 58	},
 59	{
 60		.type = INTEL_DVO_CHIP_TMDS,
 61		.name = "ch7xxx",
 62		.dvo_reg = DVOC,
 63		.dvo_srcdim_reg = DVOC_SRCDIM,
 64		.slave_addr = 0x75, /* For some ch7010 */
 65		.dev_ops = &ch7xxx_ops,
 66	},
 67	{
 68		.type = INTEL_DVO_CHIP_LVDS,
 69		.name = "ivch",
 70		.dvo_reg = DVOA,
 71		.dvo_srcdim_reg = DVOA_SRCDIM,
 72		.slave_addr = 0x02, /* Might also be 0x44, 0x84, 0xc4 */
 73		.dev_ops = &ivch_ops,
 74	},
 75	{
 76		.type = INTEL_DVO_CHIP_TMDS,
 77		.name = "tfp410",
 78		.dvo_reg = DVOC,
 79		.dvo_srcdim_reg = DVOC_SRCDIM,
 80		.slave_addr = TFP410_ADDR,
 81		.dev_ops = &tfp410_ops,
 82	},
 83	{
 84		.type = INTEL_DVO_CHIP_LVDS,
 85		.name = "ch7017",
 86		.dvo_reg = DVOC,
 87		.dvo_srcdim_reg = DVOC_SRCDIM,
 88		.slave_addr = 0x75,
 89		.gpio = GMBUS_PIN_DPB,
 90		.dev_ops = &ch7017_ops,
 91	},
 92	{
 93	        .type = INTEL_DVO_CHIP_TMDS,
 94		.name = "ns2501",
 95		.dvo_reg = DVOB,
 96		.dvo_srcdim_reg = DVOB_SRCDIM,
 97		.slave_addr = NS2501_ADDR,
 98		.dev_ops = &ns2501_ops,
 99       }
100};
101
102struct intel_dvo {
103	struct intel_encoder base;
104
105	struct intel_dvo_device dev;
106
107	struct intel_connector *attached_connector;
108
109	bool panel_wants_dither;
110};
111
112static struct intel_dvo *enc_to_dvo(struct intel_encoder *encoder)
113{
114	return container_of(encoder, struct intel_dvo, base);
115}
116
117static struct intel_dvo *intel_attached_dvo(struct drm_connector *connector)
118{
119	return enc_to_dvo(intel_attached_encoder(connector));
120}
121
122static bool intel_dvo_connector_get_hw_state(struct intel_connector *connector)
123{
124	struct drm_device *dev = connector->base.dev;
125	struct drm_i915_private *dev_priv = dev->dev_private;
126	struct intel_dvo *intel_dvo = intel_attached_dvo(&connector->base);
127	u32 tmp;
128
129	tmp = I915_READ(intel_dvo->dev.dvo_reg);
130
131	if (!(tmp & DVO_ENABLE))
132		return false;
133
134	return intel_dvo->dev.dev_ops->get_hw_state(&intel_dvo->dev);
135}
136
137static bool intel_dvo_get_hw_state(struct intel_encoder *encoder,
138				   enum pipe *pipe)
139{
140	struct drm_device *dev = encoder->base.dev;
141	struct drm_i915_private *dev_priv = dev->dev_private;
142	struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
143	u32 tmp;
144
145	tmp = I915_READ(intel_dvo->dev.dvo_reg);
146
147	if (!(tmp & DVO_ENABLE))
148		return false;
149
150	*pipe = PORT_TO_PIPE(tmp);
151
152	return true;
153}
154
155static void intel_dvo_get_config(struct intel_encoder *encoder,
156				 struct intel_crtc_state *pipe_config)
157{
158	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
159	struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
160	u32 tmp, flags = 0;
161
162	tmp = I915_READ(intel_dvo->dev.dvo_reg);
163	if (tmp & DVO_HSYNC_ACTIVE_HIGH)
164		flags |= DRM_MODE_FLAG_PHSYNC;
165	else
166		flags |= DRM_MODE_FLAG_NHSYNC;
167	if (tmp & DVO_VSYNC_ACTIVE_HIGH)
168		flags |= DRM_MODE_FLAG_PVSYNC;
169	else
170		flags |= DRM_MODE_FLAG_NVSYNC;
171
172	pipe_config->base.adjusted_mode.flags |= flags;
173
174	pipe_config->base.adjusted_mode.crtc_clock = pipe_config->port_clock;
175}
176
177static void intel_disable_dvo(struct intel_encoder *encoder)
178{
179	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
180	struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
181	i915_reg_t dvo_reg = intel_dvo->dev.dvo_reg;
182	u32 temp = I915_READ(dvo_reg);
183
184	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, false);
185	I915_WRITE(dvo_reg, temp & ~DVO_ENABLE);
186	I915_READ(dvo_reg);
 
 
 
 
 
 
187}
188
189static void intel_enable_dvo(struct intel_encoder *encoder)
190{
191	struct drm_i915_private *dev_priv = encoder->base.dev->dev_private;
192	struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
193	struct intel_crtc *crtc = to_intel_crtc(encoder->base.crtc);
194	i915_reg_t dvo_reg = intel_dvo->dev.dvo_reg;
195	u32 temp = I915_READ(dvo_reg);
196
197	intel_dvo->dev.dev_ops->mode_set(&intel_dvo->dev,
198					 &crtc->config->base.mode,
199					 &crtc->config->base.adjusted_mode);
200
201	I915_WRITE(dvo_reg, temp | DVO_ENABLE);
202	I915_READ(dvo_reg);
203
204	intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, true);
205}
206
207static enum drm_mode_status
208intel_dvo_mode_valid(struct drm_connector *connector,
209		     struct drm_display_mode *mode)
210{
211	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
212	const struct drm_display_mode *fixed_mode =
213		to_intel_connector(connector)->panel.fixed_mode;
214	int max_dotclk = to_i915(connector->dev)->max_dotclk_freq;
215	int target_clock = mode->clock;
216
217	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
218		return MODE_NO_DBLESCAN;
219
220	/* XXX: Validate clock range */
221
222	if (fixed_mode) {
223		if (mode->hdisplay > fixed_mode->hdisplay)
224			return MODE_PANEL;
225		if (mode->vdisplay > fixed_mode->vdisplay)
226			return MODE_PANEL;
227
228		target_clock = fixed_mode->clock;
229	}
230
231	if (target_clock > max_dotclk)
232		return MODE_CLOCK_HIGH;
233
234	return intel_dvo->dev.dev_ops->mode_valid(&intel_dvo->dev, mode);
235}
236
237static bool intel_dvo_compute_config(struct intel_encoder *encoder,
238				     struct intel_crtc_state *pipe_config)
 
239{
240	struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
241	const struct drm_display_mode *fixed_mode =
242		intel_dvo->attached_connector->panel.fixed_mode;
243	struct drm_display_mode *adjusted_mode = &pipe_config->base.adjusted_mode;
244
245	/* If we have timings from the BIOS for the panel, put them in
246	 * to the adjusted mode.  The CRTC will be set up for this mode,
247	 * with the panel scaling set up to source from the H/VDisplay
248	 * of the original mode.
249	 */
250	if (fixed_mode)
251		intel_fixed_panel_mode(fixed_mode, adjusted_mode);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
252
253	return true;
254}
255
256static void intel_dvo_pre_enable(struct intel_encoder *encoder)
 
 
257{
258	struct drm_device *dev = encoder->base.dev;
259	struct drm_i915_private *dev_priv = dev->dev_private;
260	struct intel_crtc *crtc = to_intel_crtc(encoder->base.crtc);
261	const struct drm_display_mode *adjusted_mode = &crtc->config->base.adjusted_mode;
262	struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
263	int pipe = crtc->pipe;
264	u32 dvo_val;
265	i915_reg_t dvo_reg = intel_dvo->dev.dvo_reg;
266	i915_reg_t dvo_srcdim_reg = intel_dvo->dev.dvo_srcdim_reg;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
267
268	/* Save the data order, since I don't know what it should be set to. */
269	dvo_val = I915_READ(dvo_reg) &
270		  (DVO_PRESERVE_MASK | DVO_DATA_ORDER_GBRG);
271	dvo_val |= DVO_DATA_ORDER_FP | DVO_BORDER_ENABLE |
272		   DVO_BLANK_ACTIVE_HIGH;
273
274	if (pipe == 1)
275		dvo_val |= DVO_PIPE_B_SELECT;
276	dvo_val |= DVO_PIPE_STALL;
277	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
278		dvo_val |= DVO_HSYNC_ACTIVE_HIGH;
279	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
280		dvo_val |= DVO_VSYNC_ACTIVE_HIGH;
281
 
 
282	/*I915_WRITE(DVOB_SRCDIM,
283	  (adjusted_mode->crtc_hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
284	  (adjusted_mode->crtc_vdisplay << DVO_SRCDIM_VERTICAL_SHIFT));*/
285	I915_WRITE(dvo_srcdim_reg,
286		   (adjusted_mode->crtc_hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
287		   (adjusted_mode->crtc_vdisplay << DVO_SRCDIM_VERTICAL_SHIFT));
288	/*I915_WRITE(DVOB, dvo_val);*/
289	I915_WRITE(dvo_reg, dvo_val);
290}
291
292/**
293 * Detect the output connection on our DVO device.
294 *
295 * Unimplemented.
296 */
297static enum drm_connector_status
298intel_dvo_detect(struct drm_connector *connector, bool force)
299{
300	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
301	DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
302		      connector->base.id, connector->name);
303	return intel_dvo->dev.dev_ops->detect(&intel_dvo->dev);
304}
305
306static int intel_dvo_get_modes(struct drm_connector *connector)
307{
 
308	struct drm_i915_private *dev_priv = connector->dev->dev_private;
309	const struct drm_display_mode *fixed_mode =
310		to_intel_connector(connector)->panel.fixed_mode;
311
312	/* We should probably have an i2c driver get_modes function for those
313	 * devices which will have a fixed set of modes determined by the chip
314	 * (TV-out, for example), but for now with just TMDS and LVDS,
315	 * that's not the case.
316	 */
317	intel_ddc_get_modes(connector,
318			    intel_gmbus_get_adapter(dev_priv, GMBUS_PIN_DPC));
319	if (!list_empty(&connector->probed_modes))
320		return 1;
321
322	if (fixed_mode) {
323		struct drm_display_mode *mode;
324		mode = drm_mode_duplicate(connector->dev, fixed_mode);
325		if (mode) {
326			drm_mode_probed_add(connector, mode);
327			return 1;
328		}
329	}
330
331	return 0;
332}
333
334static void intel_dvo_destroy(struct drm_connector *connector)
335{
 
336	drm_connector_cleanup(connector);
337	intel_panel_fini(&to_intel_connector(connector)->panel);
338	kfree(connector);
339}
340
 
 
 
 
 
 
 
 
341static const struct drm_connector_funcs intel_dvo_connector_funcs = {
342	.dpms = drm_atomic_helper_connector_dpms,
343	.detect = intel_dvo_detect,
344	.destroy = intel_dvo_destroy,
345	.fill_modes = drm_helper_probe_single_connector_modes,
346	.atomic_get_property = intel_connector_atomic_get_property,
347	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
348	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
349};
350
351static const struct drm_connector_helper_funcs intel_dvo_connector_helper_funcs = {
352	.mode_valid = intel_dvo_mode_valid,
353	.get_modes = intel_dvo_get_modes,
354	.best_encoder = intel_best_encoder,
355};
356
357static void intel_dvo_enc_destroy(struct drm_encoder *encoder)
358{
359	struct intel_dvo *intel_dvo = enc_to_dvo(to_intel_encoder(encoder));
360
361	if (intel_dvo->dev.dev_ops->destroy)
362		intel_dvo->dev.dev_ops->destroy(&intel_dvo->dev);
363
 
 
364	intel_encoder_destroy(encoder);
365}
366
367static const struct drm_encoder_funcs intel_dvo_enc_funcs = {
368	.destroy = intel_dvo_enc_destroy,
369};
370
371/**
372 * Attempts to get a fixed panel timing for LVDS (currently only the i830).
373 *
374 * Other chips with DVO LVDS will need to extend this to deal with the LVDS
375 * chip being on DVOB/C and having multiple pipes.
376 */
377static struct drm_display_mode *
378intel_dvo_get_current_mode(struct drm_connector *connector)
379{
380	struct drm_device *dev = connector->dev;
381	struct drm_i915_private *dev_priv = dev->dev_private;
382	struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
383	uint32_t dvo_val = I915_READ(intel_dvo->dev.dvo_reg);
384	struct drm_display_mode *mode = NULL;
385
386	/* If the DVO port is active, that'll be the LVDS, so we can pull out
387	 * its timings to get how the BIOS set up the panel.
388	 */
389	if (dvo_val & DVO_ENABLE) {
390		struct drm_crtc *crtc;
391		int pipe = (dvo_val & DVO_PIPE_B_SELECT) ? 1 : 0;
392
393		crtc = intel_get_crtc_for_pipe(dev, pipe);
394		if (crtc) {
395			mode = intel_crtc_mode_get(dev, crtc);
396			if (mode) {
397				mode->type |= DRM_MODE_TYPE_PREFERRED;
398				if (dvo_val & DVO_HSYNC_ACTIVE_HIGH)
399					mode->flags |= DRM_MODE_FLAG_PHSYNC;
400				if (dvo_val & DVO_VSYNC_ACTIVE_HIGH)
401					mode->flags |= DRM_MODE_FLAG_PVSYNC;
402			}
403		}
404	}
405
406	return mode;
407}
408
409void intel_dvo_init(struct drm_device *dev)
410{
411	struct drm_i915_private *dev_priv = dev->dev_private;
412	struct intel_encoder *intel_encoder;
413	struct intel_dvo *intel_dvo;
414	struct intel_connector *intel_connector;
415	int i;
416	int encoder_type = DRM_MODE_ENCODER_NONE;
417
418	intel_dvo = kzalloc(sizeof(*intel_dvo), GFP_KERNEL);
419	if (!intel_dvo)
420		return;
421
422	intel_connector = intel_connector_alloc();
423	if (!intel_connector) {
424		kfree(intel_dvo);
425		return;
426	}
427
428	intel_dvo->attached_connector = intel_connector;
429
430	intel_encoder = &intel_dvo->base;
431	drm_encoder_init(dev, &intel_encoder->base,
432			 &intel_dvo_enc_funcs, encoder_type, NULL);
433
434	intel_encoder->disable = intel_disable_dvo;
435	intel_encoder->enable = intel_enable_dvo;
436	intel_encoder->get_hw_state = intel_dvo_get_hw_state;
437	intel_encoder->get_config = intel_dvo_get_config;
438	intel_encoder->compute_config = intel_dvo_compute_config;
439	intel_encoder->pre_enable = intel_dvo_pre_enable;
440	intel_connector->get_hw_state = intel_dvo_connector_get_hw_state;
441	intel_connector->unregister = intel_connector_unregister;
442
443	/* Now, try to find a controller */
444	for (i = 0; i < ARRAY_SIZE(intel_dvo_devices); i++) {
445		struct drm_connector *connector = &intel_connector->base;
446		const struct intel_dvo_device *dvo = &intel_dvo_devices[i];
447		struct i2c_adapter *i2c;
448		int gpio;
449		bool dvoinit;
450		enum pipe pipe;
451		uint32_t dpll[I915_MAX_PIPES];
452
453		/* Allow the I2C driver info to specify the GPIO to be used in
454		 * special cases, but otherwise default to what's defined
455		 * in the spec.
456		 */
457		if (intel_gmbus_is_valid_pin(dev_priv, dvo->gpio))
458			gpio = dvo->gpio;
459		else if (dvo->type == INTEL_DVO_CHIP_LVDS)
460			gpio = GMBUS_PIN_SSC;
461		else
462			gpio = GMBUS_PIN_DPB;
463
464		/* Set up the I2C bus necessary for the chip we're probing.
465		 * It appears that everything is on GPIOE except for panels
466		 * on i830 laptops, which are on GPIOB (DVOA).
467		 */
468		i2c = intel_gmbus_get_adapter(dev_priv, gpio);
469
470		intel_dvo->dev = *dvo;
471
472		/* GMBUS NAK handling seems to be unstable, hence let the
473		 * transmitter detection run in bit banging mode for now.
474		 */
475		intel_gmbus_force_bit(i2c, true);
476
477		/* ns2501 requires the DVO 2x clock before it will
478		 * respond to i2c accesses, so make sure we have
479		 * have the clock enabled before we attempt to
480		 * initialize the device.
481		 */
482		for_each_pipe(dev_priv, pipe) {
483			dpll[pipe] = I915_READ(DPLL(pipe));
484			I915_WRITE(DPLL(pipe), dpll[pipe] | DPLL_DVO_2X_MODE);
485		}
486
487		dvoinit = dvo->dev_ops->init(&intel_dvo->dev, i2c);
488
489		/* restore the DVO 2x clock state to original */
490		for_each_pipe(dev_priv, pipe) {
491			I915_WRITE(DPLL(pipe), dpll[pipe]);
492		}
493
494		intel_gmbus_force_bit(i2c, false);
495
496		if (!dvoinit)
497			continue;
498
499		intel_encoder->type = INTEL_OUTPUT_DVO;
500		intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
501		switch (dvo->type) {
502		case INTEL_DVO_CHIP_TMDS:
503			intel_encoder->cloneable = (1 << INTEL_OUTPUT_ANALOG) |
504				(1 << INTEL_OUTPUT_DVO);
 
505			drm_connector_init(dev, connector,
506					   &intel_dvo_connector_funcs,
507					   DRM_MODE_CONNECTOR_DVII);
508			encoder_type = DRM_MODE_ENCODER_TMDS;
509			break;
510		case INTEL_DVO_CHIP_LVDS:
511			intel_encoder->cloneable = 0;
 
512			drm_connector_init(dev, connector,
513					   &intel_dvo_connector_funcs,
514					   DRM_MODE_CONNECTOR_LVDS);
515			encoder_type = DRM_MODE_ENCODER_LVDS;
516			break;
517		}
518
519		drm_connector_helper_add(connector,
520					 &intel_dvo_connector_helper_funcs);
521		connector->display_info.subpixel_order = SubPixelHorizontalRGB;
522		connector->interlace_allowed = false;
523		connector->doublescan_allowed = false;
524
 
 
 
525		intel_connector_attach_encoder(intel_connector, intel_encoder);
526		if (dvo->type == INTEL_DVO_CHIP_LVDS) {
527			/* For our LVDS chipsets, we should hopefully be able
528			 * to dig the fixed panel mode out of the BIOS data.
529			 * However, it's in a different format from the BIOS
530			 * data on chipsets with integrated LVDS (stored in AIM
531			 * headers, likely), so for now, just get the current
532			 * mode being output through DVO.
533			 */
534			intel_panel_init(&intel_connector->panel,
535					 intel_dvo_get_current_mode(connector),
536					 NULL);
537			intel_dvo->panel_wants_dither = true;
538		}
539
540		drm_connector_register(connector);
541		return;
542	}
543
544	drm_encoder_cleanup(&intel_encoder->base);
545	kfree(intel_dvo);
546	kfree(intel_connector);
547}