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
29
30
31
32#include <linux/export.h>
33#include <linux/moduleparam.h>
34
35#include <drm/drmP.h>
36#include <drm/drm_crtc.h>
37#include <drm/drm_fourcc.h>
38#include <drm/drm_crtc_helper.h>
39#include <drm/drm_fb_helper.h>
40#include <drm/drm_edid.h>
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58static bool drm_kms_helper_poll = true;
59module_param_named(poll, drm_kms_helper_poll, bool, 0600);
60
61static enum drm_mode_status
62drm_mode_validate_flag(const struct drm_display_mode *mode,
63 int flags)
64{
65 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
66 !(flags & DRM_MODE_FLAG_INTERLACE))
67 return MODE_NO_INTERLACE;
68
69 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
70 !(flags & DRM_MODE_FLAG_DBLSCAN))
71 return MODE_NO_DBLESCAN;
72
73 if ((mode->flags & DRM_MODE_FLAG_3D_MASK) &&
74 !(flags & DRM_MODE_FLAG_3D_MASK))
75 return MODE_NO_STEREO;
76
77 return MODE_OK;
78}
79
80static int drm_helper_probe_add_cmdline_mode(struct drm_connector *connector)
81{
82 struct drm_display_mode *mode;
83
84 if (!connector->cmdline_mode.specified)
85 return 0;
86
87 mode = drm_mode_create_from_cmdline_mode(connector->dev,
88 &connector->cmdline_mode);
89 if (mode == NULL)
90 return 0;
91
92 drm_mode_probed_add(connector, mode);
93 return 1;
94}
95
96static int drm_helper_probe_single_connector_modes_merge_bits(struct drm_connector *connector,
97 uint32_t maxX, uint32_t maxY, bool merge_type_bits)
98{
99 struct drm_device *dev = connector->dev;
100 struct drm_display_mode *mode;
101 struct drm_connector_helper_funcs *connector_funcs =
102 connector->helper_private;
103 int count = 0;
104 int mode_flags = 0;
105 bool verbose_prune = true;
106 enum drm_connector_status old_status;
107
108 WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
109
110 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id,
111 connector->name);
112
113 list_for_each_entry(mode, &connector->modes, head)
114 mode->status = MODE_UNVERIFIED;
115
116 if (connector->force) {
117 if (connector->force == DRM_FORCE_ON ||
118 connector->force == DRM_FORCE_ON_DIGITAL)
119 connector->status = connector_status_connected;
120 else
121 connector->status = connector_status_disconnected;
122 if (connector->funcs->force)
123 connector->funcs->force(connector);
124 } else {
125 old_status = connector->status;
126
127 connector->status = connector->funcs->detect(connector, true);
128
129
130
131
132
133
134
135 if (old_status != connector->status) {
136 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %d to %d\n",
137 connector->base.id,
138 connector->name,
139 old_status, connector->status);
140
141
142
143
144
145
146
147 dev->mode_config.delayed_event = true;
148 if (dev->mode_config.poll_enabled)
149 schedule_delayed_work(&dev->mode_config.output_poll_work,
150 0);
151 }
152 }
153
154
155 if (drm_kms_helper_poll != dev->mode_config.poll_running)
156 drm_kms_helper_poll_enable(dev);
157
158 dev->mode_config.poll_running = drm_kms_helper_poll;
159
160 if (connector->status == connector_status_disconnected) {
161 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
162 connector->base.id, connector->name);
163 drm_mode_connector_update_edid_property(connector, NULL);
164 verbose_prune = false;
165 goto prune;
166 }
167
168#ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
169 count = drm_load_edid_firmware(connector);
170 if (count == 0)
171#endif
172 {
173 if (connector->override_edid) {
174 struct edid *edid = (struct edid *) connector->edid_blob_ptr->data;
175
176 count = drm_add_edid_modes(connector, edid);
177 drm_edid_to_eld(connector, edid);
178 } else
179 count = (*connector_funcs->get_modes)(connector);
180 }
181
182 if (count == 0 && connector->status == connector_status_connected)
183 count = drm_add_modes_noedid(connector, 1024, 768);
184 count += drm_helper_probe_add_cmdline_mode(connector);
185 if (count == 0)
186 goto prune;
187
188 drm_mode_connector_list_update(connector, merge_type_bits);
189
190 if (connector->interlace_allowed)
191 mode_flags |= DRM_MODE_FLAG_INTERLACE;
192 if (connector->doublescan_allowed)
193 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
194 if (connector->stereo_allowed)
195 mode_flags |= DRM_MODE_FLAG_3D_MASK;
196
197 list_for_each_entry(mode, &connector->modes, head) {
198 mode->status = drm_mode_validate_basic(mode);
199
200 if (mode->status == MODE_OK)
201 mode->status = drm_mode_validate_size(mode, maxX, maxY);
202
203 if (mode->status == MODE_OK)
204 mode->status = drm_mode_validate_flag(mode, mode_flags);
205
206 if (mode->status == MODE_OK && connector_funcs->mode_valid)
207 mode->status = connector_funcs->mode_valid(connector,
208 mode);
209 }
210
211prune:
212 drm_mode_prune_invalid(dev, &connector->modes, verbose_prune);
213
214 if (list_empty(&connector->modes))
215 return 0;
216
217 list_for_each_entry(mode, &connector->modes, head)
218 mode->vrefresh = drm_mode_vrefresh(mode);
219
220 drm_mode_sort(&connector->modes);
221
222 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
223 connector->name);
224 list_for_each_entry(mode, &connector->modes, head) {
225 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
226 drm_mode_debug_printmodeline(mode);
227 }
228
229 return count;
230}
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
251 uint32_t maxX, uint32_t maxY)
252{
253 return drm_helper_probe_single_connector_modes_merge_bits(connector, maxX, maxY, true);
254}
255EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
256
257
258
259
260
261
262
263
264
265
266int drm_helper_probe_single_connector_modes_nomerge(struct drm_connector *connector,
267 uint32_t maxX, uint32_t maxY)
268{
269 return drm_helper_probe_single_connector_modes_merge_bits(connector, maxX, maxY, false);
270}
271EXPORT_SYMBOL(drm_helper_probe_single_connector_modes_nomerge);
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289void drm_kms_helper_hotplug_event(struct drm_device *dev)
290{
291
292 drm_sysfs_hotplug_event(dev);
293 if (dev->mode_config.funcs->output_poll_changed)
294 dev->mode_config.funcs->output_poll_changed(dev);
295}
296EXPORT_SYMBOL(drm_kms_helper_hotplug_event);
297
298#define DRM_OUTPUT_POLL_PERIOD (10*HZ)
299static void output_poll_execute(struct work_struct *work)
300{
301 struct delayed_work *delayed_work = to_delayed_work(work);
302 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_work);
303 struct drm_connector *connector;
304 enum drm_connector_status old_status;
305 bool repoll = false, changed;
306
307
308 changed = dev->mode_config.delayed_event;
309 dev->mode_config.delayed_event = false;
310
311 if (!drm_kms_helper_poll)
312 goto out;
313
314 mutex_lock(&dev->mode_config.mutex);
315 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
316
317
318 if (connector->force)
319 continue;
320
321
322
323 if (!connector->polled || connector->polled == DRM_CONNECTOR_POLL_HPD)
324 continue;
325
326 repoll = true;
327
328 old_status = connector->status;
329
330
331 if (old_status == connector_status_connected &&
332 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT))
333 continue;
334
335 connector->status = connector->funcs->detect(connector, false);
336 if (old_status != connector->status) {
337 const char *old, *new;
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352 if (connector->status == connector_status_unknown) {
353 connector->status = old_status;
354 continue;
355 }
356
357 old = drm_get_connector_status_name(old_status);
358 new = drm_get_connector_status_name(connector->status);
359
360 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] "
361 "status updated from %s to %s\n",
362 connector->base.id,
363 connector->name,
364 old, new);
365
366 changed = true;
367 }
368 }
369
370 mutex_unlock(&dev->mode_config.mutex);
371
372out:
373 if (changed)
374 drm_kms_helper_hotplug_event(dev);
375
376 if (repoll)
377 schedule_delayed_work(delayed_work, DRM_OUTPUT_POLL_PERIOD);
378}
379
380
381
382
383
384
385
386
387
388
389
390void drm_kms_helper_poll_disable(struct drm_device *dev)
391{
392 if (!dev->mode_config.poll_enabled)
393 return;
394 cancel_delayed_work_sync(&dev->mode_config.output_poll_work);
395}
396EXPORT_SYMBOL(drm_kms_helper_poll_disable);
397
398
399
400
401
402
403
404
405
406
407
408void drm_kms_helper_poll_enable(struct drm_device *dev)
409{
410 bool poll = false;
411 struct drm_connector *connector;
412
413 if (!dev->mode_config.poll_enabled || !drm_kms_helper_poll)
414 return;
415
416 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
417 if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT |
418 DRM_CONNECTOR_POLL_DISCONNECT))
419 poll = true;
420 }
421
422 if (poll)
423 schedule_delayed_work(&dev->mode_config.output_poll_work, DRM_OUTPUT_POLL_PERIOD);
424}
425EXPORT_SYMBOL(drm_kms_helper_poll_enable);
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446void drm_kms_helper_poll_init(struct drm_device *dev)
447{
448 INIT_DELAYED_WORK(&dev->mode_config.output_poll_work, output_poll_execute);
449 dev->mode_config.poll_enabled = true;
450
451 drm_kms_helper_poll_enable(dev);
452}
453EXPORT_SYMBOL(drm_kms_helper_poll_init);
454
455
456
457
458
459void drm_kms_helper_poll_fini(struct drm_device *dev)
460{
461 drm_kms_helper_poll_disable(dev);
462}
463EXPORT_SYMBOL(drm_kms_helper_poll_fini);
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488bool drm_helper_hpd_irq_event(struct drm_device *dev)
489{
490 struct drm_connector *connector;
491 enum drm_connector_status old_status;
492 bool changed = false;
493
494 if (!dev->mode_config.poll_enabled)
495 return false;
496
497 mutex_lock(&dev->mode_config.mutex);
498 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
499
500
501 if (!(connector->polled & DRM_CONNECTOR_POLL_HPD))
502 continue;
503
504 old_status = connector->status;
505
506 connector->status = connector->funcs->detect(connector, false);
507 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
508 connector->base.id,
509 connector->name,
510 drm_get_connector_status_name(old_status),
511 drm_get_connector_status_name(connector->status));
512 if (old_status != connector->status)
513 changed = true;
514 }
515
516 mutex_unlock(&dev->mode_config.mutex);
517
518 if (changed)
519 drm_kms_helper_hotplug_event(dev);
520
521 return changed;
522}
523EXPORT_SYMBOL(drm_helper_hpd_irq_event);
524