xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/i915/display/dvo_ch7017.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  *
26*4882a593Smuzhiyun  */
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #include "intel_display_types.h"
29*4882a593Smuzhiyun #include "intel_dvo_dev.h"
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun #define CH7017_TV_DISPLAY_MODE		0x00
32*4882a593Smuzhiyun #define CH7017_FLICKER_FILTER		0x01
33*4882a593Smuzhiyun #define CH7017_VIDEO_BANDWIDTH		0x02
34*4882a593Smuzhiyun #define CH7017_TEXT_ENHANCEMENT		0x03
35*4882a593Smuzhiyun #define CH7017_START_ACTIVE_VIDEO	0x04
36*4882a593Smuzhiyun #define CH7017_HORIZONTAL_POSITION	0x05
37*4882a593Smuzhiyun #define CH7017_VERTICAL_POSITION	0x06
38*4882a593Smuzhiyun #define CH7017_BLACK_LEVEL		0x07
39*4882a593Smuzhiyun #define CH7017_CONTRAST_ENHANCEMENT	0x08
40*4882a593Smuzhiyun #define CH7017_TV_PLL			0x09
41*4882a593Smuzhiyun #define CH7017_TV_PLL_M			0x0a
42*4882a593Smuzhiyun #define CH7017_TV_PLL_N			0x0b
43*4882a593Smuzhiyun #define CH7017_SUB_CARRIER_0		0x0c
44*4882a593Smuzhiyun #define CH7017_CIV_CONTROL		0x10
45*4882a593Smuzhiyun #define CH7017_CIV_0			0x11
46*4882a593Smuzhiyun #define CH7017_CHROMA_BOOST		0x14
47*4882a593Smuzhiyun #define CH7017_CLOCK_MODE		0x1c
48*4882a593Smuzhiyun #define CH7017_INPUT_CLOCK		0x1d
49*4882a593Smuzhiyun #define CH7017_GPIO_CONTROL		0x1e
50*4882a593Smuzhiyun #define CH7017_INPUT_DATA_FORMAT	0x1f
51*4882a593Smuzhiyun #define CH7017_CONNECTION_DETECT	0x20
52*4882a593Smuzhiyun #define CH7017_DAC_CONTROL		0x21
53*4882a593Smuzhiyun #define CH7017_BUFFERED_CLOCK_OUTPUT	0x22
54*4882a593Smuzhiyun #define CH7017_DEFEAT_VSYNC		0x47
55*4882a593Smuzhiyun #define CH7017_TEST_PATTERN		0x48
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun #define CH7017_POWER_MANAGEMENT		0x49
58*4882a593Smuzhiyun /** Enables the TV output path. */
59*4882a593Smuzhiyun #define CH7017_TV_EN			(1 << 0)
60*4882a593Smuzhiyun #define CH7017_DAC0_POWER_DOWN		(1 << 1)
61*4882a593Smuzhiyun #define CH7017_DAC1_POWER_DOWN		(1 << 2)
62*4882a593Smuzhiyun #define CH7017_DAC2_POWER_DOWN		(1 << 3)
63*4882a593Smuzhiyun #define CH7017_DAC3_POWER_DOWN		(1 << 4)
64*4882a593Smuzhiyun /** Powers down the TV out block, and DAC0-3 */
65*4882a593Smuzhiyun #define CH7017_TV_POWER_DOWN_EN		(1 << 5)
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun #define CH7017_VERSION_ID		0x4a
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun #define CH7017_DEVICE_ID		0x4b
70*4882a593Smuzhiyun #define CH7017_DEVICE_ID_VALUE		0x1b
71*4882a593Smuzhiyun #define CH7018_DEVICE_ID_VALUE		0x1a
72*4882a593Smuzhiyun #define CH7019_DEVICE_ID_VALUE		0x19
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun #define CH7017_XCLK_D2_ADJUST		0x53
75*4882a593Smuzhiyun #define CH7017_UP_SCALER_COEFF_0	0x55
76*4882a593Smuzhiyun #define CH7017_UP_SCALER_COEFF_1	0x56
77*4882a593Smuzhiyun #define CH7017_UP_SCALER_COEFF_2	0x57
78*4882a593Smuzhiyun #define CH7017_UP_SCALER_COEFF_3	0x58
79*4882a593Smuzhiyun #define CH7017_UP_SCALER_COEFF_4	0x59
80*4882a593Smuzhiyun #define CH7017_UP_SCALER_VERTICAL_INC_0	0x5a
81*4882a593Smuzhiyun #define CH7017_UP_SCALER_VERTICAL_INC_1	0x5b
82*4882a593Smuzhiyun #define CH7017_GPIO_INVERT		0x5c
83*4882a593Smuzhiyun #define CH7017_UP_SCALER_HORIZONTAL_INC_0	0x5d
84*4882a593Smuzhiyun #define CH7017_UP_SCALER_HORIZONTAL_INC_1	0x5e
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun #define CH7017_HORIZONTAL_ACTIVE_PIXEL_INPUT	0x5f
87*4882a593Smuzhiyun /**< Low bits of horizontal active pixel input */
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun #define CH7017_ACTIVE_INPUT_LINE_OUTPUT	0x60
90*4882a593Smuzhiyun /** High bits of horizontal active pixel input */
91*4882a593Smuzhiyun #define CH7017_LVDS_HAP_INPUT_MASK	(0x7 << 0)
92*4882a593Smuzhiyun /** High bits of vertical active line output */
93*4882a593Smuzhiyun #define CH7017_LVDS_VAL_HIGH_MASK	(0x7 << 3)
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun #define CH7017_VERTICAL_ACTIVE_LINE_OUTPUT	0x61
96*4882a593Smuzhiyun /**< Low bits of vertical active line output */
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun #define CH7017_HORIZONTAL_ACTIVE_PIXEL_OUTPUT	0x62
99*4882a593Smuzhiyun /**< Low bits of horizontal active pixel output */
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun #define CH7017_LVDS_POWER_DOWN		0x63
102*4882a593Smuzhiyun /** High bits of horizontal active pixel output */
103*4882a593Smuzhiyun #define CH7017_LVDS_HAP_HIGH_MASK	(0x7 << 0)
104*4882a593Smuzhiyun /** Enables the LVDS power down state transition */
105*4882a593Smuzhiyun #define CH7017_LVDS_POWER_DOWN_EN	(1 << 6)
106*4882a593Smuzhiyun /** Enables the LVDS upscaler */
107*4882a593Smuzhiyun #define CH7017_LVDS_UPSCALER_EN		(1 << 7)
108*4882a593Smuzhiyun #define CH7017_LVDS_POWER_DOWN_DEFAULT_RESERVED 0x08
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun #define CH7017_LVDS_ENCODING		0x64
111*4882a593Smuzhiyun #define CH7017_LVDS_DITHER_2D		(1 << 2)
112*4882a593Smuzhiyun #define CH7017_LVDS_DITHER_DIS		(1 << 3)
113*4882a593Smuzhiyun #define CH7017_LVDS_DUAL_CHANNEL_EN	(1 << 4)
114*4882a593Smuzhiyun #define CH7017_LVDS_24_BIT		(1 << 5)
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun #define CH7017_LVDS_ENCODING_2		0x65
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun #define CH7017_LVDS_PLL_CONTROL		0x66
119*4882a593Smuzhiyun /** Enables the LVDS panel output path */
120*4882a593Smuzhiyun #define CH7017_LVDS_PANEN		(1 << 0)
121*4882a593Smuzhiyun /** Enables the LVDS panel backlight */
122*4882a593Smuzhiyun #define CH7017_LVDS_BKLEN		(1 << 3)
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun #define CH7017_POWER_SEQUENCING_T1	0x67
125*4882a593Smuzhiyun #define CH7017_POWER_SEQUENCING_T2	0x68
126*4882a593Smuzhiyun #define CH7017_POWER_SEQUENCING_T3	0x69
127*4882a593Smuzhiyun #define CH7017_POWER_SEQUENCING_T4	0x6a
128*4882a593Smuzhiyun #define CH7017_POWER_SEQUENCING_T5	0x6b
129*4882a593Smuzhiyun #define CH7017_GPIO_DRIVER_TYPE		0x6c
130*4882a593Smuzhiyun #define CH7017_GPIO_DATA		0x6d
131*4882a593Smuzhiyun #define CH7017_GPIO_DIRECTION_CONTROL	0x6e
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun #define CH7017_LVDS_PLL_FEEDBACK_DIV	0x71
134*4882a593Smuzhiyun # define CH7017_LVDS_PLL_FEED_BACK_DIVIDER_SHIFT 4
135*4882a593Smuzhiyun # define CH7017_LVDS_PLL_FEED_FORWARD_DIVIDER_SHIFT 0
136*4882a593Smuzhiyun # define CH7017_LVDS_PLL_FEEDBACK_DEFAULT_RESERVED 0x80
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun #define CH7017_LVDS_PLL_VCO_CONTROL	0x72
139*4882a593Smuzhiyun # define CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED 0x80
140*4882a593Smuzhiyun # define CH7017_LVDS_PLL_VCO_SHIFT	4
141*4882a593Smuzhiyun # define CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT 0
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun #define CH7017_OUTPUTS_ENABLE		0x73
144*4882a593Smuzhiyun # define CH7017_CHARGE_PUMP_LOW		0x0
145*4882a593Smuzhiyun # define CH7017_CHARGE_PUMP_HIGH	0x3
146*4882a593Smuzhiyun # define CH7017_LVDS_CHANNEL_A		(1 << 3)
147*4882a593Smuzhiyun # define CH7017_LVDS_CHANNEL_B		(1 << 4)
148*4882a593Smuzhiyun # define CH7017_TV_DAC_A		(1 << 5)
149*4882a593Smuzhiyun # define CH7017_TV_DAC_B		(1 << 6)
150*4882a593Smuzhiyun # define CH7017_DDC_SELECT_DC2		(1 << 7)
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun #define CH7017_LVDS_OUTPUT_AMPLITUDE	0x74
153*4882a593Smuzhiyun #define CH7017_LVDS_PLL_EMI_REDUCTION	0x75
154*4882a593Smuzhiyun #define CH7017_LVDS_POWER_DOWN_FLICKER	0x76
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun #define CH7017_LVDS_CONTROL_2		0x78
157*4882a593Smuzhiyun # define CH7017_LOOP_FILTER_SHIFT	5
158*4882a593Smuzhiyun # define CH7017_PHASE_DETECTOR_SHIFT	0
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun #define CH7017_BANG_LIMIT_CONTROL	0x7f
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun struct ch7017_priv {
163*4882a593Smuzhiyun 	u8 dummy;
164*4882a593Smuzhiyun };
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun static void ch7017_dump_regs(struct intel_dvo_device *dvo);
167*4882a593Smuzhiyun static void ch7017_dpms(struct intel_dvo_device *dvo, bool enable);
168*4882a593Smuzhiyun 
ch7017_read(struct intel_dvo_device * dvo,u8 addr,u8 * val)169*4882a593Smuzhiyun static bool ch7017_read(struct intel_dvo_device *dvo, u8 addr, u8 *val)
170*4882a593Smuzhiyun {
171*4882a593Smuzhiyun 	struct i2c_msg msgs[] = {
172*4882a593Smuzhiyun 		{
173*4882a593Smuzhiyun 			.addr = dvo->slave_addr,
174*4882a593Smuzhiyun 			.flags = 0,
175*4882a593Smuzhiyun 			.len = 1,
176*4882a593Smuzhiyun 			.buf = &addr,
177*4882a593Smuzhiyun 		},
178*4882a593Smuzhiyun 		{
179*4882a593Smuzhiyun 			.addr = dvo->slave_addr,
180*4882a593Smuzhiyun 			.flags = I2C_M_RD,
181*4882a593Smuzhiyun 			.len = 1,
182*4882a593Smuzhiyun 			.buf = val,
183*4882a593Smuzhiyun 		}
184*4882a593Smuzhiyun 	};
185*4882a593Smuzhiyun 	return i2c_transfer(dvo->i2c_bus, msgs, 2) == 2;
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun 
ch7017_write(struct intel_dvo_device * dvo,u8 addr,u8 val)188*4882a593Smuzhiyun static bool ch7017_write(struct intel_dvo_device *dvo, u8 addr, u8 val)
189*4882a593Smuzhiyun {
190*4882a593Smuzhiyun 	u8 buf[2] = { addr, val };
191*4882a593Smuzhiyun 	struct i2c_msg msg = {
192*4882a593Smuzhiyun 		.addr = dvo->slave_addr,
193*4882a593Smuzhiyun 		.flags = 0,
194*4882a593Smuzhiyun 		.len = 2,
195*4882a593Smuzhiyun 		.buf = buf,
196*4882a593Smuzhiyun 	};
197*4882a593Smuzhiyun 	return i2c_transfer(dvo->i2c_bus, &msg, 1) == 1;
198*4882a593Smuzhiyun }
199*4882a593Smuzhiyun 
200*4882a593Smuzhiyun /** Probes for a CH7017 on the given bus and slave address. */
ch7017_init(struct intel_dvo_device * dvo,struct i2c_adapter * adapter)201*4882a593Smuzhiyun static bool ch7017_init(struct intel_dvo_device *dvo,
202*4882a593Smuzhiyun 			struct i2c_adapter *adapter)
203*4882a593Smuzhiyun {
204*4882a593Smuzhiyun 	struct ch7017_priv *priv;
205*4882a593Smuzhiyun 	const char *str;
206*4882a593Smuzhiyun 	u8 val;
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	priv = kzalloc(sizeof(struct ch7017_priv), GFP_KERNEL);
209*4882a593Smuzhiyun 	if (priv == NULL)
210*4882a593Smuzhiyun 		return false;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	dvo->i2c_bus = adapter;
213*4882a593Smuzhiyun 	dvo->dev_priv = priv;
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun 	if (!ch7017_read(dvo, CH7017_DEVICE_ID, &val))
216*4882a593Smuzhiyun 		goto fail;
217*4882a593Smuzhiyun 
218*4882a593Smuzhiyun 	switch (val) {
219*4882a593Smuzhiyun 	case CH7017_DEVICE_ID_VALUE:
220*4882a593Smuzhiyun 		str = "ch7017";
221*4882a593Smuzhiyun 		break;
222*4882a593Smuzhiyun 	case CH7018_DEVICE_ID_VALUE:
223*4882a593Smuzhiyun 		str = "ch7018";
224*4882a593Smuzhiyun 		break;
225*4882a593Smuzhiyun 	case CH7019_DEVICE_ID_VALUE:
226*4882a593Smuzhiyun 		str = "ch7019";
227*4882a593Smuzhiyun 		break;
228*4882a593Smuzhiyun 	default:
229*4882a593Smuzhiyun 		DRM_DEBUG_KMS("ch701x not detected, got %d: from %s "
230*4882a593Smuzhiyun 			      "slave %d.\n",
231*4882a593Smuzhiyun 			      val, adapter->name, dvo->slave_addr);
232*4882a593Smuzhiyun 		goto fail;
233*4882a593Smuzhiyun 	}
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun 	DRM_DEBUG_KMS("%s detected on %s, addr %d\n",
236*4882a593Smuzhiyun 		      str, adapter->name, dvo->slave_addr);
237*4882a593Smuzhiyun 	return true;
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun fail:
240*4882a593Smuzhiyun 	kfree(priv);
241*4882a593Smuzhiyun 	return false;
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun 
ch7017_detect(struct intel_dvo_device * dvo)244*4882a593Smuzhiyun static enum drm_connector_status ch7017_detect(struct intel_dvo_device *dvo)
245*4882a593Smuzhiyun {
246*4882a593Smuzhiyun 	return connector_status_connected;
247*4882a593Smuzhiyun }
248*4882a593Smuzhiyun 
ch7017_mode_valid(struct intel_dvo_device * dvo,struct drm_display_mode * mode)249*4882a593Smuzhiyun static enum drm_mode_status ch7017_mode_valid(struct intel_dvo_device *dvo,
250*4882a593Smuzhiyun 					      struct drm_display_mode *mode)
251*4882a593Smuzhiyun {
252*4882a593Smuzhiyun 	if (mode->clock > 160000)
253*4882a593Smuzhiyun 		return MODE_CLOCK_HIGH;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	return MODE_OK;
256*4882a593Smuzhiyun }
257*4882a593Smuzhiyun 
ch7017_mode_set(struct intel_dvo_device * dvo,const struct drm_display_mode * mode,const struct drm_display_mode * adjusted_mode)258*4882a593Smuzhiyun static void ch7017_mode_set(struct intel_dvo_device *dvo,
259*4882a593Smuzhiyun 			    const struct drm_display_mode *mode,
260*4882a593Smuzhiyun 			    const struct drm_display_mode *adjusted_mode)
261*4882a593Smuzhiyun {
262*4882a593Smuzhiyun 	u8 lvds_pll_feedback_div, lvds_pll_vco_control;
263*4882a593Smuzhiyun 	u8 outputs_enable, lvds_control_2, lvds_power_down;
264*4882a593Smuzhiyun 	u8 horizontal_active_pixel_input;
265*4882a593Smuzhiyun 	u8 horizontal_active_pixel_output, vertical_active_line_output;
266*4882a593Smuzhiyun 	u8 active_input_line_output;
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	DRM_DEBUG_KMS("Registers before mode setting\n");
269*4882a593Smuzhiyun 	ch7017_dump_regs(dvo);
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	/* LVDS PLL settings from page 75 of 7017-7017ds.pdf*/
272*4882a593Smuzhiyun 	if (mode->clock < 100000) {
273*4882a593Smuzhiyun 		outputs_enable = CH7017_LVDS_CHANNEL_A | CH7017_CHARGE_PUMP_LOW;
274*4882a593Smuzhiyun 		lvds_pll_feedback_div = CH7017_LVDS_PLL_FEEDBACK_DEFAULT_RESERVED |
275*4882a593Smuzhiyun 			(2 << CH7017_LVDS_PLL_FEED_BACK_DIVIDER_SHIFT) |
276*4882a593Smuzhiyun 			(13 << CH7017_LVDS_PLL_FEED_FORWARD_DIVIDER_SHIFT);
277*4882a593Smuzhiyun 		lvds_pll_vco_control = CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED |
278*4882a593Smuzhiyun 			(2 << CH7017_LVDS_PLL_VCO_SHIFT) |
279*4882a593Smuzhiyun 			(3 << CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT);
280*4882a593Smuzhiyun 		lvds_control_2 = (1 << CH7017_LOOP_FILTER_SHIFT) |
281*4882a593Smuzhiyun 			(0 << CH7017_PHASE_DETECTOR_SHIFT);
282*4882a593Smuzhiyun 	} else {
283*4882a593Smuzhiyun 		outputs_enable = CH7017_LVDS_CHANNEL_A | CH7017_CHARGE_PUMP_HIGH;
284*4882a593Smuzhiyun 		lvds_pll_feedback_div =
285*4882a593Smuzhiyun 			CH7017_LVDS_PLL_FEEDBACK_DEFAULT_RESERVED |
286*4882a593Smuzhiyun 			(2 << CH7017_LVDS_PLL_FEED_BACK_DIVIDER_SHIFT) |
287*4882a593Smuzhiyun 			(3 << CH7017_LVDS_PLL_FEED_FORWARD_DIVIDER_SHIFT);
288*4882a593Smuzhiyun 		lvds_control_2 = (3 << CH7017_LOOP_FILTER_SHIFT) |
289*4882a593Smuzhiyun 			(0 << CH7017_PHASE_DETECTOR_SHIFT);
290*4882a593Smuzhiyun 		if (1) { /* XXX: dual channel panel detection.  Assume yes for now. */
291*4882a593Smuzhiyun 			outputs_enable |= CH7017_LVDS_CHANNEL_B;
292*4882a593Smuzhiyun 			lvds_pll_vco_control = CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED |
293*4882a593Smuzhiyun 				(2 << CH7017_LVDS_PLL_VCO_SHIFT) |
294*4882a593Smuzhiyun 				(13 << CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT);
295*4882a593Smuzhiyun 		} else {
296*4882a593Smuzhiyun 			lvds_pll_vco_control = CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED |
297*4882a593Smuzhiyun 				(1 << CH7017_LVDS_PLL_VCO_SHIFT) |
298*4882a593Smuzhiyun 				(13 << CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT);
299*4882a593Smuzhiyun 		}
300*4882a593Smuzhiyun 	}
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	horizontal_active_pixel_input = mode->hdisplay & 0x00ff;
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	vertical_active_line_output = mode->vdisplay & 0x00ff;
305*4882a593Smuzhiyun 	horizontal_active_pixel_output = mode->hdisplay & 0x00ff;
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 	active_input_line_output = ((mode->hdisplay & 0x0700) >> 8) |
308*4882a593Smuzhiyun 				   (((mode->vdisplay & 0x0700) >> 8) << 3);
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	lvds_power_down = CH7017_LVDS_POWER_DOWN_DEFAULT_RESERVED |
311*4882a593Smuzhiyun 			  (mode->hdisplay & 0x0700) >> 8;
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	ch7017_dpms(dvo, false);
314*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_HORIZONTAL_ACTIVE_PIXEL_INPUT,
315*4882a593Smuzhiyun 			horizontal_active_pixel_input);
316*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_HORIZONTAL_ACTIVE_PIXEL_OUTPUT,
317*4882a593Smuzhiyun 			horizontal_active_pixel_output);
318*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_VERTICAL_ACTIVE_LINE_OUTPUT,
319*4882a593Smuzhiyun 			vertical_active_line_output);
320*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_ACTIVE_INPUT_LINE_OUTPUT,
321*4882a593Smuzhiyun 			active_input_line_output);
322*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_LVDS_PLL_VCO_CONTROL, lvds_pll_vco_control);
323*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_LVDS_PLL_FEEDBACK_DIV, lvds_pll_feedback_div);
324*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_LVDS_CONTROL_2, lvds_control_2);
325*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_OUTPUTS_ENABLE, outputs_enable);
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	/* Turn the LVDS back on with new settings. */
328*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_LVDS_POWER_DOWN, lvds_power_down);
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	DRM_DEBUG_KMS("Registers after mode setting\n");
331*4882a593Smuzhiyun 	ch7017_dump_regs(dvo);
332*4882a593Smuzhiyun }
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun /* set the CH7017 power state */
ch7017_dpms(struct intel_dvo_device * dvo,bool enable)335*4882a593Smuzhiyun static void ch7017_dpms(struct intel_dvo_device *dvo, bool enable)
336*4882a593Smuzhiyun {
337*4882a593Smuzhiyun 	u8 val;
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	ch7017_read(dvo, CH7017_LVDS_POWER_DOWN, &val);
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	/* Turn off TV/VGA, and never turn it on since we don't support it. */
342*4882a593Smuzhiyun 	ch7017_write(dvo, CH7017_POWER_MANAGEMENT,
343*4882a593Smuzhiyun 			CH7017_DAC0_POWER_DOWN |
344*4882a593Smuzhiyun 			CH7017_DAC1_POWER_DOWN |
345*4882a593Smuzhiyun 			CH7017_DAC2_POWER_DOWN |
346*4882a593Smuzhiyun 			CH7017_DAC3_POWER_DOWN |
347*4882a593Smuzhiyun 			CH7017_TV_POWER_DOWN_EN);
348*4882a593Smuzhiyun 
349*4882a593Smuzhiyun 	if (enable) {
350*4882a593Smuzhiyun 		/* Turn on the LVDS */
351*4882a593Smuzhiyun 		ch7017_write(dvo, CH7017_LVDS_POWER_DOWN,
352*4882a593Smuzhiyun 			     val & ~CH7017_LVDS_POWER_DOWN_EN);
353*4882a593Smuzhiyun 	} else {
354*4882a593Smuzhiyun 		/* Turn off the LVDS */
355*4882a593Smuzhiyun 		ch7017_write(dvo, CH7017_LVDS_POWER_DOWN,
356*4882a593Smuzhiyun 			     val | CH7017_LVDS_POWER_DOWN_EN);
357*4882a593Smuzhiyun 	}
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	/* XXX: Should actually wait for update power status somehow */
360*4882a593Smuzhiyun 	msleep(20);
361*4882a593Smuzhiyun }
362*4882a593Smuzhiyun 
ch7017_get_hw_state(struct intel_dvo_device * dvo)363*4882a593Smuzhiyun static bool ch7017_get_hw_state(struct intel_dvo_device *dvo)
364*4882a593Smuzhiyun {
365*4882a593Smuzhiyun 	u8 val;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	ch7017_read(dvo, CH7017_LVDS_POWER_DOWN, &val);
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 	if (val & CH7017_LVDS_POWER_DOWN_EN)
370*4882a593Smuzhiyun 		return false;
371*4882a593Smuzhiyun 	else
372*4882a593Smuzhiyun 		return true;
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun 
ch7017_dump_regs(struct intel_dvo_device * dvo)375*4882a593Smuzhiyun static void ch7017_dump_regs(struct intel_dvo_device *dvo)
376*4882a593Smuzhiyun {
377*4882a593Smuzhiyun 	u8 val;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun #define DUMP(reg)					\
380*4882a593Smuzhiyun do {							\
381*4882a593Smuzhiyun 	ch7017_read(dvo, reg, &val);			\
382*4882a593Smuzhiyun 	DRM_DEBUG_KMS(#reg ": %02x\n", val);		\
383*4882a593Smuzhiyun } while (0)
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	DUMP(CH7017_HORIZONTAL_ACTIVE_PIXEL_INPUT);
386*4882a593Smuzhiyun 	DUMP(CH7017_HORIZONTAL_ACTIVE_PIXEL_OUTPUT);
387*4882a593Smuzhiyun 	DUMP(CH7017_VERTICAL_ACTIVE_LINE_OUTPUT);
388*4882a593Smuzhiyun 	DUMP(CH7017_ACTIVE_INPUT_LINE_OUTPUT);
389*4882a593Smuzhiyun 	DUMP(CH7017_LVDS_PLL_VCO_CONTROL);
390*4882a593Smuzhiyun 	DUMP(CH7017_LVDS_PLL_FEEDBACK_DIV);
391*4882a593Smuzhiyun 	DUMP(CH7017_LVDS_CONTROL_2);
392*4882a593Smuzhiyun 	DUMP(CH7017_OUTPUTS_ENABLE);
393*4882a593Smuzhiyun 	DUMP(CH7017_LVDS_POWER_DOWN);
394*4882a593Smuzhiyun }
395*4882a593Smuzhiyun 
ch7017_destroy(struct intel_dvo_device * dvo)396*4882a593Smuzhiyun static void ch7017_destroy(struct intel_dvo_device *dvo)
397*4882a593Smuzhiyun {
398*4882a593Smuzhiyun 	struct ch7017_priv *priv = dvo->dev_priv;
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	if (priv) {
401*4882a593Smuzhiyun 		kfree(priv);
402*4882a593Smuzhiyun 		dvo->dev_priv = NULL;
403*4882a593Smuzhiyun 	}
404*4882a593Smuzhiyun }
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun const struct intel_dvo_dev_ops ch7017_ops = {
407*4882a593Smuzhiyun 	.init = ch7017_init,
408*4882a593Smuzhiyun 	.detect = ch7017_detect,
409*4882a593Smuzhiyun 	.mode_valid = ch7017_mode_valid,
410*4882a593Smuzhiyun 	.mode_set = ch7017_mode_set,
411*4882a593Smuzhiyun 	.dpms = ch7017_dpms,
412*4882a593Smuzhiyun 	.get_hw_state = ch7017_get_hw_state,
413*4882a593Smuzhiyun 	.dump_regs = ch7017_dump_regs,
414*4882a593Smuzhiyun 	.destroy = ch7017_destroy,
415*4882a593Smuzhiyun };
416