1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <linux/kernel.h>
25
26#include <drm/drmP.h>
27#include <drm/i915_drm.h>
28
29#include "i915_drv.h"
30#include "intel_drv.h"
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79bool intel_hpd_pin_to_port(enum hpd_pin pin, enum port *port)
80{
81 switch (pin) {
82 case HPD_PORT_A:
83 *port = PORT_A;
84 return true;
85 case HPD_PORT_B:
86 *port = PORT_B;
87 return true;
88 case HPD_PORT_C:
89 *port = PORT_C;
90 return true;
91 case HPD_PORT_D:
92 *port = PORT_D;
93 return true;
94 case HPD_PORT_E:
95 *port = PORT_E;
96 return true;
97 default:
98 return false;
99 }
100}
101
102#define HPD_STORM_DETECT_PERIOD 1000
103#define HPD_STORM_THRESHOLD 5
104#define HPD_STORM_REENABLE_DELAY (2 * 60 * 1000)
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121static bool intel_hpd_irq_storm_detect(struct drm_i915_private *dev_priv,
122 enum hpd_pin pin)
123{
124 unsigned long start = dev_priv->hotplug.stats[pin].last_jiffies;
125 unsigned long end = start + msecs_to_jiffies(HPD_STORM_DETECT_PERIOD);
126 bool storm = false;
127
128 if (!time_in_range(jiffies, start, end)) {
129 dev_priv->hotplug.stats[pin].last_jiffies = jiffies;
130 dev_priv->hotplug.stats[pin].count = 0;
131 DRM_DEBUG_KMS("Received HPD interrupt on PIN %d - cnt: 0\n", pin);
132 } else if (dev_priv->hotplug.stats[pin].count > HPD_STORM_THRESHOLD) {
133 dev_priv->hotplug.stats[pin].state = HPD_MARK_DISABLED;
134 DRM_DEBUG_KMS("HPD interrupt storm detected on PIN %d\n", pin);
135 storm = true;
136 } else {
137 dev_priv->hotplug.stats[pin].count++;
138 DRM_DEBUG_KMS("Received HPD interrupt on PIN %d - cnt: %d\n", pin,
139 dev_priv->hotplug.stats[pin].count);
140 }
141
142 return storm;
143}
144
145static void intel_hpd_irq_storm_disable(struct drm_i915_private *dev_priv)
146{
147 struct drm_device *dev = &dev_priv->drm;
148 struct drm_mode_config *mode_config = &dev->mode_config;
149 struct intel_connector *intel_connector;
150 struct intel_encoder *intel_encoder;
151 struct drm_connector *connector;
152 enum hpd_pin pin;
153 bool hpd_disabled = false;
154
155 assert_spin_locked(&dev_priv->irq_lock);
156
157 list_for_each_entry(connector, &mode_config->connector_list, head) {
158 if (connector->polled != DRM_CONNECTOR_POLL_HPD)
159 continue;
160
161 intel_connector = to_intel_connector(connector);
162 intel_encoder = intel_connector->encoder;
163 if (!intel_encoder)
164 continue;
165
166 pin = intel_encoder->hpd_pin;
167 if (pin == HPD_NONE ||
168 dev_priv->hotplug.stats[pin].state != HPD_MARK_DISABLED)
169 continue;
170
171 DRM_INFO("HPD interrupt storm detected on connector %s: "
172 "switching from hotplug detection to polling\n",
173 connector->name);
174
175 dev_priv->hotplug.stats[pin].state = HPD_DISABLED;
176 connector->polled = DRM_CONNECTOR_POLL_CONNECT
177 | DRM_CONNECTOR_POLL_DISCONNECT;
178 hpd_disabled = true;
179 }
180
181
182 if (hpd_disabled) {
183 drm_kms_helper_poll_enable_locked(dev);
184 mod_delayed_work(system_wq, &dev_priv->hotplug.reenable_work,
185 msecs_to_jiffies(HPD_STORM_REENABLE_DELAY));
186 }
187}
188
189static void intel_hpd_irq_storm_reenable_work(struct work_struct *work)
190{
191 struct drm_i915_private *dev_priv =
192 container_of(work, typeof(*dev_priv),
193 hotplug.reenable_work.work);
194 struct drm_device *dev = &dev_priv->drm;
195 struct drm_mode_config *mode_config = &dev->mode_config;
196 int i;
197
198 intel_runtime_pm_get(dev_priv);
199
200 spin_lock_irq(&dev_priv->irq_lock);
201 for_each_hpd_pin(i) {
202 struct drm_connector *connector;
203
204 if (dev_priv->hotplug.stats[i].state != HPD_DISABLED)
205 continue;
206
207 dev_priv->hotplug.stats[i].state = HPD_ENABLED;
208
209 list_for_each_entry(connector, &mode_config->connector_list, head) {
210 struct intel_connector *intel_connector = to_intel_connector(connector);
211
212 if (intel_connector->encoder->hpd_pin == i) {
213 if (connector->polled != intel_connector->polled)
214 DRM_DEBUG_DRIVER("Reenabling HPD on connector %s\n",
215 connector->name);
216 connector->polled = intel_connector->polled;
217 if (!connector->polled)
218 connector->polled = DRM_CONNECTOR_POLL_HPD;
219 }
220 }
221 }
222 if (dev_priv->display.hpd_irq_setup)
223 dev_priv->display.hpd_irq_setup(dev_priv);
224 spin_unlock_irq(&dev_priv->irq_lock);
225
226 intel_runtime_pm_put(dev_priv);
227}
228
229static bool intel_hpd_irq_event(struct drm_device *dev,
230 struct drm_connector *connector)
231{
232 enum drm_connector_status old_status;
233
234 WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
235 old_status = connector->status;
236
237 connector->status = connector->funcs->detect(connector, false);
238 if (old_status == connector->status)
239 return false;
240
241 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
242 connector->base.id,
243 connector->name,
244 drm_get_connector_status_name(old_status),
245 drm_get_connector_status_name(connector->status));
246
247 return true;
248}
249
250static void i915_digport_work_func(struct work_struct *work)
251{
252 struct drm_i915_private *dev_priv =
253 container_of(work, struct drm_i915_private, hotplug.dig_port_work);
254 u32 long_port_mask, short_port_mask;
255 struct intel_digital_port *intel_dig_port;
256 int i;
257 u32 old_bits = 0;
258
259 spin_lock_irq(&dev_priv->irq_lock);
260 long_port_mask = dev_priv->hotplug.long_port_mask;
261 dev_priv->hotplug.long_port_mask = 0;
262 short_port_mask = dev_priv->hotplug.short_port_mask;
263 dev_priv->hotplug.short_port_mask = 0;
264 spin_unlock_irq(&dev_priv->irq_lock);
265
266 for (i = 0; i < I915_MAX_PORTS; i++) {
267 bool valid = false;
268 bool long_hpd = false;
269 intel_dig_port = dev_priv->hotplug.irq_port[i];
270 if (!intel_dig_port || !intel_dig_port->hpd_pulse)
271 continue;
272
273 if (long_port_mask & (1 << i)) {
274 valid = true;
275 long_hpd = true;
276 } else if (short_port_mask & (1 << i))
277 valid = true;
278
279 if (valid) {
280 enum irqreturn ret;
281
282 ret = intel_dig_port->hpd_pulse(intel_dig_port, long_hpd);
283 if (ret == IRQ_NONE) {
284
285 old_bits |= (1 << intel_dig_port->base.hpd_pin);
286 }
287 }
288 }
289
290 if (old_bits) {
291 spin_lock_irq(&dev_priv->irq_lock);
292 dev_priv->hotplug.event_bits |= old_bits;
293 spin_unlock_irq(&dev_priv->irq_lock);
294 schedule_work(&dev_priv->hotplug.hotplug_work);
295 }
296}
297
298
299
300
301static void i915_hotplug_work_func(struct work_struct *work)
302{
303 struct drm_i915_private *dev_priv =
304 container_of(work, struct drm_i915_private, hotplug.hotplug_work);
305 struct drm_device *dev = &dev_priv->drm;
306 struct drm_mode_config *mode_config = &dev->mode_config;
307 struct intel_connector *intel_connector;
308 struct intel_encoder *intel_encoder;
309 struct drm_connector *connector;
310 bool changed = false;
311 u32 hpd_event_bits;
312
313 mutex_lock(&mode_config->mutex);
314 DRM_DEBUG_KMS("running encoder hotplug functions\n");
315
316 spin_lock_irq(&dev_priv->irq_lock);
317
318 hpd_event_bits = dev_priv->hotplug.event_bits;
319 dev_priv->hotplug.event_bits = 0;
320
321
322 intel_hpd_irq_storm_disable(dev_priv);
323
324 spin_unlock_irq(&dev_priv->irq_lock);
325
326 list_for_each_entry(connector, &mode_config->connector_list, head) {
327 intel_connector = to_intel_connector(connector);
328 if (!intel_connector->encoder)
329 continue;
330 intel_encoder = intel_connector->encoder;
331 if (hpd_event_bits & (1 << intel_encoder->hpd_pin)) {
332 DRM_DEBUG_KMS("Connector %s (pin %i) received hotplug event.\n",
333 connector->name, intel_encoder->hpd_pin);
334 if (intel_encoder->hot_plug)
335 intel_encoder->hot_plug(intel_encoder);
336 if (intel_hpd_irq_event(dev, connector))
337 changed = true;
338 }
339 }
340 mutex_unlock(&mode_config->mutex);
341
342 if (changed)
343 drm_kms_helper_hotplug_event(dev);
344}
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363void intel_hpd_irq_handler(struct drm_i915_private *dev_priv,
364 u32 pin_mask, u32 long_mask)
365{
366 int i;
367 enum port port;
368 bool storm_detected = false;
369 bool queue_dig = false, queue_hp = false;
370 bool is_dig_port;
371
372 if (!pin_mask)
373 return;
374
375 spin_lock(&dev_priv->irq_lock);
376 for_each_hpd_pin(i) {
377 if (!(BIT(i) & pin_mask))
378 continue;
379
380 is_dig_port = intel_hpd_pin_to_port(i, &port) &&
381 dev_priv->hotplug.irq_port[port];
382
383 if (is_dig_port) {
384 bool long_hpd = long_mask & BIT(i);
385
386 DRM_DEBUG_DRIVER("digital hpd port %c - %s\n", port_name(port),
387 long_hpd ? "long" : "short");
388
389
390
391
392 queue_dig = true;
393 if (long_hpd) {
394 dev_priv->hotplug.long_port_mask |= (1 << port);
395 } else {
396
397 dev_priv->hotplug.short_port_mask |= (1 << port);
398 continue;
399 }
400 }
401
402 if (dev_priv->hotplug.stats[i].state == HPD_DISABLED) {
403
404
405
406
407
408
409 WARN_ONCE(!HAS_GMCH_DISPLAY(dev_priv),
410 "Received HPD interrupt on pin %d although disabled\n", i);
411 continue;
412 }
413
414 if (dev_priv->hotplug.stats[i].state != HPD_ENABLED)
415 continue;
416
417 if (!is_dig_port) {
418 dev_priv->hotplug.event_bits |= BIT(i);
419 queue_hp = true;
420 }
421
422 if (intel_hpd_irq_storm_detect(dev_priv, i)) {
423 dev_priv->hotplug.event_bits &= ~BIT(i);
424 storm_detected = true;
425 }
426 }
427
428 if (storm_detected)
429 dev_priv->display.hpd_irq_setup(dev_priv);
430 spin_unlock(&dev_priv->irq_lock);
431
432
433
434
435
436
437
438 if (queue_dig)
439 queue_work(dev_priv->hotplug.dp_wq, &dev_priv->hotplug.dig_port_work);
440 if (queue_hp)
441 schedule_work(&dev_priv->hotplug.hotplug_work);
442}
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458void intel_hpd_init(struct drm_i915_private *dev_priv)
459{
460 int i;
461
462 for_each_hpd_pin(i) {
463 dev_priv->hotplug.stats[i].count = 0;
464 dev_priv->hotplug.stats[i].state = HPD_ENABLED;
465 }
466
467 WRITE_ONCE(dev_priv->hotplug.poll_enabled, false);
468 schedule_work(&dev_priv->hotplug.poll_init_work);
469
470
471
472
473
474 spin_lock_irq(&dev_priv->irq_lock);
475 if (dev_priv->display.hpd_irq_setup)
476 dev_priv->display.hpd_irq_setup(dev_priv);
477 spin_unlock_irq(&dev_priv->irq_lock);
478}
479
480static void i915_hpd_poll_init_work(struct work_struct *work)
481{
482 struct drm_i915_private *dev_priv =
483 container_of(work, struct drm_i915_private,
484 hotplug.poll_init_work);
485 struct drm_device *dev = &dev_priv->drm;
486 struct drm_mode_config *mode_config = &dev->mode_config;
487 struct drm_connector *connector;
488 bool enabled;
489
490 mutex_lock(&dev->mode_config.mutex);
491
492 enabled = READ_ONCE(dev_priv->hotplug.poll_enabled);
493
494 list_for_each_entry(connector, &mode_config->connector_list, head) {
495 struct intel_connector *intel_connector =
496 to_intel_connector(connector);
497 connector->polled = intel_connector->polled;
498
499
500
501 if (intel_connector->mst_port)
502 continue;
503
504 if (!connector->polled && I915_HAS_HOTPLUG(dev) &&
505 intel_connector->encoder->hpd_pin > HPD_NONE) {
506 connector->polled = enabled ?
507 DRM_CONNECTOR_POLL_CONNECT |
508 DRM_CONNECTOR_POLL_DISCONNECT :
509 DRM_CONNECTOR_POLL_HPD;
510 }
511 }
512
513 if (enabled)
514 drm_kms_helper_poll_enable_locked(dev);
515
516 mutex_unlock(&dev->mode_config.mutex);
517
518
519
520
521
522 if (!enabled)
523 drm_helper_hpd_irq_event(dev);
524}
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542void intel_hpd_poll_init(struct drm_i915_private *dev_priv)
543{
544 WRITE_ONCE(dev_priv->hotplug.poll_enabled, true);
545
546
547
548
549
550
551
552 schedule_work(&dev_priv->hotplug.poll_init_work);
553}
554
555void intel_hpd_init_work(struct drm_i915_private *dev_priv)
556{
557 INIT_WORK(&dev_priv->hotplug.hotplug_work, i915_hotplug_work_func);
558 INIT_WORK(&dev_priv->hotplug.dig_port_work, i915_digport_work_func);
559 INIT_WORK(&dev_priv->hotplug.poll_init_work, i915_hpd_poll_init_work);
560 INIT_DELAYED_WORK(&dev_priv->hotplug.reenable_work,
561 intel_hpd_irq_storm_reenable_work);
562}
563
564void intel_hpd_cancel_work(struct drm_i915_private *dev_priv)
565{
566 spin_lock_irq(&dev_priv->irq_lock);
567
568 dev_priv->hotplug.long_port_mask = 0;
569 dev_priv->hotplug.short_port_mask = 0;
570 dev_priv->hotplug.event_bits = 0;
571
572 spin_unlock_irq(&dev_priv->irq_lock);
573
574 cancel_work_sync(&dev_priv->hotplug.dig_port_work);
575 cancel_work_sync(&dev_priv->hotplug.hotplug_work);
576 cancel_work_sync(&dev_priv->hotplug.poll_init_work);
577 cancel_delayed_work_sync(&dev_priv->hotplug.reenable_work);
578}
579
580bool intel_hpd_disable(struct drm_i915_private *dev_priv, enum hpd_pin pin)
581{
582 bool ret = false;
583
584 if (pin == HPD_NONE)
585 return false;
586
587 spin_lock_irq(&dev_priv->irq_lock);
588 if (dev_priv->hotplug.stats[pin].state == HPD_ENABLED) {
589 dev_priv->hotplug.stats[pin].state = HPD_DISABLED;
590 ret = true;
591 }
592 spin_unlock_irq(&dev_priv->irq_lock);
593
594 return ret;
595}
596
597void intel_hpd_enable(struct drm_i915_private *dev_priv, enum hpd_pin pin)
598{
599 if (pin == HPD_NONE)
600 return;
601
602 spin_lock_irq(&dev_priv->irq_lock);
603 dev_priv->hotplug.stats[pin].state = HPD_ENABLED;
604 spin_unlock_irq(&dev_priv->irq_lock);
605}
606