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