1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/wait.h>
21
22#include <drm/drm_atomic.h>
23#include <drm/drm_atomic_helper.h>
24#include <drm/drm_crtc_helper.h>
25#include <drm/drm_fb_helper.h>
26
27#include "omap_dmm_tiler.h"
28#include "omap_drv.h"
29
30#define DRIVER_NAME MODULE_NAME
31#define DRIVER_DESC "OMAP DRM"
32#define DRIVER_DATE "20110917"
33#define DRIVER_MAJOR 1
34#define DRIVER_MINOR 0
35#define DRIVER_PATCHLEVEL 0
36
37static int num_crtc = CONFIG_DRM_OMAP_NUM_CRTCS;
38
39MODULE_PARM_DESC(num_crtc, "Number of overlays to use as CRTCs");
40module_param(num_crtc, int, 0600);
41
42
43
44
45
46
47
48
49
50
51
52
53
54static void omap_fb_output_poll_changed(struct drm_device *dev)
55{
56 struct omap_drm_private *priv = dev->dev_private;
57 DBG("dev=%p", dev);
58 if (priv->fbdev)
59 drm_fb_helper_hotplug_event(priv->fbdev);
60}
61
62struct omap_atomic_state_commit {
63 struct work_struct work;
64 struct drm_device *dev;
65 struct drm_atomic_state *state;
66 u32 crtcs;
67};
68
69static void omap_atomic_wait_for_completion(struct drm_device *dev,
70 struct drm_atomic_state *old_state)
71{
72 struct drm_crtc_state *old_crtc_state;
73 struct drm_crtc *crtc;
74 unsigned int i;
75 int ret;
76
77 for_each_crtc_in_state(old_state, crtc, old_crtc_state, i) {
78 if (!crtc->state->enable)
79 continue;
80
81 ret = omap_crtc_wait_pending(crtc);
82
83 if (!ret)
84 dev_warn(dev->dev,
85 "atomic complete timeout (pipe %u)!\n", i);
86 }
87}
88
89static void omap_atomic_complete(struct omap_atomic_state_commit *commit)
90{
91 struct drm_device *dev = commit->dev;
92 struct omap_drm_private *priv = dev->dev_private;
93 struct drm_atomic_state *old_state = commit->state;
94
95
96 dispc_runtime_get();
97
98 drm_atomic_helper_commit_modeset_disables(dev, old_state);
99 drm_atomic_helper_commit_planes(dev, old_state, false);
100 drm_atomic_helper_commit_modeset_enables(dev, old_state);
101
102 omap_atomic_wait_for_completion(dev, old_state);
103
104 drm_atomic_helper_cleanup_planes(dev, old_state);
105
106 dispc_runtime_put();
107
108 drm_atomic_state_free(old_state);
109
110
111 spin_lock(&priv->commit.lock);
112 priv->commit.pending &= ~commit->crtcs;
113 spin_unlock(&priv->commit.lock);
114
115 wake_up_all(&priv->commit.wait);
116
117 kfree(commit);
118}
119
120static void omap_atomic_work(struct work_struct *work)
121{
122 struct omap_atomic_state_commit *commit =
123 container_of(work, struct omap_atomic_state_commit, work);
124
125 omap_atomic_complete(commit);
126}
127
128static bool omap_atomic_is_pending(struct omap_drm_private *priv,
129 struct omap_atomic_state_commit *commit)
130{
131 bool pending;
132
133 spin_lock(&priv->commit.lock);
134 pending = priv->commit.pending & commit->crtcs;
135 spin_unlock(&priv->commit.lock);
136
137 return pending;
138}
139
140static int omap_atomic_commit(struct drm_device *dev,
141 struct drm_atomic_state *state, bool nonblock)
142{
143 struct omap_drm_private *priv = dev->dev_private;
144 struct omap_atomic_state_commit *commit;
145 struct drm_crtc *crtc;
146 struct drm_crtc_state *crtc_state;
147 int i, ret;
148
149 ret = drm_atomic_helper_prepare_planes(dev, state);
150 if (ret)
151 return ret;
152
153
154 commit = kzalloc(sizeof(*commit), GFP_KERNEL);
155 if (commit == NULL) {
156 ret = -ENOMEM;
157 goto error;
158 }
159
160 INIT_WORK(&commit->work, omap_atomic_work);
161 commit->dev = dev;
162 commit->state = state;
163
164
165
166
167 for_each_crtc_in_state(state, crtc, crtc_state, i)
168 commit->crtcs |= drm_crtc_mask(crtc);
169
170 wait_event(priv->commit.wait, !omap_atomic_is_pending(priv, commit));
171
172 spin_lock(&priv->commit.lock);
173 priv->commit.pending |= commit->crtcs;
174 spin_unlock(&priv->commit.lock);
175
176
177 drm_atomic_helper_swap_state(state, true);
178
179 if (nonblock)
180 schedule_work(&commit->work);
181 else
182 omap_atomic_complete(commit);
183
184 return 0;
185
186error:
187 drm_atomic_helper_cleanup_planes(dev, state);
188 return ret;
189}
190
191static const struct drm_mode_config_funcs omap_mode_config_funcs = {
192 .fb_create = omap_framebuffer_create,
193 .output_poll_changed = omap_fb_output_poll_changed,
194 .atomic_check = drm_atomic_helper_check,
195 .atomic_commit = omap_atomic_commit,
196};
197
198static int get_connector_type(struct omap_dss_device *dssdev)
199{
200 switch (dssdev->type) {
201 case OMAP_DISPLAY_TYPE_HDMI:
202 return DRM_MODE_CONNECTOR_HDMIA;
203 case OMAP_DISPLAY_TYPE_DVI:
204 return DRM_MODE_CONNECTOR_DVID;
205 case OMAP_DISPLAY_TYPE_DSI:
206 return DRM_MODE_CONNECTOR_DSI;
207 default:
208 return DRM_MODE_CONNECTOR_Unknown;
209 }
210}
211
212static bool channel_used(struct drm_device *dev, enum omap_channel channel)
213{
214 struct omap_drm_private *priv = dev->dev_private;
215 int i;
216
217 for (i = 0; i < priv->num_crtcs; i++) {
218 struct drm_crtc *crtc = priv->crtcs[i];
219
220 if (omap_crtc_channel(crtc) == channel)
221 return true;
222 }
223
224 return false;
225}
226static void omap_disconnect_dssdevs(void)
227{
228 struct omap_dss_device *dssdev = NULL;
229
230 for_each_dss_dev(dssdev)
231 dssdev->driver->disconnect(dssdev);
232}
233
234static int omap_connect_dssdevs(void)
235{
236 int r;
237 struct omap_dss_device *dssdev = NULL;
238 bool no_displays = true;
239
240 for_each_dss_dev(dssdev) {
241 r = dssdev->driver->connect(dssdev);
242 if (r == -EPROBE_DEFER) {
243 omap_dss_put_device(dssdev);
244 goto cleanup;
245 } else if (r) {
246 dev_warn(dssdev->dev, "could not connect display: %s\n",
247 dssdev->name);
248 } else {
249 no_displays = false;
250 }
251 }
252
253 if (no_displays)
254 return -EPROBE_DEFER;
255
256 return 0;
257
258cleanup:
259
260
261
262
263 omap_disconnect_dssdevs();
264
265 return r;
266}
267
268static int omap_modeset_create_crtc(struct drm_device *dev, int id,
269 enum omap_channel channel)
270{
271 struct omap_drm_private *priv = dev->dev_private;
272 struct drm_plane *plane;
273 struct drm_crtc *crtc;
274
275 plane = omap_plane_init(dev, id, DRM_PLANE_TYPE_PRIMARY);
276 if (IS_ERR(plane))
277 return PTR_ERR(plane);
278
279 crtc = omap_crtc_init(dev, plane, channel, id);
280
281 BUG_ON(priv->num_crtcs >= ARRAY_SIZE(priv->crtcs));
282 priv->crtcs[id] = crtc;
283 priv->num_crtcs++;
284
285 priv->planes[id] = plane;
286 priv->num_planes++;
287
288 return 0;
289}
290
291static int omap_modeset_init_properties(struct drm_device *dev)
292{
293 struct omap_drm_private *priv = dev->dev_private;
294
295 if (priv->has_dmm) {
296 dev->mode_config.rotation_property =
297 drm_mode_create_rotation_property(dev,
298 BIT(DRM_ROTATE_0) | BIT(DRM_ROTATE_90) |
299 BIT(DRM_ROTATE_180) | BIT(DRM_ROTATE_270) |
300 BIT(DRM_REFLECT_X) | BIT(DRM_REFLECT_Y));
301 if (!dev->mode_config.rotation_property)
302 return -ENOMEM;
303 }
304
305 priv->zorder_prop = drm_property_create_range(dev, 0, "zorder", 0, 3);
306 if (!priv->zorder_prop)
307 return -ENOMEM;
308
309 return 0;
310}
311
312static int omap_modeset_init(struct drm_device *dev)
313{
314 struct omap_drm_private *priv = dev->dev_private;
315 struct omap_dss_device *dssdev = NULL;
316 int num_ovls = dss_feat_get_num_ovls();
317 int num_mgrs = dss_feat_get_num_mgrs();
318 int num_crtcs;
319 int i, id = 0;
320 int ret;
321
322 drm_mode_config_init(dev);
323
324 omap_drm_irq_install(dev);
325
326 ret = omap_modeset_init_properties(dev);
327 if (ret < 0)
328 return ret;
329
330
331
332
333
334
335
336 num_crtcs = min3(num_crtc, num_mgrs, num_ovls);
337
338 dssdev = NULL;
339
340 for_each_dss_dev(dssdev) {
341 struct drm_connector *connector;
342 struct drm_encoder *encoder;
343 enum omap_channel channel;
344 struct omap_dss_device *out;
345
346 if (!omapdss_device_is_connected(dssdev))
347 continue;
348
349 encoder = omap_encoder_init(dev, dssdev);
350
351 if (!encoder) {
352 dev_err(dev->dev, "could not create encoder: %s\n",
353 dssdev->name);
354 return -ENOMEM;
355 }
356
357 connector = omap_connector_init(dev,
358 get_connector_type(dssdev), dssdev, encoder);
359
360 if (!connector) {
361 dev_err(dev->dev, "could not create connector: %s\n",
362 dssdev->name);
363 return -ENOMEM;
364 }
365
366 BUG_ON(priv->num_encoders >= ARRAY_SIZE(priv->encoders));
367 BUG_ON(priv->num_connectors >= ARRAY_SIZE(priv->connectors));
368
369 priv->encoders[priv->num_encoders++] = encoder;
370 priv->connectors[priv->num_connectors++] = connector;
371
372 drm_mode_connector_attach_encoder(connector, encoder);
373
374
375
376
377
378
379
380
381 if (id == num_crtcs)
382 continue;
383
384
385
386
387
388
389
390
391 out = omapdss_find_output_from_display(dssdev);
392 channel = out->dispc_channel;
393 omap_dss_put_device(out);
394
395
396
397
398
399 if (!channel_used(dev, channel)) {
400 ret = omap_modeset_create_crtc(dev, id, channel);
401 if (ret < 0) {
402 dev_err(dev->dev,
403 "could not create CRTC (channel %u)\n",
404 channel);
405 return ret;
406 }
407
408 id++;
409 }
410 }
411
412
413
414
415
416 for (; id < num_crtcs; id++) {
417
418
419 for (i = 0; i < num_mgrs; i++) {
420 if (!channel_used(dev, i))
421 break;
422 }
423
424 if (i == num_mgrs) {
425
426 dev_err(dev->dev, "no managers left for crtc\n");
427 return -ENOMEM;
428 }
429
430 ret = omap_modeset_create_crtc(dev, id, i);
431 if (ret < 0) {
432 dev_err(dev->dev,
433 "could not create CRTC (channel %u)\n", i);
434 return ret;
435 }
436 }
437
438
439
440
441 for (; id < num_ovls; id++) {
442 struct drm_plane *plane;
443
444 plane = omap_plane_init(dev, id, DRM_PLANE_TYPE_OVERLAY);
445 if (IS_ERR(plane))
446 return PTR_ERR(plane);
447
448 BUG_ON(priv->num_planes >= ARRAY_SIZE(priv->planes));
449 priv->planes[priv->num_planes++] = plane;
450 }
451
452 for (i = 0; i < priv->num_encoders; i++) {
453 struct drm_encoder *encoder = priv->encoders[i];
454 struct omap_dss_device *dssdev =
455 omap_encoder_get_dssdev(encoder);
456 struct omap_dss_device *output;
457
458 output = omapdss_find_output_from_display(dssdev);
459
460
461 encoder->possible_crtcs = 0;
462 for (id = 0; id < priv->num_crtcs; id++) {
463 struct drm_crtc *crtc = priv->crtcs[id];
464 enum omap_channel crtc_channel;
465
466 crtc_channel = omap_crtc_channel(crtc);
467
468 if (output->dispc_channel == crtc_channel) {
469 encoder->possible_crtcs |= (1 << id);
470 break;
471 }
472 }
473
474 omap_dss_put_device(output);
475 }
476
477 DBG("registered %d planes, %d crtcs, %d encoders and %d connectors\n",
478 priv->num_planes, priv->num_crtcs, priv->num_encoders,
479 priv->num_connectors);
480
481 dev->mode_config.min_width = 32;
482 dev->mode_config.min_height = 32;
483
484
485
486
487 dev->mode_config.max_width = 2048;
488 dev->mode_config.max_height = 2048;
489
490 dev->mode_config.funcs = &omap_mode_config_funcs;
491
492 drm_mode_config_reset(dev);
493
494 return 0;
495}
496
497static void omap_modeset_free(struct drm_device *dev)
498{
499 drm_mode_config_cleanup(dev);
500}
501
502
503
504
505
506
507static int ioctl_get_param(struct drm_device *dev, void *data,
508 struct drm_file *file_priv)
509{
510 struct omap_drm_private *priv = dev->dev_private;
511 struct drm_omap_param *args = data;
512
513 DBG("%p: param=%llu", dev, args->param);
514
515 switch (args->param) {
516 case OMAP_PARAM_CHIPSET_ID:
517 args->value = priv->omaprev;
518 break;
519 default:
520 DBG("unknown parameter %lld", args->param);
521 return -EINVAL;
522 }
523
524 return 0;
525}
526
527static int ioctl_set_param(struct drm_device *dev, void *data,
528 struct drm_file *file_priv)
529{
530 struct drm_omap_param *args = data;
531
532 switch (args->param) {
533 default:
534 DBG("unknown parameter %lld", args->param);
535 return -EINVAL;
536 }
537
538 return 0;
539}
540
541#define OMAP_BO_USER_MASK 0x00ffffff
542
543static int ioctl_gem_new(struct drm_device *dev, void *data,
544 struct drm_file *file_priv)
545{
546 struct drm_omap_gem_new *args = data;
547 u32 flags = args->flags & OMAP_BO_USER_MASK;
548
549 VERB("%p:%p: size=0x%08x, flags=%08x", dev, file_priv,
550 args->size.bytes, flags);
551
552 return omap_gem_new_handle(dev, file_priv, args->size, flags,
553 &args->handle);
554}
555
556static int ioctl_gem_cpu_prep(struct drm_device *dev, void *data,
557 struct drm_file *file_priv)
558{
559 struct drm_omap_gem_cpu_prep *args = data;
560 struct drm_gem_object *obj;
561 int ret;
562
563 VERB("%p:%p: handle=%d, op=%x", dev, file_priv, args->handle, args->op);
564
565 obj = drm_gem_object_lookup(file_priv, args->handle);
566 if (!obj)
567 return -ENOENT;
568
569 ret = omap_gem_op_sync(obj, args->op);
570
571 if (!ret)
572 ret = omap_gem_op_start(obj, args->op);
573
574 drm_gem_object_unreference_unlocked(obj);
575
576 return ret;
577}
578
579static int ioctl_gem_cpu_fini(struct drm_device *dev, void *data,
580 struct drm_file *file_priv)
581{
582 struct drm_omap_gem_cpu_fini *args = data;
583 struct drm_gem_object *obj;
584 int ret;
585
586 VERB("%p:%p: handle=%d", dev, file_priv, args->handle);
587
588 obj = drm_gem_object_lookup(file_priv, args->handle);
589 if (!obj)
590 return -ENOENT;
591
592
593 ret = 0;
594
595 if (!ret)
596 ret = omap_gem_op_finish(obj, args->op);
597
598 drm_gem_object_unreference_unlocked(obj);
599
600 return ret;
601}
602
603static int ioctl_gem_info(struct drm_device *dev, void *data,
604 struct drm_file *file_priv)
605{
606 struct drm_omap_gem_info *args = data;
607 struct drm_gem_object *obj;
608 int ret = 0;
609
610 VERB("%p:%p: handle=%d", dev, file_priv, args->handle);
611
612 obj = drm_gem_object_lookup(file_priv, args->handle);
613 if (!obj)
614 return -ENOENT;
615
616 args->size = omap_gem_mmap_size(obj);
617 args->offset = omap_gem_mmap_offset(obj);
618
619 drm_gem_object_unreference_unlocked(obj);
620
621 return ret;
622}
623
624static const struct drm_ioctl_desc ioctls[DRM_COMMAND_END - DRM_COMMAND_BASE] = {
625 DRM_IOCTL_DEF_DRV(OMAP_GET_PARAM, ioctl_get_param, DRM_AUTH),
626 DRM_IOCTL_DEF_DRV(OMAP_SET_PARAM, ioctl_set_param, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
627 DRM_IOCTL_DEF_DRV(OMAP_GEM_NEW, ioctl_gem_new, DRM_AUTH),
628 DRM_IOCTL_DEF_DRV(OMAP_GEM_CPU_PREP, ioctl_gem_cpu_prep, DRM_AUTH),
629 DRM_IOCTL_DEF_DRV(OMAP_GEM_CPU_FINI, ioctl_gem_cpu_fini, DRM_AUTH),
630 DRM_IOCTL_DEF_DRV(OMAP_GEM_INFO, ioctl_gem_info, DRM_AUTH),
631};
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647static int dev_load(struct drm_device *dev, unsigned long flags)
648{
649 struct omap_drm_platform_data *pdata = dev->dev->platform_data;
650 struct omap_drm_private *priv;
651 unsigned int i;
652 int ret;
653
654 DBG("load: dev=%p", dev);
655
656 priv = kzalloc(sizeof(*priv), GFP_KERNEL);
657 if (!priv)
658 return -ENOMEM;
659
660 priv->omaprev = pdata->omaprev;
661
662 dev->dev_private = priv;
663
664 priv->wq = alloc_ordered_workqueue("omapdrm", 0);
665 init_waitqueue_head(&priv->commit.wait);
666 spin_lock_init(&priv->commit.lock);
667
668 spin_lock_init(&priv->list_lock);
669 INIT_LIST_HEAD(&priv->obj_list);
670
671 omap_gem_init(dev);
672
673 ret = omap_modeset_init(dev);
674 if (ret) {
675 dev_err(dev->dev, "omap_modeset_init failed: ret=%d\n", ret);
676 dev->dev_private = NULL;
677 kfree(priv);
678 return ret;
679 }
680
681
682 ret = drm_vblank_init(dev, priv->num_crtcs);
683 if (ret)
684 dev_warn(dev->dev, "could not init vblank\n");
685
686 for (i = 0; i < priv->num_crtcs; i++)
687 drm_crtc_vblank_off(priv->crtcs[i]);
688
689 priv->fbdev = omap_fbdev_init(dev);
690
691
692 dev_set_drvdata(dev->dev, dev);
693
694 drm_kms_helper_poll_init(dev);
695
696 return 0;
697}
698
699static int dev_unload(struct drm_device *dev)
700{
701 struct omap_drm_private *priv = dev->dev_private;
702
703 DBG("unload: dev=%p", dev);
704
705 drm_kms_helper_poll_fini(dev);
706
707 if (priv->fbdev)
708 omap_fbdev_free(dev);
709
710 omap_modeset_free(dev);
711 omap_gem_deinit(dev);
712
713 destroy_workqueue(priv->wq);
714
715 drm_vblank_cleanup(dev);
716 omap_drm_irq_uninstall(dev);
717
718 kfree(dev->dev_private);
719 dev->dev_private = NULL;
720
721 dev_set_drvdata(dev->dev, NULL);
722
723 return 0;
724}
725
726static int dev_open(struct drm_device *dev, struct drm_file *file)
727{
728 file->driver_priv = NULL;
729
730 DBG("open: dev=%p, file=%p", dev, file);
731
732 return 0;
733}
734
735
736
737
738
739
740
741
742
743static void dev_lastclose(struct drm_device *dev)
744{
745 int i;
746
747
748
749
750 struct omap_drm_private *priv = dev->dev_private;
751 int ret;
752
753 DBG("lastclose: dev=%p", dev);
754
755 if (dev->mode_config.rotation_property) {
756
757
758
759
760
761
762 for (i = 0; i < priv->num_crtcs; i++) {
763 drm_object_property_set_value(&priv->crtcs[i]->base,
764 dev->mode_config.rotation_property, 0);
765 }
766
767 for (i = 0; i < priv->num_planes; i++) {
768 drm_object_property_set_value(&priv->planes[i]->base,
769 dev->mode_config.rotation_property, 0);
770 }
771 }
772
773 if (priv->fbdev) {
774 ret = drm_fb_helper_restore_fbdev_mode_unlocked(priv->fbdev);
775 if (ret)
776 DBG("failed to restore crtc mode");
777 }
778}
779
780static const struct vm_operations_struct omap_gem_vm_ops = {
781 .fault = omap_gem_fault,
782 .open = drm_gem_vm_open,
783 .close = drm_gem_vm_close,
784};
785
786static const struct file_operations omapdriver_fops = {
787 .owner = THIS_MODULE,
788 .open = drm_open,
789 .unlocked_ioctl = drm_ioctl,
790 .release = drm_release,
791 .mmap = omap_gem_mmap,
792 .poll = drm_poll,
793 .read = drm_read,
794 .llseek = noop_llseek,
795};
796
797static struct drm_driver omap_drm_driver = {
798 .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME |
799 DRIVER_ATOMIC,
800 .load = dev_load,
801 .unload = dev_unload,
802 .open = dev_open,
803 .lastclose = dev_lastclose,
804 .get_vblank_counter = drm_vblank_no_hw_counter,
805 .enable_vblank = omap_irq_enable_vblank,
806 .disable_vblank = omap_irq_disable_vblank,
807#ifdef CONFIG_DEBUG_FS
808 .debugfs_init = omap_debugfs_init,
809 .debugfs_cleanup = omap_debugfs_cleanup,
810#endif
811 .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
812 .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
813 .gem_prime_export = omap_gem_prime_export,
814 .gem_prime_import = omap_gem_prime_import,
815 .gem_free_object = omap_gem_free_object,
816 .gem_vm_ops = &omap_gem_vm_ops,
817 .dumb_create = omap_gem_dumb_create,
818 .dumb_map_offset = omap_gem_dumb_map_offset,
819 .dumb_destroy = drm_gem_dumb_destroy,
820 .ioctls = ioctls,
821 .num_ioctls = DRM_OMAP_NUM_IOCTLS,
822 .fops = &omapdriver_fops,
823 .name = DRIVER_NAME,
824 .desc = DRIVER_DESC,
825 .date = DRIVER_DATE,
826 .major = DRIVER_MAJOR,
827 .minor = DRIVER_MINOR,
828 .patchlevel = DRIVER_PATCHLEVEL,
829};
830
831static int pdev_probe(struct platform_device *device)
832{
833 int r;
834
835 if (omapdss_is_initialized() == false)
836 return -EPROBE_DEFER;
837
838 omap_crtc_pre_init();
839
840 r = omap_connect_dssdevs();
841 if (r) {
842 omap_crtc_pre_uninit();
843 return r;
844 }
845
846 DBG("%s", device->name);
847 return drm_platform_init(&omap_drm_driver, device);
848}
849
850static int pdev_remove(struct platform_device *device)
851{
852 DBG("");
853
854 drm_put_dev(platform_get_drvdata(device));
855
856 omap_disconnect_dssdevs();
857 omap_crtc_pre_uninit();
858
859 return 0;
860}
861
862#ifdef CONFIG_PM_SLEEP
863static int omap_drm_suspend_all_displays(void)
864{
865 struct omap_dss_device *dssdev = NULL;
866
867 for_each_dss_dev(dssdev) {
868 if (!dssdev->driver)
869 continue;
870
871 if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE) {
872 dssdev->driver->disable(dssdev);
873 dssdev->activate_after_resume = true;
874 } else {
875 dssdev->activate_after_resume = false;
876 }
877 }
878
879 return 0;
880}
881
882static int omap_drm_resume_all_displays(void)
883{
884 struct omap_dss_device *dssdev = NULL;
885
886 for_each_dss_dev(dssdev) {
887 if (!dssdev->driver)
888 continue;
889
890 if (dssdev->activate_after_resume) {
891 dssdev->driver->enable(dssdev);
892 dssdev->activate_after_resume = false;
893 }
894 }
895
896 return 0;
897}
898
899static int omap_drm_suspend(struct device *dev)
900{
901 struct drm_device *drm_dev = dev_get_drvdata(dev);
902
903 drm_kms_helper_poll_disable(drm_dev);
904
905 drm_modeset_lock_all(drm_dev);
906 omap_drm_suspend_all_displays();
907 drm_modeset_unlock_all(drm_dev);
908
909 return 0;
910}
911
912static int omap_drm_resume(struct device *dev)
913{
914 struct drm_device *drm_dev = dev_get_drvdata(dev);
915
916 drm_modeset_lock_all(drm_dev);
917 omap_drm_resume_all_displays();
918 drm_modeset_unlock_all(drm_dev);
919
920 drm_kms_helper_poll_enable(drm_dev);
921
922 return omap_gem_resume(dev);
923}
924#endif
925
926static SIMPLE_DEV_PM_OPS(omapdrm_pm_ops, omap_drm_suspend, omap_drm_resume);
927
928static struct platform_driver pdev = {
929 .driver = {
930 .name = DRIVER_NAME,
931 .pm = &omapdrm_pm_ops,
932 },
933 .probe = pdev_probe,
934 .remove = pdev_remove,
935};
936
937static struct platform_driver * const drivers[] = {
938 &omap_dmm_driver,
939 &pdev,
940};
941
942static int __init omap_drm_init(void)
943{
944 DBG("init");
945
946 return platform_register_drivers(drivers, ARRAY_SIZE(drivers));
947}
948
949static void __exit omap_drm_fini(void)
950{
951 DBG("fini");
952
953 platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
954}
955
956
957late_initcall(omap_drm_init);
958module_exit(omap_drm_fini);
959
960MODULE_AUTHOR("Rob Clark <rob@ti.com>");
961MODULE_DESCRIPTION("OMAP DRM Display Driver");
962MODULE_ALIAS("platform:" DRIVER_NAME);
963MODULE_LICENSE("GPL v2");
964