xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/i915/display/dvo_ivch.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Copyright © 2006 Intel Corporation
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Permission is hereby granted, free of charge, to any person obtaining a
5*4882a593Smuzhiyun  * copy of this software and associated documentation files (the "Software"),
6*4882a593Smuzhiyun  * to deal in the Software without restriction, including without limitation
7*4882a593Smuzhiyun  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8*4882a593Smuzhiyun  * and/or sell copies of the Software, and to permit persons to whom the
9*4882a593Smuzhiyun  * Software is furnished to do so, subject to the following conditions:
10*4882a593Smuzhiyun  *
11*4882a593Smuzhiyun  * The above copyright notice and this permission notice (including the next
12*4882a593Smuzhiyun  * paragraph) shall be included in all copies or substantial portions of the
13*4882a593Smuzhiyun  * Software.
14*4882a593Smuzhiyun  *
15*4882a593Smuzhiyun  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16*4882a593Smuzhiyun  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17*4882a593Smuzhiyun  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18*4882a593Smuzhiyun  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19*4882a593Smuzhiyun  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20*4882a593Smuzhiyun  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21*4882a593Smuzhiyun  * DEALINGS IN THE SOFTWARE.
22*4882a593Smuzhiyun  *
23*4882a593Smuzhiyun  * Authors:
24*4882a593Smuzhiyun  *    Eric Anholt <eric@anholt.net>
25*4882a593Smuzhiyun  *    Thomas Richter <thor@math.tu-berlin.de>
26*4882a593Smuzhiyun  *
27*4882a593Smuzhiyun  * Minor modifications (Dithering enable):
28*4882a593Smuzhiyun  *    Thomas Richter <thor@math.tu-berlin.de>
29*4882a593Smuzhiyun  *
30*4882a593Smuzhiyun  */
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun #include "intel_display_types.h"
33*4882a593Smuzhiyun #include "intel_dvo_dev.h"
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun /*
36*4882a593Smuzhiyun  * register definitions for the i82807aa.
37*4882a593Smuzhiyun  *
38*4882a593Smuzhiyun  * Documentation on this chipset can be found in datasheet #29069001 at
39*4882a593Smuzhiyun  * intel.com.
40*4882a593Smuzhiyun  */
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun /*
43*4882a593Smuzhiyun  * VCH Revision & GMBus Base Addr
44*4882a593Smuzhiyun  */
45*4882a593Smuzhiyun #define VR00		0x00
46*4882a593Smuzhiyun # define VR00_BASE_ADDRESS_MASK		0x007f
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun /*
49*4882a593Smuzhiyun  * Functionality Enable
50*4882a593Smuzhiyun  */
51*4882a593Smuzhiyun #define VR01		0x01
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun /*
54*4882a593Smuzhiyun  * Enable the panel fitter
55*4882a593Smuzhiyun  */
56*4882a593Smuzhiyun # define VR01_PANEL_FIT_ENABLE		(1 << 3)
57*4882a593Smuzhiyun /*
58*4882a593Smuzhiyun  * Enables the LCD display.
59*4882a593Smuzhiyun  *
60*4882a593Smuzhiyun  * This must not be set while VR01_DVO_BYPASS_ENABLE is set.
61*4882a593Smuzhiyun  */
62*4882a593Smuzhiyun # define VR01_LCD_ENABLE		(1 << 2)
63*4882a593Smuzhiyun /* Enables the DVO repeater. */
64*4882a593Smuzhiyun # define VR01_DVO_BYPASS_ENABLE		(1 << 1)
65*4882a593Smuzhiyun /* Enables the DVO clock */
66*4882a593Smuzhiyun # define VR01_DVO_ENABLE		(1 << 0)
67*4882a593Smuzhiyun /* Enable dithering for 18bpp panels. Not documented. */
68*4882a593Smuzhiyun # define VR01_DITHER_ENABLE             (1 << 4)
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun /*
71*4882a593Smuzhiyun  * LCD Interface Format
72*4882a593Smuzhiyun  */
73*4882a593Smuzhiyun #define VR10		0x10
74*4882a593Smuzhiyun /* Enables LVDS output instead of CMOS */
75*4882a593Smuzhiyun # define VR10_LVDS_ENABLE		(1 << 4)
76*4882a593Smuzhiyun /* Enables 18-bit LVDS output. */
77*4882a593Smuzhiyun # define VR10_INTERFACE_1X18		(0 << 2)
78*4882a593Smuzhiyun /* Enables 24-bit LVDS or CMOS output */
79*4882a593Smuzhiyun # define VR10_INTERFACE_1X24		(1 << 2)
80*4882a593Smuzhiyun /* Enables 2x18-bit LVDS or CMOS output. */
81*4882a593Smuzhiyun # define VR10_INTERFACE_2X18		(2 << 2)
82*4882a593Smuzhiyun /* Enables 2x24-bit LVDS output */
83*4882a593Smuzhiyun # define VR10_INTERFACE_2X24		(3 << 2)
84*4882a593Smuzhiyun /* Mask that defines the depth of the pipeline */
85*4882a593Smuzhiyun # define VR10_INTERFACE_DEPTH_MASK      (3 << 2)
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun /*
88*4882a593Smuzhiyun  * VR20 LCD Horizontal Display Size
89*4882a593Smuzhiyun  */
90*4882a593Smuzhiyun #define VR20	0x20
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun /*
93*4882a593Smuzhiyun  * LCD Vertical Display Size
94*4882a593Smuzhiyun  */
95*4882a593Smuzhiyun #define VR21	0x21
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun /*
98*4882a593Smuzhiyun  * Panel power down status
99*4882a593Smuzhiyun  */
100*4882a593Smuzhiyun #define VR30		0x30
101*4882a593Smuzhiyun /* Read only bit indicating that the panel is not in a safe poweroff state. */
102*4882a593Smuzhiyun # define VR30_PANEL_ON			(1 << 15)
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun #define VR40		0x40
105*4882a593Smuzhiyun # define VR40_STALL_ENABLE		(1 << 13)
106*4882a593Smuzhiyun # define VR40_VERTICAL_INTERP_ENABLE	(1 << 12)
107*4882a593Smuzhiyun # define VR40_ENHANCED_PANEL_FITTING	(1 << 11)
108*4882a593Smuzhiyun # define VR40_HORIZONTAL_INTERP_ENABLE	(1 << 10)
109*4882a593Smuzhiyun # define VR40_AUTO_RATIO_ENABLE		(1 << 9)
110*4882a593Smuzhiyun # define VR40_CLOCK_GATING_ENABLE	(1 << 8)
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun /*
113*4882a593Smuzhiyun  * Panel Fitting Vertical Ratio
114*4882a593Smuzhiyun  * (((image_height - 1) << 16) / ((panel_height - 1))) >> 2
115*4882a593Smuzhiyun  */
116*4882a593Smuzhiyun #define VR41		0x41
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun /*
119*4882a593Smuzhiyun  * Panel Fitting Horizontal Ratio
120*4882a593Smuzhiyun  * (((image_width - 1) << 16) / ((panel_width - 1))) >> 2
121*4882a593Smuzhiyun  */
122*4882a593Smuzhiyun #define VR42		0x42
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun /*
125*4882a593Smuzhiyun  * Horizontal Image Size
126*4882a593Smuzhiyun  */
127*4882a593Smuzhiyun #define VR43		0x43
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun /* VR80 GPIO 0
130*4882a593Smuzhiyun  */
131*4882a593Smuzhiyun #define VR80	    0x80
132*4882a593Smuzhiyun #define VR81	    0x81
133*4882a593Smuzhiyun #define VR82	    0x82
134*4882a593Smuzhiyun #define VR83	    0x83
135*4882a593Smuzhiyun #define VR84	    0x84
136*4882a593Smuzhiyun #define VR85	    0x85
137*4882a593Smuzhiyun #define VR86	    0x86
138*4882a593Smuzhiyun #define VR87	    0x87
139*4882a593Smuzhiyun 
140*4882a593Smuzhiyun /* VR88 GPIO 8
141*4882a593Smuzhiyun  */
142*4882a593Smuzhiyun #define VR88	    0x88
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun /* Graphics BIOS scratch 0
145*4882a593Smuzhiyun  */
146*4882a593Smuzhiyun #define VR8E	    0x8E
147*4882a593Smuzhiyun # define VR8E_PANEL_TYPE_MASK		(0xf << 0)
148*4882a593Smuzhiyun # define VR8E_PANEL_INTERFACE_CMOS	(0 << 4)
149*4882a593Smuzhiyun # define VR8E_PANEL_INTERFACE_LVDS	(1 << 4)
150*4882a593Smuzhiyun # define VR8E_FORCE_DEFAULT_PANEL	(1 << 5)
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun /* Graphics BIOS scratch 1
153*4882a593Smuzhiyun  */
154*4882a593Smuzhiyun #define VR8F	    0x8F
155*4882a593Smuzhiyun # define VR8F_VCH_PRESENT		(1 << 0)
156*4882a593Smuzhiyun # define VR8F_DISPLAY_CONN		(1 << 1)
157*4882a593Smuzhiyun # define VR8F_POWER_MASK		(0x3c)
158*4882a593Smuzhiyun # define VR8F_POWER_POS			(2)
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun /* Some Bios implementations do not restore the DVO state upon
161*4882a593Smuzhiyun  * resume from standby. Thus, this driver has to handle it
162*4882a593Smuzhiyun  * instead. The following list contains all registers that
163*4882a593Smuzhiyun  * require saving.
164*4882a593Smuzhiyun  */
165*4882a593Smuzhiyun static const u16 backup_addresses[] = {
166*4882a593Smuzhiyun 	0x11, 0x12,
167*4882a593Smuzhiyun 	0x18, 0x19, 0x1a, 0x1f,
168*4882a593Smuzhiyun 	0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27,
169*4882a593Smuzhiyun 	0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37,
170*4882a593Smuzhiyun 	0x8e, 0x8f,
171*4882a593Smuzhiyun 	0x10		/* this must come last */
172*4882a593Smuzhiyun };
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun struct ivch_priv {
176*4882a593Smuzhiyun 	bool quiet;
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	u16 width, height;
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	/* Register backup */
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	u16 reg_backup[ARRAY_SIZE(backup_addresses)];
183*4882a593Smuzhiyun };
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun static void ivch_dump_regs(struct intel_dvo_device *dvo);
187*4882a593Smuzhiyun /*
188*4882a593Smuzhiyun  * Reads a register on the ivch.
189*4882a593Smuzhiyun  *
190*4882a593Smuzhiyun  * Each of the 256 registers are 16 bits long.
191*4882a593Smuzhiyun  */
ivch_read(struct intel_dvo_device * dvo,int addr,u16 * data)192*4882a593Smuzhiyun static bool ivch_read(struct intel_dvo_device *dvo, int addr, u16 *data)
193*4882a593Smuzhiyun {
194*4882a593Smuzhiyun 	struct ivch_priv *priv = dvo->dev_priv;
195*4882a593Smuzhiyun 	struct i2c_adapter *adapter = dvo->i2c_bus;
196*4882a593Smuzhiyun 	u8 out_buf[1];
197*4882a593Smuzhiyun 	u8 in_buf[2];
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	struct i2c_msg msgs[] = {
200*4882a593Smuzhiyun 		{
201*4882a593Smuzhiyun 			.addr = dvo->slave_addr,
202*4882a593Smuzhiyun 			.flags = I2C_M_RD,
203*4882a593Smuzhiyun 			.len = 0,
204*4882a593Smuzhiyun 		},
205*4882a593Smuzhiyun 		{
206*4882a593Smuzhiyun 			.addr = 0,
207*4882a593Smuzhiyun 			.flags = I2C_M_NOSTART,
208*4882a593Smuzhiyun 			.len = 1,
209*4882a593Smuzhiyun 			.buf = out_buf,
210*4882a593Smuzhiyun 		},
211*4882a593Smuzhiyun 		{
212*4882a593Smuzhiyun 			.addr = dvo->slave_addr,
213*4882a593Smuzhiyun 			.flags = I2C_M_RD | I2C_M_NOSTART,
214*4882a593Smuzhiyun 			.len = 2,
215*4882a593Smuzhiyun 			.buf = in_buf,
216*4882a593Smuzhiyun 		}
217*4882a593Smuzhiyun 	};
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	out_buf[0] = addr;
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	if (i2c_transfer(adapter, msgs, 3) == 3) {
222*4882a593Smuzhiyun 		*data = (in_buf[1] << 8) | in_buf[0];
223*4882a593Smuzhiyun 		return true;
224*4882a593Smuzhiyun 	}
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	if (!priv->quiet) {
227*4882a593Smuzhiyun 		DRM_DEBUG_KMS("Unable to read register 0x%02x from "
228*4882a593Smuzhiyun 				"%s:%02x.\n",
229*4882a593Smuzhiyun 			  addr, adapter->name, dvo->slave_addr);
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun 	return false;
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun /* Writes a 16-bit register on the ivch */
ivch_write(struct intel_dvo_device * dvo,int addr,u16 data)235*4882a593Smuzhiyun static bool ivch_write(struct intel_dvo_device *dvo, int addr, u16 data)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	struct ivch_priv *priv = dvo->dev_priv;
238*4882a593Smuzhiyun 	struct i2c_adapter *adapter = dvo->i2c_bus;
239*4882a593Smuzhiyun 	u8 out_buf[3];
240*4882a593Smuzhiyun 	struct i2c_msg msg = {
241*4882a593Smuzhiyun 		.addr = dvo->slave_addr,
242*4882a593Smuzhiyun 		.flags = 0,
243*4882a593Smuzhiyun 		.len = 3,
244*4882a593Smuzhiyun 		.buf = out_buf,
245*4882a593Smuzhiyun 	};
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	out_buf[0] = addr;
248*4882a593Smuzhiyun 	out_buf[1] = data & 0xff;
249*4882a593Smuzhiyun 	out_buf[2] = data >> 8;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	if (i2c_transfer(adapter, &msg, 1) == 1)
252*4882a593Smuzhiyun 		return true;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	if (!priv->quiet) {
255*4882a593Smuzhiyun 		DRM_DEBUG_KMS("Unable to write register 0x%02x to %s:%d.\n",
256*4882a593Smuzhiyun 			  addr, adapter->name, dvo->slave_addr);
257*4882a593Smuzhiyun 	}
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	return false;
260*4882a593Smuzhiyun }
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun /* Probes the given bus and slave address for an ivch */
ivch_init(struct intel_dvo_device * dvo,struct i2c_adapter * adapter)263*4882a593Smuzhiyun static bool ivch_init(struct intel_dvo_device *dvo,
264*4882a593Smuzhiyun 		      struct i2c_adapter *adapter)
265*4882a593Smuzhiyun {
266*4882a593Smuzhiyun 	struct ivch_priv *priv;
267*4882a593Smuzhiyun 	u16 temp;
268*4882a593Smuzhiyun 	int i;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 	priv = kzalloc(sizeof(struct ivch_priv), GFP_KERNEL);
271*4882a593Smuzhiyun 	if (priv == NULL)
272*4882a593Smuzhiyun 		return false;
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 	dvo->i2c_bus = adapter;
275*4882a593Smuzhiyun 	dvo->dev_priv = priv;
276*4882a593Smuzhiyun 	priv->quiet = true;
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun 	if (!ivch_read(dvo, VR00, &temp))
279*4882a593Smuzhiyun 		goto out;
280*4882a593Smuzhiyun 	priv->quiet = false;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 	/* Since the identification bits are probably zeroes, which doesn't seem
283*4882a593Smuzhiyun 	 * very unique, check that the value in the base address field matches
284*4882a593Smuzhiyun 	 * the address it's responding on.
285*4882a593Smuzhiyun 	 */
286*4882a593Smuzhiyun 	if ((temp & VR00_BASE_ADDRESS_MASK) != dvo->slave_addr) {
287*4882a593Smuzhiyun 		DRM_DEBUG_KMS("ivch detect failed due to address mismatch "
288*4882a593Smuzhiyun 			  "(%d vs %d)\n",
289*4882a593Smuzhiyun 			  (temp & VR00_BASE_ADDRESS_MASK), dvo->slave_addr);
290*4882a593Smuzhiyun 		goto out;
291*4882a593Smuzhiyun 	}
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 	ivch_read(dvo, VR20, &priv->width);
294*4882a593Smuzhiyun 	ivch_read(dvo, VR21, &priv->height);
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	/* Make a backup of the registers to be able to restore them
297*4882a593Smuzhiyun 	 * upon suspend.
298*4882a593Smuzhiyun 	 */
299*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(backup_addresses); i++)
300*4882a593Smuzhiyun 		ivch_read(dvo, backup_addresses[i], priv->reg_backup + i);
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	ivch_dump_regs(dvo);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	return true;
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun out:
307*4882a593Smuzhiyun 	kfree(priv);
308*4882a593Smuzhiyun 	return false;
309*4882a593Smuzhiyun }
310*4882a593Smuzhiyun 
ivch_detect(struct intel_dvo_device * dvo)311*4882a593Smuzhiyun static enum drm_connector_status ivch_detect(struct intel_dvo_device *dvo)
312*4882a593Smuzhiyun {
313*4882a593Smuzhiyun 	return connector_status_connected;
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun 
ivch_mode_valid(struct intel_dvo_device * dvo,struct drm_display_mode * mode)316*4882a593Smuzhiyun static enum drm_mode_status ivch_mode_valid(struct intel_dvo_device *dvo,
317*4882a593Smuzhiyun 					    struct drm_display_mode *mode)
318*4882a593Smuzhiyun {
319*4882a593Smuzhiyun 	if (mode->clock > 112000)
320*4882a593Smuzhiyun 		return MODE_CLOCK_HIGH;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	return MODE_OK;
323*4882a593Smuzhiyun }
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun /* Restore the DVO registers after a resume
326*4882a593Smuzhiyun  * from RAM. Registers have been saved during
327*4882a593Smuzhiyun  * the initialization.
328*4882a593Smuzhiyun  */
ivch_reset(struct intel_dvo_device * dvo)329*4882a593Smuzhiyun static void ivch_reset(struct intel_dvo_device *dvo)
330*4882a593Smuzhiyun {
331*4882a593Smuzhiyun 	struct ivch_priv *priv = dvo->dev_priv;
332*4882a593Smuzhiyun 	int i;
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	DRM_DEBUG_KMS("Resetting the IVCH registers\n");
335*4882a593Smuzhiyun 
336*4882a593Smuzhiyun 	ivch_write(dvo, VR10, 0x0000);
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(backup_addresses); i++)
339*4882a593Smuzhiyun 		ivch_write(dvo, backup_addresses[i], priv->reg_backup[i]);
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun /* Sets the power state of the panel connected to the ivch */
ivch_dpms(struct intel_dvo_device * dvo,bool enable)343*4882a593Smuzhiyun static void ivch_dpms(struct intel_dvo_device *dvo, bool enable)
344*4882a593Smuzhiyun {
345*4882a593Smuzhiyun 	int i;
346*4882a593Smuzhiyun 	u16 vr01, vr30, backlight;
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	ivch_reset(dvo);
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	/* Set the new power state of the panel. */
351*4882a593Smuzhiyun 	if (!ivch_read(dvo, VR01, &vr01))
352*4882a593Smuzhiyun 		return;
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	if (enable)
355*4882a593Smuzhiyun 		backlight = 1;
356*4882a593Smuzhiyun 	else
357*4882a593Smuzhiyun 		backlight = 0;
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	ivch_write(dvo, VR80, backlight);
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	if (enable)
362*4882a593Smuzhiyun 		vr01 |= VR01_LCD_ENABLE | VR01_DVO_ENABLE;
363*4882a593Smuzhiyun 	else
364*4882a593Smuzhiyun 		vr01 &= ~(VR01_LCD_ENABLE | VR01_DVO_ENABLE);
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	ivch_write(dvo, VR01, vr01);
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 	/* Wait for the panel to make its state transition */
369*4882a593Smuzhiyun 	for (i = 0; i < 100; i++) {
370*4882a593Smuzhiyun 		if (!ivch_read(dvo, VR30, &vr30))
371*4882a593Smuzhiyun 			break;
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 		if (((vr30 & VR30_PANEL_ON) != 0) == enable)
374*4882a593Smuzhiyun 			break;
375*4882a593Smuzhiyun 		udelay(1000);
376*4882a593Smuzhiyun 	}
377*4882a593Smuzhiyun 	/* wait some more; vch may fail to resync sometimes without this */
378*4882a593Smuzhiyun 	udelay(16 * 1000);
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun 
ivch_get_hw_state(struct intel_dvo_device * dvo)381*4882a593Smuzhiyun static bool ivch_get_hw_state(struct intel_dvo_device *dvo)
382*4882a593Smuzhiyun {
383*4882a593Smuzhiyun 	u16 vr01;
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	ivch_reset(dvo);
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	/* Set the new power state of the panel. */
388*4882a593Smuzhiyun 	if (!ivch_read(dvo, VR01, &vr01))
389*4882a593Smuzhiyun 		return false;
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	if (vr01 & VR01_LCD_ENABLE)
392*4882a593Smuzhiyun 		return true;
393*4882a593Smuzhiyun 	else
394*4882a593Smuzhiyun 		return false;
395*4882a593Smuzhiyun }
396*4882a593Smuzhiyun 
ivch_mode_set(struct intel_dvo_device * dvo,const struct drm_display_mode * mode,const struct drm_display_mode * adjusted_mode)397*4882a593Smuzhiyun static void ivch_mode_set(struct intel_dvo_device *dvo,
398*4882a593Smuzhiyun 			  const struct drm_display_mode *mode,
399*4882a593Smuzhiyun 			  const struct drm_display_mode *adjusted_mode)
400*4882a593Smuzhiyun {
401*4882a593Smuzhiyun 	struct ivch_priv *priv = dvo->dev_priv;
402*4882a593Smuzhiyun 	u16 vr40 = 0;
403*4882a593Smuzhiyun 	u16 vr01 = 0;
404*4882a593Smuzhiyun 	u16 vr10;
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun 	ivch_reset(dvo);
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 	vr10 = priv->reg_backup[ARRAY_SIZE(backup_addresses) - 1];
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 	/* Enable dithering for 18 bpp pipelines */
411*4882a593Smuzhiyun 	vr10 &= VR10_INTERFACE_DEPTH_MASK;
412*4882a593Smuzhiyun 	if (vr10 == VR10_INTERFACE_2X18 || vr10 == VR10_INTERFACE_1X18)
413*4882a593Smuzhiyun 		vr01 = VR01_DITHER_ENABLE;
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 	vr40 = (VR40_STALL_ENABLE | VR40_VERTICAL_INTERP_ENABLE |
416*4882a593Smuzhiyun 		VR40_HORIZONTAL_INTERP_ENABLE);
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 	if (mode->hdisplay != adjusted_mode->crtc_hdisplay ||
419*4882a593Smuzhiyun 	    mode->vdisplay != adjusted_mode->crtc_vdisplay) {
420*4882a593Smuzhiyun 		u16 x_ratio, y_ratio;
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun 		vr01 |= VR01_PANEL_FIT_ENABLE;
423*4882a593Smuzhiyun 		vr40 |= VR40_CLOCK_GATING_ENABLE;
424*4882a593Smuzhiyun 		x_ratio = (((mode->hdisplay - 1) << 16) /
425*4882a593Smuzhiyun 			   (adjusted_mode->crtc_hdisplay - 1)) >> 2;
426*4882a593Smuzhiyun 		y_ratio = (((mode->vdisplay - 1) << 16) /
427*4882a593Smuzhiyun 			   (adjusted_mode->crtc_vdisplay - 1)) >> 2;
428*4882a593Smuzhiyun 		ivch_write(dvo, VR42, x_ratio);
429*4882a593Smuzhiyun 		ivch_write(dvo, VR41, y_ratio);
430*4882a593Smuzhiyun 	} else {
431*4882a593Smuzhiyun 		vr01 &= ~VR01_PANEL_FIT_ENABLE;
432*4882a593Smuzhiyun 		vr40 &= ~VR40_CLOCK_GATING_ENABLE;
433*4882a593Smuzhiyun 	}
434*4882a593Smuzhiyun 	vr40 &= ~VR40_AUTO_RATIO_ENABLE;
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	ivch_write(dvo, VR01, vr01);
437*4882a593Smuzhiyun 	ivch_write(dvo, VR40, vr40);
438*4882a593Smuzhiyun }
439*4882a593Smuzhiyun 
ivch_dump_regs(struct intel_dvo_device * dvo)440*4882a593Smuzhiyun static void ivch_dump_regs(struct intel_dvo_device *dvo)
441*4882a593Smuzhiyun {
442*4882a593Smuzhiyun 	u16 val;
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	ivch_read(dvo, VR00, &val);
445*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR00: 0x%04x\n", val);
446*4882a593Smuzhiyun 	ivch_read(dvo, VR01, &val);
447*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR01: 0x%04x\n", val);
448*4882a593Smuzhiyun 	ivch_read(dvo, VR10, &val);
449*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR10: 0x%04x\n", val);
450*4882a593Smuzhiyun 	ivch_read(dvo, VR30, &val);
451*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR30: 0x%04x\n", val);
452*4882a593Smuzhiyun 	ivch_read(dvo, VR40, &val);
453*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR40: 0x%04x\n", val);
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	/* GPIO registers */
456*4882a593Smuzhiyun 	ivch_read(dvo, VR80, &val);
457*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR80: 0x%04x\n", val);
458*4882a593Smuzhiyun 	ivch_read(dvo, VR81, &val);
459*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR81: 0x%04x\n", val);
460*4882a593Smuzhiyun 	ivch_read(dvo, VR82, &val);
461*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR82: 0x%04x\n", val);
462*4882a593Smuzhiyun 	ivch_read(dvo, VR83, &val);
463*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR83: 0x%04x\n", val);
464*4882a593Smuzhiyun 	ivch_read(dvo, VR84, &val);
465*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR84: 0x%04x\n", val);
466*4882a593Smuzhiyun 	ivch_read(dvo, VR85, &val);
467*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR85: 0x%04x\n", val);
468*4882a593Smuzhiyun 	ivch_read(dvo, VR86, &val);
469*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR86: 0x%04x\n", val);
470*4882a593Smuzhiyun 	ivch_read(dvo, VR87, &val);
471*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR87: 0x%04x\n", val);
472*4882a593Smuzhiyun 	ivch_read(dvo, VR88, &val);
473*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR88: 0x%04x\n", val);
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 	/* Scratch register 0 - AIM Panel type */
476*4882a593Smuzhiyun 	ivch_read(dvo, VR8E, &val);
477*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR8E: 0x%04x\n", val);
478*4882a593Smuzhiyun 
479*4882a593Smuzhiyun 	/* Scratch register 1 - Status register */
480*4882a593Smuzhiyun 	ivch_read(dvo, VR8F, &val);
481*4882a593Smuzhiyun 	DRM_DEBUG_KMS("VR8F: 0x%04x\n", val);
482*4882a593Smuzhiyun }
483*4882a593Smuzhiyun 
ivch_destroy(struct intel_dvo_device * dvo)484*4882a593Smuzhiyun static void ivch_destroy(struct intel_dvo_device *dvo)
485*4882a593Smuzhiyun {
486*4882a593Smuzhiyun 	struct ivch_priv *priv = dvo->dev_priv;
487*4882a593Smuzhiyun 
488*4882a593Smuzhiyun 	if (priv) {
489*4882a593Smuzhiyun 		kfree(priv);
490*4882a593Smuzhiyun 		dvo->dev_priv = NULL;
491*4882a593Smuzhiyun 	}
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun const struct intel_dvo_dev_ops ivch_ops = {
495*4882a593Smuzhiyun 	.init = ivch_init,
496*4882a593Smuzhiyun 	.dpms = ivch_dpms,
497*4882a593Smuzhiyun 	.get_hw_state = ivch_get_hw_state,
498*4882a593Smuzhiyun 	.mode_valid = ivch_mode_valid,
499*4882a593Smuzhiyun 	.mode_set = ivch_mode_set,
500*4882a593Smuzhiyun 	.detect = ivch_detect,
501*4882a593Smuzhiyun 	.dump_regs = ivch_dump_regs,
502*4882a593Smuzhiyun 	.destroy = ivch_destroy,
503*4882a593Smuzhiyun };
504