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