xref: /openbmc/linux/drivers/gpu/drm/i915/display/dvo_ch7017.c (revision 976e3645923bdd2fe7893aae33fd7a21098bfb28)
1379bc100SJani Nikula /*
2379bc100SJani Nikula  * Copyright © 2006 Intel Corporation
3379bc100SJani Nikula  *
4379bc100SJani Nikula  * Permission is hereby granted, free of charge, to any person obtaining a
5379bc100SJani Nikula  * copy of this software and associated documentation files (the "Software"),
6379bc100SJani Nikula  * to deal in the Software without restriction, including without limitation
7379bc100SJani Nikula  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8379bc100SJani Nikula  * and/or sell copies of the Software, and to permit persons to whom the
9379bc100SJani Nikula  * Software is furnished to do so, subject to the following conditions:
10379bc100SJani Nikula  *
11379bc100SJani Nikula  * The above copyright notice and this permission notice (including the next
12379bc100SJani Nikula  * paragraph) shall be included in all copies or substantial portions of the
13379bc100SJani Nikula  * Software.
14379bc100SJani Nikula  *
15379bc100SJani Nikula  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16379bc100SJani Nikula  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17379bc100SJani Nikula  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18379bc100SJani Nikula  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19379bc100SJani Nikula  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20379bc100SJani Nikula  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21379bc100SJani Nikula  * DEALINGS IN THE SOFTWARE.
22379bc100SJani Nikula  *
23379bc100SJani Nikula  * Authors:
24379bc100SJani Nikula  *    Eric Anholt <eric@anholt.net>
25379bc100SJani Nikula  *
26379bc100SJani Nikula  */
27379bc100SJani Nikula 
28*1d455f8dSJani Nikula #include "intel_display_types.h"
29379bc100SJani Nikula #include "intel_dvo_dev.h"
30379bc100SJani Nikula 
31379bc100SJani Nikula #define CH7017_TV_DISPLAY_MODE		0x00
32379bc100SJani Nikula #define CH7017_FLICKER_FILTER		0x01
33379bc100SJani Nikula #define CH7017_VIDEO_BANDWIDTH		0x02
34379bc100SJani Nikula #define CH7017_TEXT_ENHANCEMENT		0x03
35379bc100SJani Nikula #define CH7017_START_ACTIVE_VIDEO	0x04
36379bc100SJani Nikula #define CH7017_HORIZONTAL_POSITION	0x05
37379bc100SJani Nikula #define CH7017_VERTICAL_POSITION	0x06
38379bc100SJani Nikula #define CH7017_BLACK_LEVEL		0x07
39379bc100SJani Nikula #define CH7017_CONTRAST_ENHANCEMENT	0x08
40379bc100SJani Nikula #define CH7017_TV_PLL			0x09
41379bc100SJani Nikula #define CH7017_TV_PLL_M			0x0a
42379bc100SJani Nikula #define CH7017_TV_PLL_N			0x0b
43379bc100SJani Nikula #define CH7017_SUB_CARRIER_0		0x0c
44379bc100SJani Nikula #define CH7017_CIV_CONTROL		0x10
45379bc100SJani Nikula #define CH7017_CIV_0			0x11
46379bc100SJani Nikula #define CH7017_CHROMA_BOOST		0x14
47379bc100SJani Nikula #define CH7017_CLOCK_MODE		0x1c
48379bc100SJani Nikula #define CH7017_INPUT_CLOCK		0x1d
49379bc100SJani Nikula #define CH7017_GPIO_CONTROL		0x1e
50379bc100SJani Nikula #define CH7017_INPUT_DATA_FORMAT	0x1f
51379bc100SJani Nikula #define CH7017_CONNECTION_DETECT	0x20
52379bc100SJani Nikula #define CH7017_DAC_CONTROL		0x21
53379bc100SJani Nikula #define CH7017_BUFFERED_CLOCK_OUTPUT	0x22
54379bc100SJani Nikula #define CH7017_DEFEAT_VSYNC		0x47
55379bc100SJani Nikula #define CH7017_TEST_PATTERN		0x48
56379bc100SJani Nikula 
57379bc100SJani Nikula #define CH7017_POWER_MANAGEMENT		0x49
58379bc100SJani Nikula /** Enables the TV output path. */
59379bc100SJani Nikula #define CH7017_TV_EN			(1 << 0)
60379bc100SJani Nikula #define CH7017_DAC0_POWER_DOWN		(1 << 1)
61379bc100SJani Nikula #define CH7017_DAC1_POWER_DOWN		(1 << 2)
62379bc100SJani Nikula #define CH7017_DAC2_POWER_DOWN		(1 << 3)
63379bc100SJani Nikula #define CH7017_DAC3_POWER_DOWN		(1 << 4)
64379bc100SJani Nikula /** Powers down the TV out block, and DAC0-3 */
65379bc100SJani Nikula #define CH7017_TV_POWER_DOWN_EN		(1 << 5)
66379bc100SJani Nikula 
67379bc100SJani Nikula #define CH7017_VERSION_ID		0x4a
68379bc100SJani Nikula 
69379bc100SJani Nikula #define CH7017_DEVICE_ID		0x4b
70379bc100SJani Nikula #define CH7017_DEVICE_ID_VALUE		0x1b
71379bc100SJani Nikula #define CH7018_DEVICE_ID_VALUE		0x1a
72379bc100SJani Nikula #define CH7019_DEVICE_ID_VALUE		0x19
73379bc100SJani Nikula 
74379bc100SJani Nikula #define CH7017_XCLK_D2_ADJUST		0x53
75379bc100SJani Nikula #define CH7017_UP_SCALER_COEFF_0	0x55
76379bc100SJani Nikula #define CH7017_UP_SCALER_COEFF_1	0x56
77379bc100SJani Nikula #define CH7017_UP_SCALER_COEFF_2	0x57
78379bc100SJani Nikula #define CH7017_UP_SCALER_COEFF_3	0x58
79379bc100SJani Nikula #define CH7017_UP_SCALER_COEFF_4	0x59
80379bc100SJani Nikula #define CH7017_UP_SCALER_VERTICAL_INC_0	0x5a
81379bc100SJani Nikula #define CH7017_UP_SCALER_VERTICAL_INC_1	0x5b
82379bc100SJani Nikula #define CH7017_GPIO_INVERT		0x5c
83379bc100SJani Nikula #define CH7017_UP_SCALER_HORIZONTAL_INC_0	0x5d
84379bc100SJani Nikula #define CH7017_UP_SCALER_HORIZONTAL_INC_1	0x5e
85379bc100SJani Nikula 
86379bc100SJani Nikula #define CH7017_HORIZONTAL_ACTIVE_PIXEL_INPUT	0x5f
87379bc100SJani Nikula /**< Low bits of horizontal active pixel input */
88379bc100SJani Nikula 
89379bc100SJani Nikula #define CH7017_ACTIVE_INPUT_LINE_OUTPUT	0x60
90379bc100SJani Nikula /** High bits of horizontal active pixel input */
91379bc100SJani Nikula #define CH7017_LVDS_HAP_INPUT_MASK	(0x7 << 0)
92379bc100SJani Nikula /** High bits of vertical active line output */
93379bc100SJani Nikula #define CH7017_LVDS_VAL_HIGH_MASK	(0x7 << 3)
94379bc100SJani Nikula 
95379bc100SJani Nikula #define CH7017_VERTICAL_ACTIVE_LINE_OUTPUT	0x61
96379bc100SJani Nikula /**< Low bits of vertical active line output */
97379bc100SJani Nikula 
98379bc100SJani Nikula #define CH7017_HORIZONTAL_ACTIVE_PIXEL_OUTPUT	0x62
99379bc100SJani Nikula /**< Low bits of horizontal active pixel output */
100379bc100SJani Nikula 
101379bc100SJani Nikula #define CH7017_LVDS_POWER_DOWN		0x63
102379bc100SJani Nikula /** High bits of horizontal active pixel output */
103379bc100SJani Nikula #define CH7017_LVDS_HAP_HIGH_MASK	(0x7 << 0)
104379bc100SJani Nikula /** Enables the LVDS power down state transition */
105379bc100SJani Nikula #define CH7017_LVDS_POWER_DOWN_EN	(1 << 6)
106379bc100SJani Nikula /** Enables the LVDS upscaler */
107379bc100SJani Nikula #define CH7017_LVDS_UPSCALER_EN		(1 << 7)
108379bc100SJani Nikula #define CH7017_LVDS_POWER_DOWN_DEFAULT_RESERVED 0x08
109379bc100SJani Nikula 
110379bc100SJani Nikula #define CH7017_LVDS_ENCODING		0x64
111379bc100SJani Nikula #define CH7017_LVDS_DITHER_2D		(1 << 2)
112379bc100SJani Nikula #define CH7017_LVDS_DITHER_DIS		(1 << 3)
113379bc100SJani Nikula #define CH7017_LVDS_DUAL_CHANNEL_EN	(1 << 4)
114379bc100SJani Nikula #define CH7017_LVDS_24_BIT		(1 << 5)
115379bc100SJani Nikula 
116379bc100SJani Nikula #define CH7017_LVDS_ENCODING_2		0x65
117379bc100SJani Nikula 
118379bc100SJani Nikula #define CH7017_LVDS_PLL_CONTROL		0x66
119379bc100SJani Nikula /** Enables the LVDS panel output path */
120379bc100SJani Nikula #define CH7017_LVDS_PANEN		(1 << 0)
121379bc100SJani Nikula /** Enables the LVDS panel backlight */
122379bc100SJani Nikula #define CH7017_LVDS_BKLEN		(1 << 3)
123379bc100SJani Nikula 
124379bc100SJani Nikula #define CH7017_POWER_SEQUENCING_T1	0x67
125379bc100SJani Nikula #define CH7017_POWER_SEQUENCING_T2	0x68
126379bc100SJani Nikula #define CH7017_POWER_SEQUENCING_T3	0x69
127379bc100SJani Nikula #define CH7017_POWER_SEQUENCING_T4	0x6a
128379bc100SJani Nikula #define CH7017_POWER_SEQUENCING_T5	0x6b
129379bc100SJani Nikula #define CH7017_GPIO_DRIVER_TYPE		0x6c
130379bc100SJani Nikula #define CH7017_GPIO_DATA		0x6d
131379bc100SJani Nikula #define CH7017_GPIO_DIRECTION_CONTROL	0x6e
132379bc100SJani Nikula 
133379bc100SJani Nikula #define CH7017_LVDS_PLL_FEEDBACK_DIV	0x71
134379bc100SJani Nikula # define CH7017_LVDS_PLL_FEED_BACK_DIVIDER_SHIFT 4
135379bc100SJani Nikula # define CH7017_LVDS_PLL_FEED_FORWARD_DIVIDER_SHIFT 0
136379bc100SJani Nikula # define CH7017_LVDS_PLL_FEEDBACK_DEFAULT_RESERVED 0x80
137379bc100SJani Nikula 
138379bc100SJani Nikula #define CH7017_LVDS_PLL_VCO_CONTROL	0x72
139379bc100SJani Nikula # define CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED 0x80
140379bc100SJani Nikula # define CH7017_LVDS_PLL_VCO_SHIFT	4
141379bc100SJani Nikula # define CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT 0
142379bc100SJani Nikula 
143379bc100SJani Nikula #define CH7017_OUTPUTS_ENABLE		0x73
144379bc100SJani Nikula # define CH7017_CHARGE_PUMP_LOW		0x0
145379bc100SJani Nikula # define CH7017_CHARGE_PUMP_HIGH	0x3
146379bc100SJani Nikula # define CH7017_LVDS_CHANNEL_A		(1 << 3)
147379bc100SJani Nikula # define CH7017_LVDS_CHANNEL_B		(1 << 4)
148379bc100SJani Nikula # define CH7017_TV_DAC_A		(1 << 5)
149379bc100SJani Nikula # define CH7017_TV_DAC_B		(1 << 6)
150379bc100SJani Nikula # define CH7017_DDC_SELECT_DC2		(1 << 7)
151379bc100SJani Nikula 
152379bc100SJani Nikula #define CH7017_LVDS_OUTPUT_AMPLITUDE	0x74
153379bc100SJani Nikula #define CH7017_LVDS_PLL_EMI_REDUCTION	0x75
154379bc100SJani Nikula #define CH7017_LVDS_POWER_DOWN_FLICKER	0x76
155379bc100SJani Nikula 
156379bc100SJani Nikula #define CH7017_LVDS_CONTROL_2		0x78
157379bc100SJani Nikula # define CH7017_LOOP_FILTER_SHIFT	5
158379bc100SJani Nikula # define CH7017_PHASE_DETECTOR_SHIFT	0
159379bc100SJani Nikula 
160379bc100SJani Nikula #define CH7017_BANG_LIMIT_CONTROL	0x7f
161379bc100SJani Nikula 
162379bc100SJani Nikula struct ch7017_priv {
163379bc100SJani Nikula 	u8 dummy;
164379bc100SJani Nikula };
165379bc100SJani Nikula 
166379bc100SJani Nikula static void ch7017_dump_regs(struct intel_dvo_device *dvo);
167379bc100SJani Nikula static void ch7017_dpms(struct intel_dvo_device *dvo, bool enable);
168379bc100SJani Nikula 
ch7017_read(struct intel_dvo_device * dvo,u8 addr,u8 * val)169379bc100SJani Nikula static bool ch7017_read(struct intel_dvo_device *dvo, u8 addr, u8 *val)
170379bc100SJani Nikula {
171379bc100SJani Nikula 	struct i2c_msg msgs[] = {
172379bc100SJani Nikula 		{
173379bc100SJani Nikula 			.addr = dvo->slave_addr,
174379bc100SJani Nikula 			.flags = 0,
175379bc100SJani Nikula 			.len = 1,
176379bc100SJani Nikula 			.buf = &addr,
177379bc100SJani Nikula 		},
178379bc100SJani Nikula 		{
179379bc100SJani Nikula 			.addr = dvo->slave_addr,
180379bc100SJani Nikula 			.flags = I2C_M_RD,
181379bc100SJani Nikula 			.len = 1,
182379bc100SJani Nikula 			.buf = val,
183379bc100SJani Nikula 		}
184379bc100SJani Nikula 	};
185379bc100SJani Nikula 	return i2c_transfer(dvo->i2c_bus, msgs, 2) == 2;
186379bc100SJani Nikula }
187379bc100SJani Nikula 
ch7017_write(struct intel_dvo_device * dvo,u8 addr,u8 val)188379bc100SJani Nikula static bool ch7017_write(struct intel_dvo_device *dvo, u8 addr, u8 val)
189379bc100SJani Nikula {
190379bc100SJani Nikula 	u8 buf[2] = { addr, val };
191379bc100SJani Nikula 	struct i2c_msg msg = {
192379bc100SJani Nikula 		.addr = dvo->slave_addr,
193379bc100SJani Nikula 		.flags = 0,
194379bc100SJani Nikula 		.len = 2,
195379bc100SJani Nikula 		.buf = buf,
196379bc100SJani Nikula 	};
197379bc100SJani Nikula 	return i2c_transfer(dvo->i2c_bus, &msg, 1) == 1;
198379bc100SJani Nikula }
199379bc100SJani Nikula 
200379bc100SJani Nikula /** Probes for a CH7017 on the given bus and slave address. */
ch7017_init(struct intel_dvo_device * dvo,struct i2c_adapter * adapter)201379bc100SJani Nikula static bool ch7017_init(struct intel_dvo_device *dvo,
202379bc100SJani Nikula 			struct i2c_adapter *adapter)
203379bc100SJani Nikula {
204379bc100SJani Nikula 	struct ch7017_priv *priv;
205379bc100SJani Nikula 	const char *str;
206379bc100SJani Nikula 	u8 val;
207379bc100SJani Nikula 
208379bc100SJani Nikula 	priv = kzalloc(sizeof(struct ch7017_priv), GFP_KERNEL);
209379bc100SJani Nikula 	if (priv == NULL)
210379bc100SJani Nikula 		return false;
211379bc100SJani Nikula 
212379bc100SJani Nikula 	dvo->i2c_bus = adapter;
213379bc100SJani Nikula 	dvo->dev_priv = priv;
214379bc100SJani Nikula 
215379bc100SJani Nikula 	if (!ch7017_read(dvo, CH7017_DEVICE_ID, &val))
216379bc100SJani Nikula 		goto fail;
217379bc100SJani Nikula 
218379bc100SJani Nikula 	switch (val) {
219379bc100SJani Nikula 	case CH7017_DEVICE_ID_VALUE:
220379bc100SJani Nikula 		str = "ch7017";
221379bc100SJani Nikula 		break;
222379bc100SJani Nikula 	case CH7018_DEVICE_ID_VALUE:
223379bc100SJani Nikula 		str = "ch7018";
224379bc100SJani Nikula 		break;
225379bc100SJani Nikula 	case CH7019_DEVICE_ID_VALUE:
226379bc100SJani Nikula 		str = "ch7019";
227379bc100SJani Nikula 		break;
228379bc100SJani Nikula 	default:
229379bc100SJani Nikula 		DRM_DEBUG_KMS("ch701x not detected, got %d: from %s "
230379bc100SJani Nikula 			      "slave %d.\n",
231379bc100SJani Nikula 			      val, adapter->name, dvo->slave_addr);
232379bc100SJani Nikula 		goto fail;
233379bc100SJani Nikula 	}
234379bc100SJani Nikula 
235379bc100SJani Nikula 	DRM_DEBUG_KMS("%s detected on %s, addr %d\n",
236379bc100SJani Nikula 		      str, adapter->name, dvo->slave_addr);
237379bc100SJani Nikula 	return true;
238379bc100SJani Nikula 
239379bc100SJani Nikula fail:
240379bc100SJani Nikula 	kfree(priv);
241379bc100SJani Nikula 	return false;
242379bc100SJani Nikula }
243379bc100SJani Nikula 
ch7017_detect(struct intel_dvo_device * dvo)244379bc100SJani Nikula static enum drm_connector_status ch7017_detect(struct intel_dvo_device *dvo)
245379bc100SJani Nikula {
246379bc100SJani Nikula 	return connector_status_connected;
247379bc100SJani Nikula }
248379bc100SJani Nikula 
ch7017_mode_valid(struct intel_dvo_device * dvo,struct drm_display_mode * mode)249379bc100SJani Nikula static enum drm_mode_status ch7017_mode_valid(struct intel_dvo_device *dvo,
250379bc100SJani Nikula 					      struct drm_display_mode *mode)
251379bc100SJani Nikula {
252379bc100SJani Nikula 	if (mode->clock > 160000)
253379bc100SJani Nikula 		return MODE_CLOCK_HIGH;
254379bc100SJani Nikula 
255379bc100SJani Nikula 	return MODE_OK;
256379bc100SJani Nikula }
257379bc100SJani Nikula 
ch7017_mode_set(struct intel_dvo_device * dvo,const struct drm_display_mode * mode,const struct drm_display_mode * adjusted_mode)258379bc100SJani Nikula static void ch7017_mode_set(struct intel_dvo_device *dvo,
259379bc100SJani Nikula 			    const struct drm_display_mode *mode,
260379bc100SJani Nikula 			    const struct drm_display_mode *adjusted_mode)
261379bc100SJani Nikula {
262379bc100SJani Nikula 	u8 lvds_pll_feedback_div, lvds_pll_vco_control;
263379bc100SJani Nikula 	u8 outputs_enable, lvds_control_2, lvds_power_down;
264379bc100SJani Nikula 	u8 horizontal_active_pixel_input;
265379bc100SJani Nikula 	u8 horizontal_active_pixel_output, vertical_active_line_output;
266379bc100SJani Nikula 	u8 active_input_line_output;
267379bc100SJani Nikula 
268379bc100SJani Nikula 	DRM_DEBUG_KMS("Registers before mode setting\n");
269379bc100SJani Nikula 	ch7017_dump_regs(dvo);
270379bc100SJani Nikula 
271379bc100SJani Nikula 	/* LVDS PLL settings from page 75 of 7017-7017ds.pdf*/
272379bc100SJani Nikula 	if (mode->clock < 100000) {
273379bc100SJani Nikula 		outputs_enable = CH7017_LVDS_CHANNEL_A | CH7017_CHARGE_PUMP_LOW;
274379bc100SJani Nikula 		lvds_pll_feedback_div = CH7017_LVDS_PLL_FEEDBACK_DEFAULT_RESERVED |
275379bc100SJani Nikula 			(2 << CH7017_LVDS_PLL_FEED_BACK_DIVIDER_SHIFT) |
276379bc100SJani Nikula 			(13 << CH7017_LVDS_PLL_FEED_FORWARD_DIVIDER_SHIFT);
277379bc100SJani Nikula 		lvds_pll_vco_control = CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED |
278379bc100SJani Nikula 			(2 << CH7017_LVDS_PLL_VCO_SHIFT) |
279379bc100SJani Nikula 			(3 << CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT);
280379bc100SJani Nikula 		lvds_control_2 = (1 << CH7017_LOOP_FILTER_SHIFT) |
281379bc100SJani Nikula 			(0 << CH7017_PHASE_DETECTOR_SHIFT);
282379bc100SJani Nikula 	} else {
283379bc100SJani Nikula 		outputs_enable = CH7017_LVDS_CHANNEL_A | CH7017_CHARGE_PUMP_HIGH;
284379bc100SJani Nikula 		lvds_pll_feedback_div =
285379bc100SJani Nikula 			CH7017_LVDS_PLL_FEEDBACK_DEFAULT_RESERVED |
286379bc100SJani Nikula 			(2 << CH7017_LVDS_PLL_FEED_BACK_DIVIDER_SHIFT) |
287379bc100SJani Nikula 			(3 << CH7017_LVDS_PLL_FEED_FORWARD_DIVIDER_SHIFT);
288379bc100SJani Nikula 		lvds_control_2 = (3 << CH7017_LOOP_FILTER_SHIFT) |
289379bc100SJani Nikula 			(0 << CH7017_PHASE_DETECTOR_SHIFT);
290379bc100SJani Nikula 		if (1) { /* XXX: dual channel panel detection.  Assume yes for now. */
291379bc100SJani Nikula 			outputs_enable |= CH7017_LVDS_CHANNEL_B;
292379bc100SJani Nikula 			lvds_pll_vco_control = CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED |
293379bc100SJani Nikula 				(2 << CH7017_LVDS_PLL_VCO_SHIFT) |
294379bc100SJani Nikula 				(13 << CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT);
295379bc100SJani Nikula 		} else {
296379bc100SJani Nikula 			lvds_pll_vco_control = CH7017_LVDS_PLL_VCO_DEFAULT_RESERVED |
297379bc100SJani Nikula 				(1 << CH7017_LVDS_PLL_VCO_SHIFT) |
298379bc100SJani Nikula 				(13 << CH7017_LVDS_PLL_POST_SCALE_DIV_SHIFT);
299379bc100SJani Nikula 		}
300379bc100SJani Nikula 	}
301379bc100SJani Nikula 
302379bc100SJani Nikula 	horizontal_active_pixel_input = mode->hdisplay & 0x00ff;
303379bc100SJani Nikula 
304379bc100SJani Nikula 	vertical_active_line_output = mode->vdisplay & 0x00ff;
305379bc100SJani Nikula 	horizontal_active_pixel_output = mode->hdisplay & 0x00ff;
306379bc100SJani Nikula 
307379bc100SJani Nikula 	active_input_line_output = ((mode->hdisplay & 0x0700) >> 8) |
308379bc100SJani Nikula 				   (((mode->vdisplay & 0x0700) >> 8) << 3);
309379bc100SJani Nikula 
310379bc100SJani Nikula 	lvds_power_down = CH7017_LVDS_POWER_DOWN_DEFAULT_RESERVED |
311379bc100SJani Nikula 			  (mode->hdisplay & 0x0700) >> 8;
312379bc100SJani Nikula 
313379bc100SJani Nikula 	ch7017_dpms(dvo, false);
314379bc100SJani Nikula 	ch7017_write(dvo, CH7017_HORIZONTAL_ACTIVE_PIXEL_INPUT,
315379bc100SJani Nikula 			horizontal_active_pixel_input);
316379bc100SJani Nikula 	ch7017_write(dvo, CH7017_HORIZONTAL_ACTIVE_PIXEL_OUTPUT,
317379bc100SJani Nikula 			horizontal_active_pixel_output);
318379bc100SJani Nikula 	ch7017_write(dvo, CH7017_VERTICAL_ACTIVE_LINE_OUTPUT,
319379bc100SJani Nikula 			vertical_active_line_output);
320379bc100SJani Nikula 	ch7017_write(dvo, CH7017_ACTIVE_INPUT_LINE_OUTPUT,
321379bc100SJani Nikula 			active_input_line_output);
322379bc100SJani Nikula 	ch7017_write(dvo, CH7017_LVDS_PLL_VCO_CONTROL, lvds_pll_vco_control);
323379bc100SJani Nikula 	ch7017_write(dvo, CH7017_LVDS_PLL_FEEDBACK_DIV, lvds_pll_feedback_div);
324379bc100SJani Nikula 	ch7017_write(dvo, CH7017_LVDS_CONTROL_2, lvds_control_2);
325379bc100SJani Nikula 	ch7017_write(dvo, CH7017_OUTPUTS_ENABLE, outputs_enable);
326379bc100SJani Nikula 
327379bc100SJani Nikula 	/* Turn the LVDS back on with new settings. */
328379bc100SJani Nikula 	ch7017_write(dvo, CH7017_LVDS_POWER_DOWN, lvds_power_down);
329379bc100SJani Nikula 
330379bc100SJani Nikula 	DRM_DEBUG_KMS("Registers after mode setting\n");
331379bc100SJani Nikula 	ch7017_dump_regs(dvo);
332379bc100SJani Nikula }
333379bc100SJani Nikula 
334379bc100SJani Nikula /* set the CH7017 power state */
ch7017_dpms(struct intel_dvo_device * dvo,bool enable)335379bc100SJani Nikula static void ch7017_dpms(struct intel_dvo_device *dvo, bool enable)
336379bc100SJani Nikula {
337379bc100SJani Nikula 	u8 val;
338379bc100SJani Nikula 
339379bc100SJani Nikula 	ch7017_read(dvo, CH7017_LVDS_POWER_DOWN, &val);
340379bc100SJani Nikula 
341379bc100SJani Nikula 	/* Turn off TV/VGA, and never turn it on since we don't support it. */
342379bc100SJani Nikula 	ch7017_write(dvo, CH7017_POWER_MANAGEMENT,
343379bc100SJani Nikula 			CH7017_DAC0_POWER_DOWN |
344379bc100SJani Nikula 			CH7017_DAC1_POWER_DOWN |
345379bc100SJani Nikula 			CH7017_DAC2_POWER_DOWN |
346379bc100SJani Nikula 			CH7017_DAC3_POWER_DOWN |
347379bc100SJani Nikula 			CH7017_TV_POWER_DOWN_EN);
348379bc100SJani Nikula 
349379bc100SJani Nikula 	if (enable) {
350379bc100SJani Nikula 		/* Turn on the LVDS */
351379bc100SJani Nikula 		ch7017_write(dvo, CH7017_LVDS_POWER_DOWN,
352379bc100SJani Nikula 			     val & ~CH7017_LVDS_POWER_DOWN_EN);
353379bc100SJani Nikula 	} else {
354379bc100SJani Nikula 		/* Turn off the LVDS */
355379bc100SJani Nikula 		ch7017_write(dvo, CH7017_LVDS_POWER_DOWN,
356379bc100SJani Nikula 			     val | CH7017_LVDS_POWER_DOWN_EN);
357379bc100SJani Nikula 	}
358379bc100SJani Nikula 
359379bc100SJani Nikula 	/* XXX: Should actually wait for update power status somehow */
360379bc100SJani Nikula 	msleep(20);
361379bc100SJani Nikula }
362379bc100SJani Nikula 
ch7017_get_hw_state(struct intel_dvo_device * dvo)363379bc100SJani Nikula static bool ch7017_get_hw_state(struct intel_dvo_device *dvo)
364379bc100SJani Nikula {
365379bc100SJani Nikula 	u8 val;
366379bc100SJani Nikula 
367379bc100SJani Nikula 	ch7017_read(dvo, CH7017_LVDS_POWER_DOWN, &val);
368379bc100SJani Nikula 
369379bc100SJani Nikula 	if (val & CH7017_LVDS_POWER_DOWN_EN)
370379bc100SJani Nikula 		return false;
371379bc100SJani Nikula 	else
372379bc100SJani Nikula 		return true;
373379bc100SJani Nikula }
374379bc100SJani Nikula 
ch7017_dump_regs(struct intel_dvo_device * dvo)375379bc100SJani Nikula static void ch7017_dump_regs(struct intel_dvo_device *dvo)
376379bc100SJani Nikula {
377379bc100SJani Nikula 	u8 val;
378379bc100SJani Nikula 
379379bc100SJani Nikula #define DUMP(reg)					\
380379bc100SJani Nikula do {							\
381379bc100SJani Nikula 	ch7017_read(dvo, reg, &val);			\
382379bc100SJani Nikula 	DRM_DEBUG_KMS(#reg ": %02x\n", val);		\
383379bc100SJani Nikula } while (0)
384379bc100SJani Nikula 
385379bc100SJani Nikula 	DUMP(CH7017_HORIZONTAL_ACTIVE_PIXEL_INPUT);
386379bc100SJani Nikula 	DUMP(CH7017_HORIZONTAL_ACTIVE_PIXEL_OUTPUT);
387379bc100SJani Nikula 	DUMP(CH7017_VERTICAL_ACTIVE_LINE_OUTPUT);
388379bc100SJani Nikula 	DUMP(CH7017_ACTIVE_INPUT_LINE_OUTPUT);
389379bc100SJani Nikula 	DUMP(CH7017_LVDS_PLL_VCO_CONTROL);
390379bc100SJani Nikula 	DUMP(CH7017_LVDS_PLL_FEEDBACK_DIV);
391379bc100SJani Nikula 	DUMP(CH7017_LVDS_CONTROL_2);
392379bc100SJani Nikula 	DUMP(CH7017_OUTPUTS_ENABLE);
393379bc100SJani Nikula 	DUMP(CH7017_LVDS_POWER_DOWN);
394379bc100SJani Nikula }
395379bc100SJani Nikula 
ch7017_destroy(struct intel_dvo_device * dvo)396379bc100SJani Nikula static void ch7017_destroy(struct intel_dvo_device *dvo)
397379bc100SJani Nikula {
398379bc100SJani Nikula 	struct ch7017_priv *priv = dvo->dev_priv;
399379bc100SJani Nikula 
400379bc100SJani Nikula 	if (priv) {
401379bc100SJani Nikula 		kfree(priv);
402379bc100SJani Nikula 		dvo->dev_priv = NULL;
403379bc100SJani Nikula 	}
404379bc100SJani Nikula }
405379bc100SJani Nikula 
406379bc100SJani Nikula const struct intel_dvo_dev_ops ch7017_ops = {
407379bc100SJani Nikula 	.init = ch7017_init,
408379bc100SJani Nikula 	.detect = ch7017_detect,
409379bc100SJani Nikula 	.mode_valid = ch7017_mode_valid,
410379bc100SJani Nikula 	.mode_set = ch7017_mode_set,
411379bc100SJani Nikula 	.dpms = ch7017_dpms,
412379bc100SJani Nikula 	.get_hw_state = ch7017_get_hw_state,
413379bc100SJani Nikula 	.dump_regs = ch7017_dump_regs,
414379bc100SJani Nikula 	.destroy = ch7017_destroy,
415379bc100SJani Nikula };
416