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#include <linux/i2c.h>
28#include <linux/slab.h>
29#include <drm/drmP.h>
30#include <drm/drm_atomic_helper.h>
31#include <drm/drm_crtc.h>
32#include "intel_drv.h"
33#include <drm/i915_drm.h>
34#include "i915_drv.h"
35#include "dvo.h"
36
37#define SIL164_ADDR 0x38
38#define CH7xxx_ADDR 0x76
39#define TFP410_ADDR 0x38
40#define NS2501_ADDR 0x38
41
42static const struct intel_dvo_device intel_dvo_devices[] = {
43 {
44 .type = INTEL_DVO_CHIP_TMDS,
45 .name = "sil164",
46 .dvo_reg = DVOC,
47 .dvo_srcdim_reg = DVOC_SRCDIM,
48 .slave_addr = SIL164_ADDR,
49 .dev_ops = &sil164_ops,
50 },
51 {
52 .type = INTEL_DVO_CHIP_TMDS,
53 .name = "ch7xxx",
54 .dvo_reg = DVOC,
55 .dvo_srcdim_reg = DVOC_SRCDIM,
56 .slave_addr = CH7xxx_ADDR,
57 .dev_ops = &ch7xxx_ops,
58 },
59 {
60 .type = INTEL_DVO_CHIP_TMDS,
61 .name = "ch7xxx",
62 .dvo_reg = DVOC,
63 .dvo_srcdim_reg = DVOC_SRCDIM,
64 .slave_addr = 0x75,
65 .dev_ops = &ch7xxx_ops,
66 },
67 {
68 .type = INTEL_DVO_CHIP_LVDS,
69 .name = "ivch",
70 .dvo_reg = DVOA,
71 .dvo_srcdim_reg = DVOA_SRCDIM,
72 .slave_addr = 0x02,
73 .dev_ops = &ivch_ops,
74 },
75 {
76 .type = INTEL_DVO_CHIP_TMDS,
77 .name = "tfp410",
78 .dvo_reg = DVOC,
79 .dvo_srcdim_reg = DVOC_SRCDIM,
80 .slave_addr = TFP410_ADDR,
81 .dev_ops = &tfp410_ops,
82 },
83 {
84 .type = INTEL_DVO_CHIP_LVDS,
85 .name = "ch7017",
86 .dvo_reg = DVOC,
87 .dvo_srcdim_reg = DVOC_SRCDIM,
88 .slave_addr = 0x75,
89 .gpio = GMBUS_PIN_DPB,
90 .dev_ops = &ch7017_ops,
91 },
92 {
93 .type = INTEL_DVO_CHIP_TMDS,
94 .name = "ns2501",
95 .dvo_reg = DVOB,
96 .dvo_srcdim_reg = DVOB_SRCDIM,
97 .slave_addr = NS2501_ADDR,
98 .dev_ops = &ns2501_ops,
99 }
100};
101
102struct intel_dvo {
103 struct intel_encoder base;
104
105 struct intel_dvo_device dev;
106
107 struct intel_connector *attached_connector;
108
109 bool panel_wants_dither;
110};
111
112static struct intel_dvo *enc_to_dvo(struct intel_encoder *encoder)
113{
114 return container_of(encoder, struct intel_dvo, base);
115}
116
117static struct intel_dvo *intel_attached_dvo(struct drm_connector *connector)
118{
119 return enc_to_dvo(intel_attached_encoder(connector));
120}
121
122static bool intel_dvo_connector_get_hw_state(struct intel_connector *connector)
123{
124 struct drm_device *dev = connector->base.dev;
125 struct drm_i915_private *dev_priv = to_i915(dev);
126 struct intel_dvo *intel_dvo = intel_attached_dvo(&connector->base);
127 u32 tmp;
128
129 tmp = I915_READ(intel_dvo->dev.dvo_reg);
130
131 if (!(tmp & DVO_ENABLE))
132 return false;
133
134 return intel_dvo->dev.dev_ops->get_hw_state(&intel_dvo->dev);
135}
136
137static bool intel_dvo_get_hw_state(struct intel_encoder *encoder,
138 enum pipe *pipe)
139{
140 struct drm_device *dev = encoder->base.dev;
141 struct drm_i915_private *dev_priv = to_i915(dev);
142 struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
143 u32 tmp;
144
145 tmp = I915_READ(intel_dvo->dev.dvo_reg);
146
147 if (!(tmp & DVO_ENABLE))
148 return false;
149
150 *pipe = PORT_TO_PIPE(tmp);
151
152 return true;
153}
154
155static void intel_dvo_get_config(struct intel_encoder *encoder,
156 struct intel_crtc_state *pipe_config)
157{
158 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
159 struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
160 u32 tmp, flags = 0;
161
162 tmp = I915_READ(intel_dvo->dev.dvo_reg);
163 if (tmp & DVO_HSYNC_ACTIVE_HIGH)
164 flags |= DRM_MODE_FLAG_PHSYNC;
165 else
166 flags |= DRM_MODE_FLAG_NHSYNC;
167 if (tmp & DVO_VSYNC_ACTIVE_HIGH)
168 flags |= DRM_MODE_FLAG_PVSYNC;
169 else
170 flags |= DRM_MODE_FLAG_NVSYNC;
171
172 pipe_config->base.adjusted_mode.flags |= flags;
173
174 pipe_config->base.adjusted_mode.crtc_clock = pipe_config->port_clock;
175}
176
177static void intel_disable_dvo(struct intel_encoder *encoder,
178 struct intel_crtc_state *old_crtc_state,
179 struct drm_connector_state *old_conn_state)
180{
181 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
182 struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
183 i915_reg_t dvo_reg = intel_dvo->dev.dvo_reg;
184 u32 temp = I915_READ(dvo_reg);
185
186 intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, false);
187 I915_WRITE(dvo_reg, temp & ~DVO_ENABLE);
188 I915_READ(dvo_reg);
189}
190
191static void intel_enable_dvo(struct intel_encoder *encoder,
192 struct intel_crtc_state *pipe_config,
193 struct drm_connector_state *conn_state)
194{
195 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
196 struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
197 i915_reg_t dvo_reg = intel_dvo->dev.dvo_reg;
198 u32 temp = I915_READ(dvo_reg);
199
200 intel_dvo->dev.dev_ops->mode_set(&intel_dvo->dev,
201 &pipe_config->base.mode,
202 &pipe_config->base.adjusted_mode);
203
204 I915_WRITE(dvo_reg, temp | DVO_ENABLE);
205 I915_READ(dvo_reg);
206
207 intel_dvo->dev.dev_ops->dpms(&intel_dvo->dev, true);
208}
209
210static enum drm_mode_status
211intel_dvo_mode_valid(struct drm_connector *connector,
212 struct drm_display_mode *mode)
213{
214 struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
215 const struct drm_display_mode *fixed_mode =
216 to_intel_connector(connector)->panel.fixed_mode;
217 int max_dotclk = to_i915(connector->dev)->max_dotclk_freq;
218 int target_clock = mode->clock;
219
220 if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
221 return MODE_NO_DBLESCAN;
222
223
224
225 if (fixed_mode) {
226 if (mode->hdisplay > fixed_mode->hdisplay)
227 return MODE_PANEL;
228 if (mode->vdisplay > fixed_mode->vdisplay)
229 return MODE_PANEL;
230
231 target_clock = fixed_mode->clock;
232 }
233
234 if (target_clock > max_dotclk)
235 return MODE_CLOCK_HIGH;
236
237 return intel_dvo->dev.dev_ops->mode_valid(&intel_dvo->dev, mode);
238}
239
240static bool intel_dvo_compute_config(struct intel_encoder *encoder,
241 struct intel_crtc_state *pipe_config,
242 struct drm_connector_state *conn_state)
243{
244 struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
245 const struct drm_display_mode *fixed_mode =
246 intel_dvo->attached_connector->panel.fixed_mode;
247 struct drm_display_mode *adjusted_mode = &pipe_config->base.adjusted_mode;
248
249
250
251
252
253
254 if (fixed_mode)
255 intel_fixed_panel_mode(fixed_mode, adjusted_mode);
256
257 return true;
258}
259
260static void intel_dvo_pre_enable(struct intel_encoder *encoder,
261 struct intel_crtc_state *pipe_config,
262 struct drm_connector_state *conn_state)
263{
264 struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
265 struct intel_crtc *crtc = to_intel_crtc(pipe_config->base.crtc);
266 const struct drm_display_mode *adjusted_mode = &pipe_config->base.adjusted_mode;
267 struct intel_dvo *intel_dvo = enc_to_dvo(encoder);
268 int pipe = crtc->pipe;
269 u32 dvo_val;
270 i915_reg_t dvo_reg = intel_dvo->dev.dvo_reg;
271 i915_reg_t dvo_srcdim_reg = intel_dvo->dev.dvo_srcdim_reg;
272
273
274 dvo_val = I915_READ(dvo_reg) &
275 (DVO_PRESERVE_MASK | DVO_DATA_ORDER_GBRG);
276 dvo_val |= DVO_DATA_ORDER_FP | DVO_BORDER_ENABLE |
277 DVO_BLANK_ACTIVE_HIGH;
278
279 if (pipe == 1)
280 dvo_val |= DVO_PIPE_B_SELECT;
281 dvo_val |= DVO_PIPE_STALL;
282 if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
283 dvo_val |= DVO_HSYNC_ACTIVE_HIGH;
284 if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
285 dvo_val |= DVO_VSYNC_ACTIVE_HIGH;
286
287
288
289
290 I915_WRITE(dvo_srcdim_reg,
291 (adjusted_mode->crtc_hdisplay << DVO_SRCDIM_HORIZONTAL_SHIFT) |
292 (adjusted_mode->crtc_vdisplay << DVO_SRCDIM_VERTICAL_SHIFT));
293
294 I915_WRITE(dvo_reg, dvo_val);
295}
296
297
298
299
300
301
302static enum drm_connector_status
303intel_dvo_detect(struct drm_connector *connector, bool force)
304{
305 struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
306 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n",
307 connector->base.id, connector->name);
308 return intel_dvo->dev.dev_ops->detect(&intel_dvo->dev);
309}
310
311static int intel_dvo_get_modes(struct drm_connector *connector)
312{
313 struct drm_i915_private *dev_priv = to_i915(connector->dev);
314 const struct drm_display_mode *fixed_mode =
315 to_intel_connector(connector)->panel.fixed_mode;
316
317
318
319
320
321
322 intel_ddc_get_modes(connector,
323 intel_gmbus_get_adapter(dev_priv, GMBUS_PIN_DPC));
324 if (!list_empty(&connector->probed_modes))
325 return 1;
326
327 if (fixed_mode) {
328 struct drm_display_mode *mode;
329 mode = drm_mode_duplicate(connector->dev, fixed_mode);
330 if (mode) {
331 drm_mode_probed_add(connector, mode);
332 return 1;
333 }
334 }
335
336 return 0;
337}
338
339static void intel_dvo_destroy(struct drm_connector *connector)
340{
341 drm_connector_cleanup(connector);
342 intel_panel_fini(&to_intel_connector(connector)->panel);
343 kfree(connector);
344}
345
346static const struct drm_connector_funcs intel_dvo_connector_funcs = {
347 .detect = intel_dvo_detect,
348 .late_register = intel_connector_register,
349 .early_unregister = intel_connector_unregister,
350 .destroy = intel_dvo_destroy,
351 .fill_modes = drm_helper_probe_single_connector_modes,
352 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
353 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
354};
355
356static const struct drm_connector_helper_funcs intel_dvo_connector_helper_funcs = {
357 .mode_valid = intel_dvo_mode_valid,
358 .get_modes = intel_dvo_get_modes,
359};
360
361static void intel_dvo_enc_destroy(struct drm_encoder *encoder)
362{
363 struct intel_dvo *intel_dvo = enc_to_dvo(to_intel_encoder(encoder));
364
365 if (intel_dvo->dev.dev_ops->destroy)
366 intel_dvo->dev.dev_ops->destroy(&intel_dvo->dev);
367
368 intel_encoder_destroy(encoder);
369}
370
371static const struct drm_encoder_funcs intel_dvo_enc_funcs = {
372 .destroy = intel_dvo_enc_destroy,
373};
374
375
376
377
378
379
380
381static struct drm_display_mode *
382intel_dvo_get_current_mode(struct drm_connector *connector)
383{
384 struct drm_device *dev = connector->dev;
385 struct drm_i915_private *dev_priv = to_i915(dev);
386 struct intel_dvo *intel_dvo = intel_attached_dvo(connector);
387 uint32_t dvo_val = I915_READ(intel_dvo->dev.dvo_reg);
388 struct drm_display_mode *mode = NULL;
389
390
391
392
393 if (dvo_val & DVO_ENABLE) {
394 struct intel_crtc *crtc;
395 int pipe = (dvo_val & DVO_PIPE_B_SELECT) ? 1 : 0;
396
397 crtc = intel_get_crtc_for_pipe(dev_priv, pipe);
398 if (crtc) {
399 mode = intel_crtc_mode_get(dev, &crtc->base);
400 if (mode) {
401 mode->type |= DRM_MODE_TYPE_PREFERRED;
402 if (dvo_val & DVO_HSYNC_ACTIVE_HIGH)
403 mode->flags |= DRM_MODE_FLAG_PHSYNC;
404 if (dvo_val & DVO_VSYNC_ACTIVE_HIGH)
405 mode->flags |= DRM_MODE_FLAG_PVSYNC;
406 }
407 }
408 }
409
410 return mode;
411}
412
413static enum port intel_dvo_port(i915_reg_t dvo_reg)
414{
415 if (i915_mmio_reg_equal(dvo_reg, DVOA))
416 return PORT_A;
417 else if (i915_mmio_reg_equal(dvo_reg, DVOB))
418 return PORT_B;
419 else
420 return PORT_C;
421}
422
423void intel_dvo_init(struct drm_i915_private *dev_priv)
424{
425 struct intel_encoder *intel_encoder;
426 struct intel_dvo *intel_dvo;
427 struct intel_connector *intel_connector;
428 int i;
429 int encoder_type = DRM_MODE_ENCODER_NONE;
430
431 intel_dvo = kzalloc(sizeof(*intel_dvo), GFP_KERNEL);
432 if (!intel_dvo)
433 return;
434
435 intel_connector = intel_connector_alloc();
436 if (!intel_connector) {
437 kfree(intel_dvo);
438 return;
439 }
440
441 intel_dvo->attached_connector = intel_connector;
442
443 intel_encoder = &intel_dvo->base;
444
445 intel_encoder->disable = intel_disable_dvo;
446 intel_encoder->enable = intel_enable_dvo;
447 intel_encoder->get_hw_state = intel_dvo_get_hw_state;
448 intel_encoder->get_config = intel_dvo_get_config;
449 intel_encoder->compute_config = intel_dvo_compute_config;
450 intel_encoder->pre_enable = intel_dvo_pre_enable;
451 intel_connector->get_hw_state = intel_dvo_connector_get_hw_state;
452
453
454 for (i = 0; i < ARRAY_SIZE(intel_dvo_devices); i++) {
455 struct drm_connector *connector = &intel_connector->base;
456 const struct intel_dvo_device *dvo = &intel_dvo_devices[i];
457 struct i2c_adapter *i2c;
458 int gpio;
459 bool dvoinit;
460 enum pipe pipe;
461 uint32_t dpll[I915_MAX_PIPES];
462 enum port port;
463
464
465
466
467
468 if (intel_gmbus_is_valid_pin(dev_priv, dvo->gpio))
469 gpio = dvo->gpio;
470 else if (dvo->type == INTEL_DVO_CHIP_LVDS)
471 gpio = GMBUS_PIN_SSC;
472 else
473 gpio = GMBUS_PIN_DPB;
474
475
476
477
478
479 i2c = intel_gmbus_get_adapter(dev_priv, gpio);
480
481 intel_dvo->dev = *dvo;
482
483
484
485
486 intel_gmbus_force_bit(i2c, true);
487
488
489
490
491
492
493 for_each_pipe(dev_priv, pipe) {
494 dpll[pipe] = I915_READ(DPLL(pipe));
495 I915_WRITE(DPLL(pipe), dpll[pipe] | DPLL_DVO_2X_MODE);
496 }
497
498 dvoinit = dvo->dev_ops->init(&intel_dvo->dev, i2c);
499
500
501 for_each_pipe(dev_priv, pipe) {
502 I915_WRITE(DPLL(pipe), dpll[pipe]);
503 }
504
505 intel_gmbus_force_bit(i2c, false);
506
507 if (!dvoinit)
508 continue;
509
510 port = intel_dvo_port(dvo->dvo_reg);
511 drm_encoder_init(&dev_priv->drm, &intel_encoder->base,
512 &intel_dvo_enc_funcs, encoder_type,
513 "DVO %c", port_name(port));
514
515 intel_encoder->type = INTEL_OUTPUT_DVO;
516 intel_encoder->power_domain = POWER_DOMAIN_PORT_OTHER;
517 intel_encoder->port = port;
518 intel_encoder->crtc_mask = (1 << 0) | (1 << 1);
519
520 switch (dvo->type) {
521 case INTEL_DVO_CHIP_TMDS:
522 intel_encoder->cloneable = (1 << INTEL_OUTPUT_ANALOG) |
523 (1 << INTEL_OUTPUT_DVO);
524 drm_connector_init(&dev_priv->drm, connector,
525 &intel_dvo_connector_funcs,
526 DRM_MODE_CONNECTOR_DVII);
527 encoder_type = DRM_MODE_ENCODER_TMDS;
528 break;
529 case INTEL_DVO_CHIP_LVDS:
530 intel_encoder->cloneable = 0;
531 drm_connector_init(&dev_priv->drm, connector,
532 &intel_dvo_connector_funcs,
533 DRM_MODE_CONNECTOR_LVDS);
534 encoder_type = DRM_MODE_ENCODER_LVDS;
535 break;
536 }
537
538 drm_connector_helper_add(connector,
539 &intel_dvo_connector_helper_funcs);
540 connector->display_info.subpixel_order = SubPixelHorizontalRGB;
541 connector->interlace_allowed = false;
542 connector->doublescan_allowed = false;
543
544 intel_connector_attach_encoder(intel_connector, intel_encoder);
545 if (dvo->type == INTEL_DVO_CHIP_LVDS) {
546
547
548
549
550
551
552
553 intel_panel_init(&intel_connector->panel,
554 intel_dvo_get_current_mode(connector),
555 NULL, NULL);
556 intel_dvo->panel_wants_dither = true;
557 }
558
559 return;
560 }
561
562 kfree(intel_dvo);
563 kfree(intel_connector);
564}
565