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 void drm_mode_validate_flag(struct drm_connector *connector,
62 int flags)
63{
64 struct drm_display_mode *mode;
65
66 if (flags == (DRM_MODE_FLAG_DBLSCAN | DRM_MODE_FLAG_INTERLACE |
67 DRM_MODE_FLAG_3D_MASK))
68 return;
69
70 list_for_each_entry(mode, &connector->modes, head) {
71 if ((mode->flags & DRM_MODE_FLAG_INTERLACE) &&
72 !(flags & DRM_MODE_FLAG_INTERLACE))
73 mode->status = MODE_NO_INTERLACE;
74 if ((mode->flags & DRM_MODE_FLAG_DBLSCAN) &&
75 !(flags & DRM_MODE_FLAG_DBLSCAN))
76 mode->status = MODE_NO_DBLESCAN;
77 if ((mode->flags & DRM_MODE_FLAG_3D_MASK) &&
78 !(flags & DRM_MODE_FLAG_3D_MASK))
79 mode->status = MODE_NO_STEREO;
80 }
81
82 return;
83}
84
85static int drm_helper_probe_single_connector_modes_merge_bits(struct drm_connector *connector,
86 uint32_t maxX, uint32_t maxY, bool merge_type_bits)
87{
88 struct drm_device *dev = connector->dev;
89 struct drm_display_mode *mode;
90 struct drm_connector_helper_funcs *connector_funcs =
91 connector->helper_private;
92 int count = 0;
93 int mode_flags = 0;
94 bool verbose_prune = true;
95
96 WARN_ON(!mutex_is_locked(&dev->mode_config.mutex));
97
98 DRM_DEBUG_KMS("[CONNECTOR:%d:%s]\n", connector->base.id,
99 connector->name);
100
101 list_for_each_entry(mode, &connector->modes, head)
102 mode->status = MODE_UNVERIFIED;
103
104 if (connector->force) {
105 if (connector->force == DRM_FORCE_ON)
106 connector->status = connector_status_connected;
107 else
108 connector->status = connector_status_disconnected;
109 if (connector->funcs->force)
110 connector->funcs->force(connector);
111 } else {
112 connector->status = connector->funcs->detect(connector, true);
113 }
114
115
116 if (drm_kms_helper_poll != dev->mode_config.poll_running)
117 drm_kms_helper_poll_enable(dev);
118
119 dev->mode_config.poll_running = drm_kms_helper_poll;
120
121 if (connector->status == connector_status_disconnected) {
122 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] disconnected\n",
123 connector->base.id, connector->name);
124 drm_mode_connector_update_edid_property(connector, NULL);
125 verbose_prune = false;
126 goto prune;
127 }
128
129#ifdef CONFIG_DRM_LOAD_EDID_FIRMWARE
130 count = drm_load_edid_firmware(connector);
131 if (count == 0)
132#endif
133 count = (*connector_funcs->get_modes)(connector);
134
135 if (count == 0 && connector->status == connector_status_connected)
136 count = drm_add_modes_noedid(connector, 1024, 768);
137 if (count == 0)
138 goto prune;
139
140 drm_mode_connector_list_update(connector, merge_type_bits);
141
142 if (maxX && maxY)
143 drm_mode_validate_size(dev, &connector->modes, maxX, maxY);
144
145 if (connector->interlace_allowed)
146 mode_flags |= DRM_MODE_FLAG_INTERLACE;
147 if (connector->doublescan_allowed)
148 mode_flags |= DRM_MODE_FLAG_DBLSCAN;
149 if (connector->stereo_allowed)
150 mode_flags |= DRM_MODE_FLAG_3D_MASK;
151 drm_mode_validate_flag(connector, mode_flags);
152
153 list_for_each_entry(mode, &connector->modes, head) {
154 if (mode->status == MODE_OK && connector_funcs->mode_valid)
155 mode->status = connector_funcs->mode_valid(connector,
156 mode);
157 }
158
159prune:
160 drm_mode_prune_invalid(dev, &connector->modes, verbose_prune);
161
162 if (list_empty(&connector->modes))
163 return 0;
164
165 list_for_each_entry(mode, &connector->modes, head)
166 mode->vrefresh = drm_mode_vrefresh(mode);
167
168 drm_mode_sort(&connector->modes);
169
170 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] probed modes :\n", connector->base.id,
171 connector->name);
172 list_for_each_entry(mode, &connector->modes, head) {
173 drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
174 drm_mode_debug_printmodeline(mode);
175 }
176
177 return count;
178}
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198int drm_helper_probe_single_connector_modes(struct drm_connector *connector,
199 uint32_t maxX, uint32_t maxY)
200{
201 return drm_helper_probe_single_connector_modes_merge_bits(connector, maxX, maxY, true);
202}
203EXPORT_SYMBOL(drm_helper_probe_single_connector_modes);
204
205
206
207
208
209
210
211
212
213
214int drm_helper_probe_single_connector_modes_nomerge(struct drm_connector *connector,
215 uint32_t maxX, uint32_t maxY)
216{
217 return drm_helper_probe_single_connector_modes_merge_bits(connector, maxX, maxY, false);
218}
219EXPORT_SYMBOL(drm_helper_probe_single_connector_modes_nomerge);
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237void drm_kms_helper_hotplug_event(struct drm_device *dev)
238{
239
240 drm_sysfs_hotplug_event(dev);
241 if (dev->mode_config.funcs->output_poll_changed)
242 dev->mode_config.funcs->output_poll_changed(dev);
243}
244EXPORT_SYMBOL(drm_kms_helper_hotplug_event);
245
246#define DRM_OUTPUT_POLL_PERIOD (10*HZ)
247static void output_poll_execute(struct work_struct *work)
248{
249 struct delayed_work *delayed_work = to_delayed_work(work);
250 struct drm_device *dev = container_of(delayed_work, struct drm_device, mode_config.output_poll_work);
251 struct drm_connector *connector;
252 enum drm_connector_status old_status;
253 bool repoll = false, changed = false;
254
255 if (!drm_kms_helper_poll)
256 return;
257
258 mutex_lock(&dev->mode_config.mutex);
259 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
260
261
262 if (connector->force)
263 continue;
264
265
266
267 if (!connector->polled || connector->polled == DRM_CONNECTOR_POLL_HPD)
268 continue;
269
270 repoll = true;
271
272 old_status = connector->status;
273
274
275 if (old_status == connector_status_connected &&
276 !(connector->polled & DRM_CONNECTOR_POLL_DISCONNECT))
277 continue;
278
279 connector->status = connector->funcs->detect(connector, false);
280 if (old_status != connector->status) {
281 const char *old, *new;
282
283 old = drm_get_connector_status_name(old_status);
284 new = drm_get_connector_status_name(connector->status);
285
286 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] "
287 "status updated from %s to %s\n",
288 connector->base.id,
289 connector->name,
290 old, new);
291
292 changed = true;
293 }
294 }
295
296 mutex_unlock(&dev->mode_config.mutex);
297
298 if (changed)
299 drm_kms_helper_hotplug_event(dev);
300
301 if (repoll)
302 schedule_delayed_work(delayed_work, DRM_OUTPUT_POLL_PERIOD);
303}
304
305
306
307
308
309
310
311
312
313
314
315void drm_kms_helper_poll_disable(struct drm_device *dev)
316{
317 if (!dev->mode_config.poll_enabled)
318 return;
319 cancel_delayed_work_sync(&dev->mode_config.output_poll_work);
320}
321EXPORT_SYMBOL(drm_kms_helper_poll_disable);
322
323
324
325
326
327
328
329
330
331
332
333void drm_kms_helper_poll_enable(struct drm_device *dev)
334{
335 bool poll = false;
336 struct drm_connector *connector;
337
338 if (!dev->mode_config.poll_enabled || !drm_kms_helper_poll)
339 return;
340
341 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
342 if (connector->polled & (DRM_CONNECTOR_POLL_CONNECT |
343 DRM_CONNECTOR_POLL_DISCONNECT))
344 poll = true;
345 }
346
347 if (poll)
348 schedule_delayed_work(&dev->mode_config.output_poll_work, DRM_OUTPUT_POLL_PERIOD);
349}
350EXPORT_SYMBOL(drm_kms_helper_poll_enable);
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371void drm_kms_helper_poll_init(struct drm_device *dev)
372{
373 INIT_DELAYED_WORK(&dev->mode_config.output_poll_work, output_poll_execute);
374 dev->mode_config.poll_enabled = true;
375
376 drm_kms_helper_poll_enable(dev);
377}
378EXPORT_SYMBOL(drm_kms_helper_poll_init);
379
380
381
382
383
384void drm_kms_helper_poll_fini(struct drm_device *dev)
385{
386 drm_kms_helper_poll_disable(dev);
387}
388EXPORT_SYMBOL(drm_kms_helper_poll_fini);
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413bool drm_helper_hpd_irq_event(struct drm_device *dev)
414{
415 struct drm_connector *connector;
416 enum drm_connector_status old_status;
417 bool changed = false;
418
419 if (!dev->mode_config.poll_enabled)
420 return false;
421
422 mutex_lock(&dev->mode_config.mutex);
423 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
424
425
426 if (!(connector->polled & DRM_CONNECTOR_POLL_HPD))
427 continue;
428
429 old_status = connector->status;
430
431 connector->status = connector->funcs->detect(connector, false);
432 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %s to %s\n",
433 connector->base.id,
434 connector->name,
435 drm_get_connector_status_name(old_status),
436 drm_get_connector_status_name(connector->status));
437 if (old_status != connector->status)
438 changed = true;
439 }
440
441 mutex_unlock(&dev->mode_config.mutex);
442
443 if (changed)
444 drm_kms_helper_hotplug_event(dev);
445
446 return changed;
447}
448EXPORT_SYMBOL(drm_helper_hpd_irq_event);
449