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