1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/slab.h>
24#include <linux/uaccess.h>
25
26#include <drm/drm_plane.h>
27#include <drm/drm_drv.h>
28#include <drm/drm_print.h>
29#include <drm/drm_framebuffer.h>
30#include <drm/drm_file.h>
31#include <drm/drm_crtc.h>
32#include <drm/drm_fourcc.h>
33#include <drm/drm_vblank.h>
34
35#include "drm_crtc_internal.h"
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
62static unsigned int drm_num_planes(struct drm_device *dev)
63{
64 unsigned int num = 0;
65 struct drm_plane *tmp;
66
67 drm_for_each_plane(tmp, dev) {
68 num++;
69 }
70
71 return num;
72}
73
74static inline u32 *
75formats_ptr(struct drm_format_modifier_blob *blob)
76{
77 return (u32 *)(((char *)blob) + blob->formats_offset);
78}
79
80static inline struct drm_format_modifier *
81modifiers_ptr(struct drm_format_modifier_blob *blob)
82{
83 return (struct drm_format_modifier *)(((char *)blob) + blob->modifiers_offset);
84}
85
86static int create_in_format_blob(struct drm_device *dev, struct drm_plane *plane)
87{
88 const struct drm_mode_config *config = &dev->mode_config;
89 struct drm_property_blob *blob;
90 struct drm_format_modifier *mod;
91 size_t blob_size, formats_size, modifiers_size;
92 struct drm_format_modifier_blob *blob_data;
93 unsigned int i, j;
94
95 formats_size = sizeof(__u32) * plane->format_count;
96 if (WARN_ON(!formats_size)) {
97
98 return 0;
99 }
100
101 modifiers_size =
102 sizeof(struct drm_format_modifier) * plane->modifier_count;
103
104 blob_size = sizeof(struct drm_format_modifier_blob);
105
106
107
108 BUILD_BUG_ON(sizeof(struct drm_format_modifier_blob) % 8);
109 blob_size += ALIGN(formats_size, 8);
110 blob_size += modifiers_size;
111
112 blob = drm_property_create_blob(dev, blob_size, NULL);
113 if (IS_ERR(blob))
114 return -1;
115
116 blob_data = blob->data;
117 blob_data->version = FORMAT_BLOB_CURRENT;
118 blob_data->count_formats = plane->format_count;
119 blob_data->formats_offset = sizeof(struct drm_format_modifier_blob);
120 blob_data->count_modifiers = plane->modifier_count;
121
122 blob_data->modifiers_offset =
123 ALIGN(blob_data->formats_offset + formats_size, 8);
124
125 memcpy(formats_ptr(blob_data), plane->format_types, formats_size);
126
127
128 if (!plane->funcs->format_mod_supported)
129 goto done;
130
131 mod = modifiers_ptr(blob_data);
132 for (i = 0; i < plane->modifier_count; i++) {
133 for (j = 0; j < plane->format_count; j++) {
134 if (plane->funcs->format_mod_supported(plane,
135 plane->format_types[j],
136 plane->modifiers[i])) {
137
138 mod->formats |= 1ULL << j;
139 }
140 }
141
142 mod->modifier = plane->modifiers[i];
143 mod->offset = 0;
144 mod->pad = 0;
145 mod++;
146 }
147
148done:
149 drm_object_attach_property(&plane->base, config->modifiers_property,
150 blob->base.id);
151
152 return 0;
153}
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173int drm_universal_plane_init(struct drm_device *dev, struct drm_plane *plane,
174 uint32_t possible_crtcs,
175 const struct drm_plane_funcs *funcs,
176 const uint32_t *formats, unsigned int format_count,
177 const uint64_t *format_modifiers,
178 enum drm_plane_type type,
179 const char *name, ...)
180{
181 struct drm_mode_config *config = &dev->mode_config;
182 unsigned int format_modifier_count = 0;
183 int ret;
184
185
186 if (WARN_ON(config->num_total_plane >= 32))
187 return -EINVAL;
188
189 WARN_ON(drm_drv_uses_atomic_modeset(dev) &&
190 (!funcs->atomic_destroy_state ||
191 !funcs->atomic_duplicate_state));
192
193 ret = drm_mode_object_add(dev, &plane->base, DRM_MODE_OBJECT_PLANE);
194 if (ret)
195 return ret;
196
197 drm_modeset_lock_init(&plane->mutex);
198
199 plane->base.properties = &plane->properties;
200 plane->dev = dev;
201 plane->funcs = funcs;
202 plane->format_types = kmalloc_array(format_count, sizeof(uint32_t),
203 GFP_KERNEL);
204 if (!plane->format_types) {
205 DRM_DEBUG_KMS("out of memory when allocating plane\n");
206 drm_mode_object_unregister(dev, &plane->base);
207 return -ENOMEM;
208 }
209
210
211
212
213
214 if (WARN_ON(format_count > 64))
215 return -EINVAL;
216
217 if (format_modifiers) {
218 const uint64_t *temp_modifiers = format_modifiers;
219 while (*temp_modifiers++ != DRM_FORMAT_MOD_INVALID)
220 format_modifier_count++;
221 }
222
223 if (format_modifier_count)
224 config->allow_fb_modifiers = true;
225
226 plane->modifier_count = format_modifier_count;
227 plane->modifiers = kmalloc_array(format_modifier_count,
228 sizeof(format_modifiers[0]),
229 GFP_KERNEL);
230
231 if (format_modifier_count && !plane->modifiers) {
232 DRM_DEBUG_KMS("out of memory when allocating plane\n");
233 kfree(plane->format_types);
234 drm_mode_object_unregister(dev, &plane->base);
235 return -ENOMEM;
236 }
237
238 if (name) {
239 va_list ap;
240
241 va_start(ap, name);
242 plane->name = kvasprintf(GFP_KERNEL, name, ap);
243 va_end(ap);
244 } else {
245 plane->name = kasprintf(GFP_KERNEL, "plane-%d",
246 drm_num_planes(dev));
247 }
248 if (!plane->name) {
249 kfree(plane->format_types);
250 kfree(plane->modifiers);
251 drm_mode_object_unregister(dev, &plane->base);
252 return -ENOMEM;
253 }
254
255 memcpy(plane->format_types, formats, format_count * sizeof(uint32_t));
256 plane->format_count = format_count;
257 memcpy(plane->modifiers, format_modifiers,
258 format_modifier_count * sizeof(format_modifiers[0]));
259 plane->possible_crtcs = possible_crtcs;
260 plane->type = type;
261
262 list_add_tail(&plane->head, &config->plane_list);
263 plane->index = config->num_total_plane++;
264
265 drm_object_attach_property(&plane->base,
266 config->plane_type_property,
267 plane->type);
268
269 if (drm_core_check_feature(dev, DRIVER_ATOMIC)) {
270 drm_object_attach_property(&plane->base, config->prop_fb_id, 0);
271 drm_object_attach_property(&plane->base, config->prop_in_fence_fd, -1);
272 drm_object_attach_property(&plane->base, config->prop_crtc_id, 0);
273 drm_object_attach_property(&plane->base, config->prop_crtc_x, 0);
274 drm_object_attach_property(&plane->base, config->prop_crtc_y, 0);
275 drm_object_attach_property(&plane->base, config->prop_crtc_w, 0);
276 drm_object_attach_property(&plane->base, config->prop_crtc_h, 0);
277 drm_object_attach_property(&plane->base, config->prop_src_x, 0);
278 drm_object_attach_property(&plane->base, config->prop_src_y, 0);
279 drm_object_attach_property(&plane->base, config->prop_src_w, 0);
280 drm_object_attach_property(&plane->base, config->prop_src_h, 0);
281 }
282
283 if (config->allow_fb_modifiers)
284 create_in_format_blob(dev, plane);
285
286 return 0;
287}
288EXPORT_SYMBOL(drm_universal_plane_init);
289
290int drm_plane_register_all(struct drm_device *dev)
291{
292 struct drm_plane *plane;
293 int ret = 0;
294
295 drm_for_each_plane(plane, dev) {
296 if (plane->funcs->late_register)
297 ret = plane->funcs->late_register(plane);
298 if (ret)
299 return ret;
300 }
301
302 return 0;
303}
304
305void drm_plane_unregister_all(struct drm_device *dev)
306{
307 struct drm_plane *plane;
308
309 drm_for_each_plane(plane, dev) {
310 if (plane->funcs->early_unregister)
311 plane->funcs->early_unregister(plane);
312 }
313}
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332int drm_plane_init(struct drm_device *dev, struct drm_plane *plane,
333 uint32_t possible_crtcs,
334 const struct drm_plane_funcs *funcs,
335 const uint32_t *formats, unsigned int format_count,
336 bool is_primary)
337{
338 enum drm_plane_type type;
339
340 type = is_primary ? DRM_PLANE_TYPE_PRIMARY : DRM_PLANE_TYPE_OVERLAY;
341 return drm_universal_plane_init(dev, plane, possible_crtcs, funcs,
342 formats, format_count,
343 NULL, type, NULL);
344}
345EXPORT_SYMBOL(drm_plane_init);
346
347
348
349
350
351
352
353
354
355void drm_plane_cleanup(struct drm_plane *plane)
356{
357 struct drm_device *dev = plane->dev;
358
359 drm_modeset_lock_fini(&plane->mutex);
360
361 kfree(plane->format_types);
362 kfree(plane->modifiers);
363 drm_mode_object_unregister(dev, &plane->base);
364
365 BUG_ON(list_empty(&plane->head));
366
367
368
369
370
371
372 list_del(&plane->head);
373 dev->mode_config.num_total_plane--;
374
375 WARN_ON(plane->state && !plane->funcs->atomic_destroy_state);
376 if (plane->state && plane->funcs->atomic_destroy_state)
377 plane->funcs->atomic_destroy_state(plane, plane->state);
378
379 kfree(plane->name);
380
381 memset(plane, 0, sizeof(*plane));
382}
383EXPORT_SYMBOL(drm_plane_cleanup);
384
385
386
387
388
389
390
391
392
393struct drm_plane *
394drm_plane_from_index(struct drm_device *dev, int idx)
395{
396 struct drm_plane *plane;
397
398 drm_for_each_plane(plane, dev)
399 if (idx == plane->index)
400 return plane;
401
402 return NULL;
403}
404EXPORT_SYMBOL(drm_plane_from_index);
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421void drm_plane_force_disable(struct drm_plane *plane)
422{
423 int ret;
424
425 if (!plane->fb)
426 return;
427
428 WARN_ON(drm_drv_uses_atomic_modeset(plane->dev));
429
430 plane->old_fb = plane->fb;
431 ret = plane->funcs->disable_plane(plane, NULL);
432 if (ret) {
433 DRM_ERROR("failed to disable plane with busy fb\n");
434 plane->old_fb = NULL;
435 return;
436 }
437
438 drm_framebuffer_put(plane->old_fb);
439 plane->old_fb = NULL;
440 plane->fb = NULL;
441 plane->crtc = NULL;
442}
443EXPORT_SYMBOL(drm_plane_force_disable);
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458int drm_mode_plane_set_obj_prop(struct drm_plane *plane,
459 struct drm_property *property,
460 uint64_t value)
461{
462 int ret = -EINVAL;
463 struct drm_mode_object *obj = &plane->base;
464
465 if (plane->funcs->set_property)
466 ret = plane->funcs->set_property(plane, property, value);
467 if (!ret)
468 drm_object_property_set_value(obj, property, value);
469
470 return ret;
471}
472EXPORT_SYMBOL(drm_mode_plane_set_obj_prop);
473
474int drm_mode_getplane_res(struct drm_device *dev, void *data,
475 struct drm_file *file_priv)
476{
477 struct drm_mode_get_plane_res *plane_resp = data;
478 struct drm_plane *plane;
479 uint32_t __user *plane_ptr;
480 int count = 0;
481
482 if (!drm_core_check_feature(dev, DRIVER_MODESET))
483 return -EOPNOTSUPP;
484
485 plane_ptr = u64_to_user_ptr(plane_resp->plane_id_ptr);
486
487
488
489
490
491 drm_for_each_plane(plane, dev) {
492
493
494
495
496 if (plane->type != DRM_PLANE_TYPE_OVERLAY &&
497 !file_priv->universal_planes)
498 continue;
499
500 if (drm_lease_held(file_priv, plane->base.id)) {
501 if (count < plane_resp->count_planes &&
502 put_user(plane->base.id, plane_ptr + count))
503 return -EFAULT;
504 count++;
505 }
506 }
507 plane_resp->count_planes = count;
508
509 return 0;
510}
511
512int drm_mode_getplane(struct drm_device *dev, void *data,
513 struct drm_file *file_priv)
514{
515 struct drm_mode_get_plane *plane_resp = data;
516 struct drm_plane *plane;
517 uint32_t __user *format_ptr;
518
519 if (!drm_core_check_feature(dev, DRIVER_MODESET))
520 return -EOPNOTSUPP;
521
522 plane = drm_plane_find(dev, file_priv, plane_resp->plane_id);
523 if (!plane)
524 return -ENOENT;
525
526 drm_modeset_lock(&plane->mutex, NULL);
527 if (plane->state && plane->state->crtc && drm_lease_held(file_priv, plane->state->crtc->base.id))
528 plane_resp->crtc_id = plane->state->crtc->base.id;
529 else if (!plane->state && plane->crtc && drm_lease_held(file_priv, plane->crtc->base.id))
530 plane_resp->crtc_id = plane->crtc->base.id;
531 else
532 plane_resp->crtc_id = 0;
533
534 if (plane->state && plane->state->fb)
535 plane_resp->fb_id = plane->state->fb->base.id;
536 else if (!plane->state && plane->fb)
537 plane_resp->fb_id = plane->fb->base.id;
538 else
539 plane_resp->fb_id = 0;
540 drm_modeset_unlock(&plane->mutex);
541
542 plane_resp->plane_id = plane->base.id;
543 plane_resp->possible_crtcs = drm_lease_filter_crtcs(file_priv,
544 plane->possible_crtcs);
545
546 plane_resp->gamma_size = 0;
547
548
549
550
551
552 if (plane->format_count &&
553 (plane_resp->count_format_types >= plane->format_count)) {
554 format_ptr = (uint32_t __user *)(unsigned long)plane_resp->format_type_ptr;
555 if (copy_to_user(format_ptr,
556 plane->format_types,
557 sizeof(uint32_t) * plane->format_count)) {
558 return -EFAULT;
559 }
560 }
561 plane_resp->count_format_types = plane->format_count;
562
563 return 0;
564}
565
566int drm_plane_check_pixel_format(struct drm_plane *plane,
567 u32 format, u64 modifier)
568{
569 unsigned int i;
570
571 for (i = 0; i < plane->format_count; i++) {
572 if (format == plane->format_types[i])
573 break;
574 }
575 if (i == plane->format_count)
576 return -EINVAL;
577
578 if (plane->funcs->format_mod_supported) {
579 if (!plane->funcs->format_mod_supported(plane, format, modifier))
580 return -EINVAL;
581 } else {
582 if (!plane->modifier_count)
583 return 0;
584
585 for (i = 0; i < plane->modifier_count; i++) {
586 if (modifier == plane->modifiers[i])
587 break;
588 }
589 if (i == plane->modifier_count)
590 return -EINVAL;
591 }
592
593 return 0;
594}
595
596static int __setplane_check(struct drm_plane *plane,
597 struct drm_crtc *crtc,
598 struct drm_framebuffer *fb,
599 int32_t crtc_x, int32_t crtc_y,
600 uint32_t crtc_w, uint32_t crtc_h,
601 uint32_t src_x, uint32_t src_y,
602 uint32_t src_w, uint32_t src_h)
603{
604 int ret;
605
606
607 if (!(plane->possible_crtcs & drm_crtc_mask(crtc))) {
608 DRM_DEBUG_KMS("Invalid crtc for plane\n");
609 return -EINVAL;
610 }
611
612
613 ret = drm_plane_check_pixel_format(plane, fb->format->format,
614 fb->modifier);
615 if (ret) {
616 struct drm_format_name_buf format_name;
617
618 DRM_DEBUG_KMS("Invalid pixel format %s, modifier 0x%llx\n",
619 drm_get_format_name(fb->format->format,
620 &format_name),
621 fb->modifier);
622 return ret;
623 }
624
625
626 if (crtc_w > INT_MAX ||
627 crtc_x > INT_MAX - (int32_t) crtc_w ||
628 crtc_h > INT_MAX ||
629 crtc_y > INT_MAX - (int32_t) crtc_h) {
630 DRM_DEBUG_KMS("Invalid CRTC coordinates %ux%u+%d+%d\n",
631 crtc_w, crtc_h, crtc_x, crtc_y);
632 return -ERANGE;
633 }
634
635 ret = drm_framebuffer_check_src_coords(src_x, src_y, src_w, src_h, fb);
636 if (ret)
637 return ret;
638
639 return 0;
640}
641
642
643
644
645
646
647
648
649
650
651bool drm_any_plane_has_format(struct drm_device *dev,
652 u32 format, u64 modifier)
653{
654 struct drm_plane *plane;
655
656 drm_for_each_plane(plane, dev) {
657 if (drm_plane_check_pixel_format(plane, format, modifier) == 0)
658 return true;
659 }
660
661 return false;
662}
663EXPORT_SYMBOL(drm_any_plane_has_format);
664
665
666
667
668
669
670
671
672
673static int __setplane_internal(struct drm_plane *plane,
674 struct drm_crtc *crtc,
675 struct drm_framebuffer *fb,
676 int32_t crtc_x, int32_t crtc_y,
677 uint32_t crtc_w, uint32_t crtc_h,
678
679 uint32_t src_x, uint32_t src_y,
680 uint32_t src_w, uint32_t src_h,
681 struct drm_modeset_acquire_ctx *ctx)
682{
683 int ret = 0;
684
685 WARN_ON(drm_drv_uses_atomic_modeset(plane->dev));
686
687
688 if (!fb) {
689 plane->old_fb = plane->fb;
690 ret = plane->funcs->disable_plane(plane, ctx);
691 if (!ret) {
692 plane->crtc = NULL;
693 plane->fb = NULL;
694 } else {
695 plane->old_fb = NULL;
696 }
697 goto out;
698 }
699
700 ret = __setplane_check(plane, crtc, fb,
701 crtc_x, crtc_y, crtc_w, crtc_h,
702 src_x, src_y, src_w, src_h);
703 if (ret)
704 goto out;
705
706 plane->old_fb = plane->fb;
707 ret = plane->funcs->update_plane(plane, crtc, fb,
708 crtc_x, crtc_y, crtc_w, crtc_h,
709 src_x, src_y, src_w, src_h, ctx);
710 if (!ret) {
711 plane->crtc = crtc;
712 plane->fb = fb;
713 drm_framebuffer_get(plane->fb);
714 } else {
715 plane->old_fb = NULL;
716 }
717
718out:
719 if (plane->old_fb)
720 drm_framebuffer_put(plane->old_fb);
721 plane->old_fb = NULL;
722
723 return ret;
724}
725
726static int __setplane_atomic(struct drm_plane *plane,
727 struct drm_crtc *crtc,
728 struct drm_framebuffer *fb,
729 int32_t crtc_x, int32_t crtc_y,
730 uint32_t crtc_w, uint32_t crtc_h,
731 uint32_t src_x, uint32_t src_y,
732 uint32_t src_w, uint32_t src_h,
733 struct drm_modeset_acquire_ctx *ctx)
734{
735 int ret;
736
737 WARN_ON(!drm_drv_uses_atomic_modeset(plane->dev));
738
739
740 if (!fb)
741 return plane->funcs->disable_plane(plane, ctx);
742
743
744
745
746
747
748
749
750 ret = __setplane_check(plane, crtc, fb,
751 crtc_x, crtc_y, crtc_w, crtc_h,
752 src_x, src_y, src_w, src_h);
753 if (ret)
754 return ret;
755
756 return plane->funcs->update_plane(plane, crtc, fb,
757 crtc_x, crtc_y, crtc_w, crtc_h,
758 src_x, src_y, src_w, src_h, ctx);
759}
760
761static int setplane_internal(struct drm_plane *plane,
762 struct drm_crtc *crtc,
763 struct drm_framebuffer *fb,
764 int32_t crtc_x, int32_t crtc_y,
765 uint32_t crtc_w, uint32_t crtc_h,
766
767 uint32_t src_x, uint32_t src_y,
768 uint32_t src_w, uint32_t src_h)
769{
770 struct drm_modeset_acquire_ctx ctx;
771 int ret;
772
773 DRM_MODESET_LOCK_ALL_BEGIN(plane->dev, ctx,
774 DRM_MODESET_ACQUIRE_INTERRUPTIBLE, ret);
775
776 if (drm_drv_uses_atomic_modeset(plane->dev))
777 ret = __setplane_atomic(plane, crtc, fb,
778 crtc_x, crtc_y, crtc_w, crtc_h,
779 src_x, src_y, src_w, src_h, &ctx);
780 else
781 ret = __setplane_internal(plane, crtc, fb,
782 crtc_x, crtc_y, crtc_w, crtc_h,
783 src_x, src_y, src_w, src_h, &ctx);
784
785 DRM_MODESET_LOCK_ALL_END(ctx, ret);
786
787 return ret;
788}
789
790int drm_mode_setplane(struct drm_device *dev, void *data,
791 struct drm_file *file_priv)
792{
793 struct drm_mode_set_plane *plane_req = data;
794 struct drm_plane *plane;
795 struct drm_crtc *crtc = NULL;
796 struct drm_framebuffer *fb = NULL;
797 int ret;
798
799 if (!drm_core_check_feature(dev, DRIVER_MODESET))
800 return -EOPNOTSUPP;
801
802
803
804
805
806 plane = drm_plane_find(dev, file_priv, plane_req->plane_id);
807 if (!plane) {
808 DRM_DEBUG_KMS("Unknown plane ID %d\n",
809 plane_req->plane_id);
810 return -ENOENT;
811 }
812
813 if (plane_req->fb_id) {
814 fb = drm_framebuffer_lookup(dev, file_priv, plane_req->fb_id);
815 if (!fb) {
816 DRM_DEBUG_KMS("Unknown framebuffer ID %d\n",
817 plane_req->fb_id);
818 return -ENOENT;
819 }
820
821 crtc = drm_crtc_find(dev, file_priv, plane_req->crtc_id);
822 if (!crtc) {
823 drm_framebuffer_put(fb);
824 DRM_DEBUG_KMS("Unknown crtc ID %d\n",
825 plane_req->crtc_id);
826 return -ENOENT;
827 }
828 }
829
830 ret = setplane_internal(plane, crtc, fb,
831 plane_req->crtc_x, plane_req->crtc_y,
832 plane_req->crtc_w, plane_req->crtc_h,
833 plane_req->src_x, plane_req->src_y,
834 plane_req->src_w, plane_req->src_h);
835
836 if (fb)
837 drm_framebuffer_put(fb);
838
839 return ret;
840}
841
842static int drm_mode_cursor_universal(struct drm_crtc *crtc,
843 struct drm_mode_cursor2 *req,
844 struct drm_file *file_priv,
845 struct drm_modeset_acquire_ctx *ctx)
846{
847 struct drm_device *dev = crtc->dev;
848 struct drm_plane *plane = crtc->cursor;
849 struct drm_framebuffer *fb = NULL;
850 struct drm_mode_fb_cmd2 fbreq = {
851 .width = req->width,
852 .height = req->height,
853 .pixel_format = DRM_FORMAT_ARGB8888,
854 .pitches = { req->width * 4 },
855 .handles = { req->handle },
856 };
857 int32_t crtc_x, crtc_y;
858 uint32_t crtc_w = 0, crtc_h = 0;
859 uint32_t src_w = 0, src_h = 0;
860 int ret = 0;
861
862 BUG_ON(!plane);
863 WARN_ON(plane->crtc != crtc && plane->crtc != NULL);
864
865
866
867
868
869
870 if (req->flags & DRM_MODE_CURSOR_BO) {
871 if (req->handle) {
872 fb = drm_internal_framebuffer_create(dev, &fbreq, file_priv);
873 if (IS_ERR(fb)) {
874 DRM_DEBUG_KMS("failed to wrap cursor buffer in drm framebuffer\n");
875 return PTR_ERR(fb);
876 }
877
878 fb->hot_x = req->hot_x;
879 fb->hot_y = req->hot_y;
880 } else {
881 fb = NULL;
882 }
883 } else {
884 if (plane->state)
885 fb = plane->state->fb;
886 else
887 fb = plane->fb;
888
889 if (fb)
890 drm_framebuffer_get(fb);
891 }
892
893 if (req->flags & DRM_MODE_CURSOR_MOVE) {
894 crtc_x = req->x;
895 crtc_y = req->y;
896 } else {
897 crtc_x = crtc->cursor_x;
898 crtc_y = crtc->cursor_y;
899 }
900
901 if (fb) {
902 crtc_w = fb->width;
903 crtc_h = fb->height;
904 src_w = fb->width << 16;
905 src_h = fb->height << 16;
906 }
907
908 if (drm_drv_uses_atomic_modeset(dev))
909 ret = __setplane_atomic(plane, crtc, fb,
910 crtc_x, crtc_y, crtc_w, crtc_h,
911 0, 0, src_w, src_h, ctx);
912 else
913 ret = __setplane_internal(plane, crtc, fb,
914 crtc_x, crtc_y, crtc_w, crtc_h,
915 0, 0, src_w, src_h, ctx);
916
917 if (fb)
918 drm_framebuffer_put(fb);
919
920
921 if (ret == 0 && req->flags & DRM_MODE_CURSOR_MOVE) {
922 crtc->cursor_x = req->x;
923 crtc->cursor_y = req->y;
924 }
925
926 return ret;
927}
928
929static int drm_mode_cursor_common(struct drm_device *dev,
930 struct drm_mode_cursor2 *req,
931 struct drm_file *file_priv)
932{
933 struct drm_crtc *crtc;
934 struct drm_modeset_acquire_ctx ctx;
935 int ret = 0;
936
937 if (!drm_core_check_feature(dev, DRIVER_MODESET))
938 return -EOPNOTSUPP;
939
940 if (!req->flags || (~DRM_MODE_CURSOR_FLAGS & req->flags))
941 return -EINVAL;
942
943 crtc = drm_crtc_find(dev, file_priv, req->crtc_id);
944 if (!crtc) {
945 DRM_DEBUG_KMS("Unknown CRTC ID %d\n", req->crtc_id);
946 return -ENOENT;
947 }
948
949 drm_modeset_acquire_init(&ctx, DRM_MODESET_ACQUIRE_INTERRUPTIBLE);
950retry:
951 ret = drm_modeset_lock(&crtc->mutex, &ctx);
952 if (ret)
953 goto out;
954
955
956
957
958 if (crtc->cursor) {
959 ret = drm_modeset_lock(&crtc->cursor->mutex, &ctx);
960 if (ret)
961 goto out;
962
963 ret = drm_mode_cursor_universal(crtc, req, file_priv, &ctx);
964 goto out;
965 }
966
967 if (req->flags & DRM_MODE_CURSOR_BO) {
968 if (!crtc->funcs->cursor_set && !crtc->funcs->cursor_set2) {
969 ret = -ENXIO;
970 goto out;
971 }
972
973 if (crtc->funcs->cursor_set2)
974 ret = crtc->funcs->cursor_set2(crtc, file_priv, req->handle,
975 req->width, req->height, req->hot_x, req->hot_y);
976 else
977 ret = crtc->funcs->cursor_set(crtc, file_priv, req->handle,
978 req->width, req->height);
979 }
980
981 if (req->flags & DRM_MODE_CURSOR_MOVE) {
982 if (crtc->funcs->cursor_move) {
983 ret = crtc->funcs->cursor_move(crtc, req->x, req->y);
984 } else {
985 ret = -EFAULT;
986 goto out;
987 }
988 }
989out:
990 if (ret == -EDEADLK) {
991 ret = drm_modeset_backoff(&ctx);
992 if (!ret)
993 goto retry;
994 }
995
996 drm_modeset_drop_locks(&ctx);
997 drm_modeset_acquire_fini(&ctx);
998
999 return ret;
1000
1001}
1002
1003
1004int drm_mode_cursor_ioctl(struct drm_device *dev,
1005 void *data, struct drm_file *file_priv)
1006{
1007 struct drm_mode_cursor *req = data;
1008 struct drm_mode_cursor2 new_req;
1009
1010 memcpy(&new_req, req, sizeof(struct drm_mode_cursor));
1011 new_req.hot_x = new_req.hot_y = 0;
1012
1013 return drm_mode_cursor_common(dev, &new_req, file_priv);
1014}
1015
1016
1017
1018
1019
1020
1021int drm_mode_cursor2_ioctl(struct drm_device *dev,
1022 void *data, struct drm_file *file_priv)
1023{
1024 struct drm_mode_cursor2 *req = data;
1025
1026 return drm_mode_cursor_common(dev, req, file_priv);
1027}
1028
1029int drm_mode_page_flip_ioctl(struct drm_device *dev,
1030 void *data, struct drm_file *file_priv)
1031{
1032 struct drm_mode_crtc_page_flip_target *page_flip = data;
1033 struct drm_crtc *crtc;
1034 struct drm_plane *plane;
1035 struct drm_framebuffer *fb = NULL, *old_fb;
1036 struct drm_pending_vblank_event *e = NULL;
1037 u32 target_vblank = page_flip->sequence;
1038 struct drm_modeset_acquire_ctx ctx;
1039 int ret = -EINVAL;
1040
1041 if (!drm_core_check_feature(dev, DRIVER_MODESET))
1042 return -EOPNOTSUPP;
1043
1044 if (page_flip->flags & ~DRM_MODE_PAGE_FLIP_FLAGS)
1045 return -EINVAL;
1046
1047 if (page_flip->sequence != 0 && !(page_flip->flags & DRM_MODE_PAGE_FLIP_TARGET))
1048 return -EINVAL;
1049
1050
1051
1052
1053 if ((page_flip->flags & DRM_MODE_PAGE_FLIP_TARGET) == DRM_MODE_PAGE_FLIP_TARGET)
1054 return -EINVAL;
1055
1056 if ((page_flip->flags & DRM_MODE_PAGE_FLIP_ASYNC) && !dev->mode_config.async_page_flip)
1057 return -EINVAL;
1058
1059 crtc = drm_crtc_find(dev, file_priv, page_flip->crtc_id);
1060 if (!crtc)
1061 return -ENOENT;
1062
1063 plane = crtc->primary;
1064
1065 if (crtc->funcs->page_flip_target) {
1066 u32 current_vblank;
1067 int r;
1068
1069 r = drm_crtc_vblank_get(crtc);
1070 if (r)
1071 return r;
1072
1073 current_vblank = (u32)drm_crtc_vblank_count(crtc);
1074
1075 switch (page_flip->flags & DRM_MODE_PAGE_FLIP_TARGET) {
1076 case DRM_MODE_PAGE_FLIP_TARGET_ABSOLUTE:
1077 if ((int)(target_vblank - current_vblank) > 1) {
1078 DRM_DEBUG("Invalid absolute flip target %u, "
1079 "must be <= %u\n", target_vblank,
1080 current_vblank + 1);
1081 drm_crtc_vblank_put(crtc);
1082 return -EINVAL;
1083 }
1084 break;
1085 case DRM_MODE_PAGE_FLIP_TARGET_RELATIVE:
1086 if (target_vblank != 0 && target_vblank != 1) {
1087 DRM_DEBUG("Invalid relative flip target %u, "
1088 "must be 0 or 1\n", target_vblank);
1089 drm_crtc_vblank_put(crtc);
1090 return -EINVAL;
1091 }
1092 target_vblank += current_vblank;
1093 break;
1094 default:
1095 target_vblank = current_vblank +
1096 !(page_flip->flags & DRM_MODE_PAGE_FLIP_ASYNC);
1097 break;
1098 }
1099 } else if (crtc->funcs->page_flip == NULL ||
1100 (page_flip->flags & DRM_MODE_PAGE_FLIP_TARGET)) {
1101 return -EINVAL;
1102 }
1103
1104 drm_modeset_acquire_init(&ctx, DRM_MODESET_ACQUIRE_INTERRUPTIBLE);
1105retry:
1106 ret = drm_modeset_lock(&crtc->mutex, &ctx);
1107 if (ret)
1108 goto out;
1109 ret = drm_modeset_lock(&plane->mutex, &ctx);
1110 if (ret)
1111 goto out;
1112
1113 if (plane->state)
1114 old_fb = plane->state->fb;
1115 else
1116 old_fb = plane->fb;
1117
1118 if (old_fb == NULL) {
1119
1120
1121
1122
1123 ret = -EBUSY;
1124 goto out;
1125 }
1126
1127 fb = drm_framebuffer_lookup(dev, file_priv, page_flip->fb_id);
1128 if (!fb) {
1129 ret = -ENOENT;
1130 goto out;
1131 }
1132
1133 if (plane->state) {
1134 const struct drm_plane_state *state = plane->state;
1135
1136 ret = drm_framebuffer_check_src_coords(state->src_x,
1137 state->src_y,
1138 state->src_w,
1139 state->src_h,
1140 fb);
1141 } else {
1142 ret = drm_crtc_check_viewport(crtc, crtc->x, crtc->y,
1143 &crtc->mode, fb);
1144 }
1145 if (ret)
1146 goto out;
1147
1148 if (old_fb->format != fb->format) {
1149 DRM_DEBUG_KMS("Page flip is not allowed to change frame buffer format.\n");
1150 ret = -EINVAL;
1151 goto out;
1152 }
1153
1154 if (page_flip->flags & DRM_MODE_PAGE_FLIP_EVENT) {
1155 e = kzalloc(sizeof *e, GFP_KERNEL);
1156 if (!e) {
1157 ret = -ENOMEM;
1158 goto out;
1159 }
1160
1161 e->event.base.type = DRM_EVENT_FLIP_COMPLETE;
1162 e->event.base.length = sizeof(e->event);
1163 e->event.vbl.user_data = page_flip->user_data;
1164 e->event.vbl.crtc_id = crtc->base.id;
1165
1166 ret = drm_event_reserve_init(dev, file_priv, &e->base, &e->event.base);
1167 if (ret) {
1168 kfree(e);
1169 e = NULL;
1170 goto out;
1171 }
1172 }
1173
1174 plane->old_fb = plane->fb;
1175 if (crtc->funcs->page_flip_target)
1176 ret = crtc->funcs->page_flip_target(crtc, fb, e,
1177 page_flip->flags,
1178 target_vblank,
1179 &ctx);
1180 else
1181 ret = crtc->funcs->page_flip(crtc, fb, e, page_flip->flags,
1182 &ctx);
1183 if (ret) {
1184 if (page_flip->flags & DRM_MODE_PAGE_FLIP_EVENT)
1185 drm_event_cancel_free(dev, &e->base);
1186
1187 plane->old_fb = NULL;
1188 } else {
1189 if (!plane->state) {
1190 plane->fb = fb;
1191 drm_framebuffer_get(fb);
1192 }
1193 }
1194
1195out:
1196 if (fb)
1197 drm_framebuffer_put(fb);
1198 if (plane->old_fb)
1199 drm_framebuffer_put(plane->old_fb);
1200 plane->old_fb = NULL;
1201
1202 if (ret == -EDEADLK) {
1203 ret = drm_modeset_backoff(&ctx);
1204 if (!ret)
1205 goto retry;
1206 }
1207
1208 drm_modeset_drop_locks(&ctx);
1209 drm_modeset_acquire_fini(&ctx);
1210
1211 if (ret && crtc->funcs->page_flip_target)
1212 drm_crtc_vblank_put(crtc);
1213
1214 return ret;
1215}
1216