334a421dea6b454ed9c842df85aa288e3037c833
[profile/ivi/weston-ivi-shell.git] / src / compositor-drm.c
1 /*
2  * Copyright © 2008-2011 Kristian Høgsberg
3  * Copyright © 2011 Intel Corporation
4  *
5  * Permission to use, copy, modify, distribute, and sell this software and
6  * its documentation for any purpose is hereby granted without fee, provided
7  * that the above copyright notice appear in all copies and that both that
8  * copyright notice and this permission notice appear in supporting
9  * documentation, and that the name of the copyright holders not be used in
10  * advertising or publicity pertaining to distribution of the software
11  * without specific, written prior permission.  The copyright holders make
12  * no representations about the suitability of this software for any
13  * purpose.  It is provided "as is" without express or implied warranty.
14  *
15  * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS
16  * SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND
17  * FITNESS, IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY
18  * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER
19  * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF
20  * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
21  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
22  */
23
24 #define _GNU_SOURCE
25
26 #include <errno.h>
27 #include <stdlib.h>
28 #include <string.h>
29 #include <fcntl.h>
30 #include <unistd.h>
31 #include <linux/input.h>
32 #include <assert.h>
33
34 #include <xf86drm.h>
35 #include <xf86drmMode.h>
36 #include <drm_fourcc.h>
37
38 #include <gbm.h>
39 #include <libbacklight.h>
40
41 #include "compositor.h"
42 #include "evdev.h"
43 #include "launcher-util.h"
44 #include "log.h"
45
46 enum {
47         WESTON_PLANE_DRM_CURSOR = 0x100
48 };
49
50 struct drm_compositor {
51         struct weston_compositor base;
52
53         struct udev *udev;
54         struct wl_event_source *drm_source;
55
56         struct udev_monitor *udev_monitor;
57         struct wl_event_source *udev_drm_source;
58
59         struct {
60                 int id;
61                 int fd;
62         } drm;
63         struct gbm_device *gbm;
64         uint32_t *crtcs;
65         int num_crtcs;
66         uint32_t crtc_allocator;
67         uint32_t connector_allocator;
68         struct tty *tty;
69
70         struct gbm_surface *dummy_surface;
71         EGLSurface dummy_egl_surface;
72
73         struct wl_list sprite_list;
74         int sprites_are_broken;
75
76         uint32_t prev_state;
77 };
78
79 struct drm_mode {
80         struct weston_mode base;
81         drmModeModeInfo mode_info;
82 };
83
84 struct drm_output;
85
86 struct drm_fb {
87         struct gbm_bo *bo;
88         struct drm_output *output;
89         uint32_t fb_id;
90         int is_client_buffer;
91         struct wl_buffer *buffer;
92         struct wl_listener buffer_destroy_listener;
93 };
94
95 struct drm_output {
96         struct weston_output   base;
97
98         uint32_t crtc_id;
99         uint32_t connector_id;
100         drmModeCrtcPtr original_crtc;
101
102         int vblank_pending;
103         int page_flip_pending;
104
105         struct gbm_surface *surface;
106         struct gbm_bo *cursor_bo[2];
107         int current_cursor;
108         EGLSurface egl_surface;
109         struct drm_fb *current, *next;
110         struct backlight *backlight;
111 };
112
113 /*
114  * An output has a primary display plane plus zero or more sprites for
115  * blending display contents.
116  */
117 struct drm_sprite {
118         struct wl_list link;
119
120         uint32_t fb_id;
121         uint32_t pending_fb_id;
122         struct weston_surface *surface;
123         struct weston_surface *pending_surface;
124
125         struct drm_output *output;
126
127         struct drm_compositor *compositor;
128
129         struct wl_listener destroy_listener;
130         struct wl_listener pending_destroy_listener;
131
132         uint32_t possible_crtcs;
133         uint32_t plane_id;
134         uint32_t count_formats;
135
136         int32_t src_x, src_y;
137         uint32_t src_w, src_h;
138         uint32_t dest_x, dest_y;
139         uint32_t dest_w, dest_h;
140
141         uint32_t formats[];
142 };
143
144 static int
145 surface_is_primary(struct weston_compositor *ec, struct weston_surface *es)
146 {
147         struct weston_surface *primary;
148
149         primary = container_of(ec->surface_list.next, struct weston_surface,
150                                link);
151         if (es == primary)
152                 return -1;
153         return 0;
154 }
155
156 static int
157 drm_sprite_crtc_supported(struct weston_output *output_base, uint32_t supported)
158 {
159         struct weston_compositor *ec = output_base->compositor;
160         struct drm_compositor *c =(struct drm_compositor *) ec;
161         struct drm_output *output = (struct drm_output *) output_base;
162         int crtc;
163
164         for (crtc = 0; crtc < c->num_crtcs; crtc++) {
165                 if (c->crtcs[crtc] != output->crtc_id)
166                         continue;
167
168                 if (supported & (1 << crtc))
169                         return -1;
170         }
171
172         return 0;
173 }
174
175 static void
176 drm_fb_destroy_callback(struct gbm_bo *bo, void *data)
177 {
178         struct drm_fb *fb = data;
179         struct gbm_device *gbm = gbm_bo_get_device(bo);
180
181         if (fb->fb_id)
182                 drmModeRmFB(gbm_device_get_fd(gbm), fb->fb_id);
183
184         if (fb->buffer) {
185                 weston_buffer_post_release(fb->buffer);
186                 wl_list_remove(&fb->buffer_destroy_listener.link);
187         }
188
189         free(data);
190 }
191
192 static struct drm_fb *
193 drm_fb_get_from_bo(struct gbm_bo *bo, struct drm_output *output)
194 {
195         struct drm_fb *fb = gbm_bo_get_user_data(bo);
196         struct drm_compositor *compositor =
197                 (struct drm_compositor *) output->base.compositor;
198         uint32_t width, height, stride, handle;
199         int ret;
200
201         if (fb)
202                 return fb;
203
204         fb = malloc(sizeof *fb);
205
206         fb->bo = bo;
207         fb->output = output;
208         fb->is_client_buffer = 0;
209         fb->buffer = NULL;
210
211         width = gbm_bo_get_width(bo);
212         height = gbm_bo_get_height(bo);
213         stride = gbm_bo_get_pitch(bo);
214         handle = gbm_bo_get_handle(bo).u32;
215
216         ret = drmModeAddFB(compositor->drm.fd, width, height, 24, 32,
217                            stride, handle, &fb->fb_id);
218         if (ret) {
219                 weston_log("failed to create kms fb: %m\n");
220                 free(fb);
221                 return NULL;
222         }
223
224         gbm_bo_set_user_data(bo, fb, drm_fb_destroy_callback);
225
226         return fb;
227 }
228
229 static void
230 fb_handle_buffer_destroy(struct wl_listener *listener, void *data)
231 {
232         struct drm_fb *fb = container_of(listener, struct drm_fb,
233                                          buffer_destroy_listener);
234
235         fb->buffer = NULL;
236
237         if (fb == fb->output->next ||
238             (fb == fb->output->current && !fb->output->next))
239                 weston_output_schedule_repaint(&fb->output->base);
240 }
241
242 static int
243 drm_output_prepare_scanout_surface(struct drm_output *output)
244 {
245         struct drm_compositor *c =
246                 (struct drm_compositor *) output->base.compositor;
247         struct weston_surface *es;
248         struct gbm_bo *bo;
249
250         es = container_of(c->base.surface_list.next,
251                           struct weston_surface, link);
252
253         if (es->geometry.x != output->base.x ||
254             es->geometry.y != output->base.y ||
255             es->geometry.width != output->base.current->width ||
256             es->geometry.height != output->base.current->height ||
257             es->transform.enabled ||
258             es->image == EGL_NO_IMAGE_KHR)
259                 return -1;
260
261         bo = gbm_bo_create_from_egl_image(c->gbm,
262                                           c->base.egl_display,
263                                           es->image,
264                                           es->geometry.width,
265                                           es->geometry.height,
266                                           GBM_BO_USE_SCANOUT);
267
268         /* Need to verify output->region contained in surface opaque
269          * region.  Or maybe just that format doesn't have alpha.
270          * For now, scanout only if format is XRGB8888. */
271         if (gbm_bo_get_format(bo) != GBM_FORMAT_XRGB8888) {
272                 gbm_bo_destroy(bo);
273                 return -1;
274         }
275
276         output->next = drm_fb_get_from_bo(bo, output);
277         if (!output->next) {
278                 gbm_bo_destroy(bo);
279                 return -1;
280         }
281
282         output->next->is_client_buffer = 1;
283         output->next->buffer = es->buffer;
284         output->next->buffer->busy_count++;
285         output->next->buffer_destroy_listener.notify = fb_handle_buffer_destroy;
286
287         wl_signal_add(&output->next->buffer->resource.destroy_signal,
288                       &output->next->buffer_destroy_listener);
289
290         pixman_region32_fini(&es->damage);
291         pixman_region32_init(&es->damage);
292
293         return 0;
294 }
295
296 static void
297 drm_output_render(struct drm_output *output, pixman_region32_t *damage)
298 {
299         struct drm_compositor *compositor =
300                 (struct drm_compositor *) output->base.compositor;
301         struct weston_surface *surface;
302         struct gbm_bo *bo;
303
304         if (!eglMakeCurrent(compositor->base.egl_display, output->egl_surface,
305                             output->egl_surface,
306                             compositor->base.egl_context)) {
307                 weston_log("failed to make current\n");
308                 return;
309         }
310
311         wl_list_for_each_reverse(surface, &compositor->base.surface_list, link)
312                 weston_surface_draw(surface, &output->base, damage);
313
314         wl_signal_emit(&output->base.frame_signal, output);
315
316         eglSwapBuffers(compositor->base.egl_display, output->egl_surface);
317         bo = gbm_surface_lock_front_buffer(output->surface);
318         if (!bo) {
319                 weston_log("failed to lock front buffer: %m\n");
320                 return;
321         }
322
323         output->next = drm_fb_get_from_bo(bo, output);
324         if (!output->next) {
325                 weston_log("failed to get drm_fb for bo\n");
326                 gbm_surface_release_buffer(output->surface, bo);
327                 return;
328         }
329 }
330
331 static void
332 drm_output_repaint(struct weston_output *output_base,
333                    pixman_region32_t *damage)
334 {
335         struct drm_output *output = (struct drm_output *) output_base;
336         struct drm_compositor *compositor =
337                 (struct drm_compositor *) output->base.compositor;
338         struct drm_sprite *s;
339         struct drm_mode *mode;
340         int ret = 0;
341
342         drm_output_prepare_scanout_surface(output);
343         if (!output->next)
344                 drm_output_render(output, damage);
345         if (!output->next)
346                 return;
347
348         mode = container_of(output->base.current, struct drm_mode, base);
349         if (!output->current) {
350                 ret = drmModeSetCrtc(compositor->drm.fd, output->crtc_id,
351                                      output->next->fb_id, 0, 0,
352                                      &output->connector_id, 1,
353                                      &mode->mode_info);
354                 if (ret) {
355                         weston_log("set mode failed: %m\n");
356                         return;
357                 }
358         }
359
360         if (drmModePageFlip(compositor->drm.fd, output->crtc_id,
361                             output->next->fb_id,
362                             DRM_MODE_PAGE_FLIP_EVENT, output) < 0) {
363                 weston_log("queueing pageflip failed: %m\n");
364                 return;
365         }
366
367         output->page_flip_pending = 1;
368
369         /*
370          * Now, update all the sprite surfaces
371          */
372         wl_list_for_each(s, &compositor->sprite_list, link) {
373                 uint32_t flags = 0;
374                 drmVBlank vbl = {
375                         .request.type = DRM_VBLANK_RELATIVE | DRM_VBLANK_EVENT,
376                         .request.sequence = 1,
377                 };
378
379                 if (!drm_sprite_crtc_supported(output_base, s->possible_crtcs))
380                         continue;
381
382                 ret = drmModeSetPlane(compositor->drm.fd, s->plane_id,
383                                       output->crtc_id, s->pending_fb_id, flags,
384                                       s->dest_x, s->dest_y,
385                                       s->dest_w, s->dest_h,
386                                       s->src_x, s->src_y,
387                                       s->src_w, s->src_h);
388                 if (ret)
389                         weston_log("setplane failed: %d: %s\n",
390                                 ret, strerror(errno));
391
392                 /*
393                  * Queue a vblank signal so we know when the surface
394                  * becomes active on the display or has been replaced.
395                  */
396                 vbl.request.signal = (unsigned long)s;
397                 ret = drmWaitVBlank(compositor->drm.fd, &vbl);
398                 if (ret) {
399                         weston_log("vblank event request failed: %d: %s\n",
400                                 ret, strerror(errno));
401                 }
402
403                 s->output = output;
404                 output->vblank_pending = 1;
405         }
406
407         return;
408 }
409
410 static void
411 vblank_handler(int fd, unsigned int frame, unsigned int sec, unsigned int usec,
412                void *data)
413 {
414         struct drm_sprite *s = (struct drm_sprite *)data;
415         struct drm_compositor *c = s->compositor;
416         struct drm_output *output = s->output;
417         uint32_t msecs;
418
419         output->vblank_pending = 0;
420
421         if (s->surface) {
422                 weston_buffer_post_release(s->surface->buffer);
423                 wl_list_remove(&s->destroy_listener.link);
424                 s->surface = NULL;
425                 drmModeRmFB(c->drm.fd, s->fb_id);
426                 s->fb_id = 0;
427         }
428
429         if (s->pending_surface) {
430                 wl_list_remove(&s->pending_destroy_listener.link);
431                 wl_signal_add(&s->pending_surface->buffer->resource.destroy_signal,
432                               &s->destroy_listener);
433                 s->surface = s->pending_surface;
434                 s->pending_surface = NULL;
435                 s->fb_id = s->pending_fb_id;
436                 s->pending_fb_id = 0;
437         }
438
439         if (!output->page_flip_pending) {
440                 msecs = sec * 1000 + usec / 1000;
441                 weston_output_finish_frame(&output->base, msecs);
442         }
443 }
444
445 static void
446 page_flip_handler(int fd, unsigned int frame,
447                   unsigned int sec, unsigned int usec, void *data)
448 {
449         struct drm_output *output = (struct drm_output *) data;
450         uint32_t msecs;
451
452         output->page_flip_pending = 0;
453
454         if (output->current) {
455                 if (output->current->is_client_buffer)
456                         gbm_bo_destroy(output->current->bo);
457                 else
458                         gbm_surface_release_buffer(output->surface,
459                                                    output->current->bo);
460         }
461
462         output->current = output->next;
463         output->next = NULL;
464
465         if (!output->vblank_pending) {
466                 msecs = sec * 1000 + usec / 1000;
467                 weston_output_finish_frame(&output->base, msecs);
468         }
469 }
470
471 static int
472 drm_surface_format_supported(struct drm_sprite *s, uint32_t format)
473 {
474         uint32_t i;
475
476         for (i = 0; i < s->count_formats; i++)
477                 if (s->formats[i] == format)
478                         return 1;
479
480         return 0;
481 }
482
483 static int
484 drm_surface_transform_supported(struct weston_surface *es)
485 {
486         if (es->transform.enabled)
487                 return 0;
488
489         return 1;
490 }
491
492 static int
493 drm_surface_overlap_supported(struct weston_output *output_base,
494                               pixman_region32_t *overlap)
495 {
496         /* We could potentially use a color key here if the surface left
497          * to display has rectangular regions
498          */
499         if (pixman_region32_not_empty(overlap))
500                 return 0;
501         return 1;
502 }
503
504 static void
505 drm_disable_unused_sprites(struct weston_output *output_base)
506 {
507         struct weston_compositor *ec = output_base->compositor;
508         struct drm_compositor *c =(struct drm_compositor *) ec;
509         struct drm_output *output = (struct drm_output *) output_base;
510         struct drm_sprite *s;
511         int ret;
512
513         wl_list_for_each(s, &c->sprite_list, link) {
514                 if (s->pending_fb_id)
515                         continue;
516
517                 ret = drmModeSetPlane(c->drm.fd, s->plane_id,
518                                       output->crtc_id, 0, 0,
519                                       0, 0, 0, 0, 0, 0, 0, 0);
520                 if (ret)
521                         weston_log("failed to disable plane: %d: %s\n",
522                                 ret, strerror(errno));
523                 drmModeRmFB(c->drm.fd, s->fb_id);
524
525                 if (s->surface) {
526                         s->surface = NULL;
527                         wl_list_remove(&s->destroy_listener.link);
528                 }
529
530                 assert(!s->pending_surface);
531                 s->fb_id = 0;
532                 s->pending_fb_id = 0;
533         }
534 }
535
536 /*
537  * This function must take care to damage any previously assigned surface
538  * if the sprite ends up binding to a different surface than in the
539  * previous frame.
540  */
541 static int
542 drm_output_prepare_overlay_surface(struct weston_output *output_base,
543                                    struct weston_surface *es,
544                                    pixman_region32_t *overlap)
545 {
546         struct weston_compositor *ec = output_base->compositor;
547         struct drm_compositor *c =(struct drm_compositor *) ec;
548         struct drm_sprite *s;
549         int found = 0;
550         EGLint handle, stride;
551         struct gbm_bo *bo;
552         uint32_t fb_id = 0;
553         uint32_t handles[4], pitches[4], offsets[4];
554         int ret = 0;
555         pixman_region32_t dest_rect, src_rect;
556         pixman_box32_t *box;
557         uint32_t format;
558
559         if (c->sprites_are_broken)
560                 return -1;
561
562         if (es->output_mask != (1u << output_base->id))
563                 return -1;
564
565         if (surface_is_primary(ec, es))
566                 return -1;
567
568         if (es->image == EGL_NO_IMAGE_KHR)
569                 return -1;
570
571         if (!drm_surface_transform_supported(es))
572                 return -1;
573
574         if (!drm_surface_overlap_supported(output_base, overlap))
575                 return -1;
576
577         wl_list_for_each(s, &c->sprite_list, link) {
578                 if (!drm_sprite_crtc_supported(output_base, s->possible_crtcs))
579                         continue;
580
581                 if (!s->pending_fb_id) {
582                         found = 1;
583                         break;
584                 }
585         }
586
587         /* No sprites available */
588         if (!found)
589                 return -1;
590
591         bo = gbm_bo_create_from_egl_image(c->gbm, c->base.egl_display,
592                                           es->image, es->geometry.width,
593                                           es->geometry.height,
594                                           GBM_BO_USE_SCANOUT);
595         format = gbm_bo_get_format(bo);
596         handle = gbm_bo_get_handle(bo).s32;
597         stride = gbm_bo_get_pitch(bo);
598
599         gbm_bo_destroy(bo);
600
601         if (!drm_surface_format_supported(s, format))
602                 return -1;
603
604         if (!handle)
605                 return -1;
606
607         handles[0] = handle;
608         pitches[0] = stride;
609         offsets[0] = 0;
610
611         ret = drmModeAddFB2(c->drm.fd, es->geometry.width, es->geometry.height,
612                             format, handles, pitches, offsets,
613                             &fb_id, 0);
614         if (ret) {
615                 weston_log("addfb2 failed: %d\n", ret);
616                 c->sprites_are_broken = 1;
617                 return -1;
618         }
619
620         if (s->surface && s->surface != es) {
621                 struct weston_surface *old_surf = s->surface;
622                 pixman_region32_fini(&old_surf->damage);
623                 pixman_region32_init_rect(&old_surf->damage,
624                                           old_surf->geometry.x, old_surf->geometry.y,
625                                           old_surf->geometry.width, old_surf->geometry.height);
626         }
627
628         s->pending_fb_id = fb_id;
629         s->pending_surface = es;
630         es->buffer->busy_count++;
631
632         /*
633          * Calculate the source & dest rects properly based on actual
634          * postion (note the caller has called weston_surface_update_transform()
635          * for us already).
636          */
637         pixman_region32_init(&dest_rect);
638         pixman_region32_intersect(&dest_rect, &es->transform.boundingbox,
639                                   &output_base->region);
640         pixman_region32_translate(&dest_rect, -output_base->x, -output_base->y);
641         box = pixman_region32_extents(&dest_rect);
642         s->dest_x = box->x1;
643         s->dest_y = box->y1;
644         s->dest_w = box->x2 - box->x1;
645         s->dest_h = box->y2 - box->y1;
646         pixman_region32_fini(&dest_rect);
647
648         pixman_region32_init(&src_rect);
649         pixman_region32_intersect(&src_rect, &es->transform.boundingbox,
650                                   &output_base->region);
651         pixman_region32_translate(&src_rect, -es->geometry.x, -es->geometry.y);
652         box = pixman_region32_extents(&src_rect);
653         s->src_x = box->x1 << 16;
654         s->src_y = box->y1 << 16;
655         s->src_w = (box->x2 - box->x1) << 16;
656         s->src_h = (box->y2 - box->y1) << 16;
657         pixman_region32_fini(&src_rect);
658
659         wl_signal_add(&es->buffer->resource.destroy_signal,
660                       &s->pending_destroy_listener);
661         return 0;
662 }
663
664 static int
665 drm_output_set_cursor(struct weston_output *output_base,
666                       struct weston_seat *es);
667
668 static void
669 weston_output_set_cursor(struct weston_output *output,
670                          struct weston_seat *seat,
671                          pixman_region32_t *overlap)
672 {
673         pixman_region32_t cursor_region;
674
675         if (seat->sprite == NULL)
676                 return;
677
678         pixman_region32_init(&cursor_region);
679         pixman_region32_intersect(&cursor_region,
680                                   &seat->sprite->transform.boundingbox,
681                                   &output->region);
682
683         if (!pixman_region32_not_empty(&cursor_region)) {
684                 drm_output_set_cursor(output, NULL);
685                 goto out;
686         }
687
688         if (pixman_region32_not_empty(overlap) ||
689             drm_output_set_cursor(output, seat) < 0) {
690                 if (seat->sprite->plane == WESTON_PLANE_DRM_CURSOR) {
691                         weston_surface_damage(seat->sprite);
692                         drm_output_set_cursor(output, NULL);
693                 }
694                 seat->sprite->plane = WESTON_PLANE_PRIMARY;
695         } else {
696                 if (seat->sprite->plane == WESTON_PLANE_PRIMARY)
697                         weston_surface_damage_below(seat->sprite);
698                 wl_list_remove(&seat->sprite->link);
699                 seat->sprite->plane = WESTON_PLANE_DRM_CURSOR;
700         }
701
702 out:
703         pixman_region32_fini(&cursor_region);
704 }
705
706 static void
707 drm_assign_planes(struct weston_output *output)
708 {
709         struct weston_compositor *ec = output->compositor;
710         struct weston_surface *es, *next;
711         pixman_region32_t overlap, surface_overlap;
712         struct weston_seat *seat;
713
714         /*
715          * Find a surface for each sprite in the output using some heuristics:
716          * 1) size
717          * 2) frequency of update
718          * 3) opacity (though some hw might support alpha blending)
719          * 4) clipping (this can be fixed with color keys)
720          *
721          * The idea is to save on blitting since this should save power.
722          * If we can get a large video surface on the sprite for example,
723          * the main display surface may not need to update at all, and
724          * the client buffer can be used directly for the sprite surface
725          * as we do for flipping full screen surfaces.
726          */
727         seat = (struct weston_seat *) ec->seat;
728         pixman_region32_init(&overlap);
729         wl_list_for_each_safe(es, next, &ec->surface_list, link) {
730                 /*
731                  * FIXME: try to assign hw cursors here too, they're just
732                  * special overlays
733                  */
734                 pixman_region32_init(&surface_overlap);
735                 pixman_region32_intersect(&surface_overlap, &overlap,
736                                           &es->transform.boundingbox);
737
738                 if (es == seat->sprite) {
739                         weston_output_set_cursor(output, seat,
740                                                  &surface_overlap);
741
742                         if (seat->sprite->plane == WESTON_PLANE_PRIMARY)
743                                 pixman_region32_union(&overlap, &overlap,
744                                                       &es->transform.boundingbox);
745                 } else if (!drm_output_prepare_overlay_surface(output, es,
746                                                                &surface_overlap)) {
747                         pixman_region32_fini(&es->damage);
748                         pixman_region32_init(&es->damage);
749                 } else {
750                         pixman_region32_union(&overlap, &overlap,
751                                               &es->transform.boundingbox);
752                 }
753                 pixman_region32_fini(&surface_overlap);
754         }
755         pixman_region32_fini(&overlap);
756
757         if (!seat->sprite || !weston_surface_is_mapped(seat->sprite))
758                 drm_output_set_cursor(output, NULL);
759
760         drm_disable_unused_sprites(output);
761 }
762
763 static int
764 drm_output_set_cursor(struct weston_output *output_base,
765                       struct weston_seat *es)
766 {
767         struct drm_output *output = (struct drm_output *) output_base;
768         struct drm_compositor *c =
769                 (struct drm_compositor *) output->base.compositor;
770         EGLint handle, stride;
771         int ret = -1;
772         struct gbm_bo *bo;
773         uint32_t buf[64 * 64];
774         unsigned char *d, *s, *end;
775
776         if (es == NULL) {
777                 drmModeSetCursor(c->drm.fd, output->crtc_id, 0, 0, 0);
778                 return 0;
779         }
780
781         if (es->sprite->buffer == NULL ||
782             !wl_buffer_is_shm(es->sprite->buffer))
783                 goto out;
784
785         if (es->sprite->geometry.width > 64 ||
786             es->sprite->geometry.height > 64)
787                 goto out;
788
789         output->current_cursor ^= 1;
790         bo = output->cursor_bo[output->current_cursor];
791         if (bo == NULL)
792                 goto out;
793
794         memset(buf, 0, sizeof buf);
795         d = (unsigned char *) buf;
796         stride = wl_shm_buffer_get_stride(es->sprite->buffer);
797         s = wl_shm_buffer_get_data(es->sprite->buffer);
798         end = s + stride * es->sprite->geometry.height;
799         while (s < end) {
800                 memcpy(d, s, es->sprite->geometry.width * 4);
801                 s += stride;
802                 d += 64 * 4;
803         }
804
805         if (gbm_bo_write(bo, buf, sizeof buf) < 0)
806                 goto out;
807
808         handle = gbm_bo_get_handle(bo).s32;
809         ret = drmModeSetCursor(c->drm.fd, output->crtc_id, handle, 64, 64);
810         if (ret) {
811                 weston_log("failed to set cursor: %s\n", strerror(-ret));
812                 goto out;
813         }
814
815         ret = drmModeMoveCursor(c->drm.fd, output->crtc_id,
816                                 es->sprite->geometry.x - output->base.x,
817                                 es->sprite->geometry.y - output->base.y);
818         if (ret) {
819                 weston_log("failed to move cursor: %s\n", strerror(-ret));
820                 goto out;
821         }
822
823 out:
824         if (ret)
825                 drmModeSetCursor(c->drm.fd, output->crtc_id, 0, 0, 0);
826         return ret;
827 }
828
829 static void
830 drm_output_destroy(struct weston_output *output_base)
831 {
832         struct drm_output *output = (struct drm_output *) output_base;
833         struct drm_compositor *c =
834                 (struct drm_compositor *) output->base.compositor;
835         drmModeCrtcPtr origcrtc = output->original_crtc;
836
837         if (output->backlight)
838                 backlight_destroy(output->backlight);
839
840         /* Turn off hardware cursor */
841         drm_output_set_cursor(&output->base, NULL);
842
843         /* Restore original CRTC state */
844         drmModeSetCrtc(c->drm.fd, origcrtc->crtc_id, origcrtc->buffer_id,
845                        origcrtc->x, origcrtc->y,
846                        &output->connector_id, 1, &origcrtc->mode);
847         drmModeFreeCrtc(origcrtc);
848
849         c->crtc_allocator &= ~(1 << output->crtc_id);
850         c->connector_allocator &= ~(1 << output->connector_id);
851
852         eglDestroySurface(c->base.egl_display, output->egl_surface);
853         gbm_surface_destroy(output->surface);
854
855         weston_output_destroy(&output->base);
856         wl_list_remove(&output->base.link);
857
858         free(output);
859 }
860
861 static struct drm_mode *
862 choose_mode (struct drm_output *output, struct weston_mode *target_mode)
863 {
864         struct drm_mode *tmp_mode = NULL, *mode;
865
866         if (output->base.current->width == target_mode->width && 
867             output->base.current->height == target_mode->height &&
868             (output->base.current->refresh == target_mode->refresh ||
869              target_mode->refresh == 0))
870                 return (struct drm_mode *)output->base.current;
871
872         wl_list_for_each(mode, &output->base.mode_list, base.link) {
873                 if (mode->mode_info.hdisplay == target_mode->width &&
874                     mode->mode_info.vdisplay == target_mode->height) {
875                         if (mode->mode_info.vrefresh == target_mode->refresh || 
876                             target_mode->refresh == 0) {
877                                 return mode;
878                         } else if (!tmp_mode) 
879                                 tmp_mode = mode;
880                 }
881         }
882
883         return tmp_mode;
884 }
885
886 static int
887 drm_output_switch_mode(struct weston_output *output_base, struct weston_mode *mode)
888 {
889         struct drm_output *output;
890         struct drm_mode *drm_mode;
891         int ret;
892         struct drm_compositor *ec;
893         struct gbm_surface *surface;
894         EGLSurface egl_surface;
895
896         if (output_base == NULL) {
897                 weston_log("output is NULL.\n");
898                 return -1;
899         }
900
901         if (mode == NULL) {
902                 weston_log("mode is NULL.\n");
903                 return -1;
904         }
905
906         ec = (struct drm_compositor *)output_base->compositor;
907         output = (struct drm_output *)output_base;
908         drm_mode  = choose_mode (output, mode);
909
910         if (!drm_mode) {
911                 weston_log("%s, invalid resolution:%dx%d\n", __func__, mode->width, mode->height);
912                 return -1;
913         } else if (&drm_mode->base == output->base.current) {
914                 return 0;
915         } else if (drm_mode->base.width == output->base.current->width &&
916                    drm_mode->base.height == output->base.current->height) {
917                 /* only change refresh value */
918                 ret = drmModeSetCrtc(ec->drm.fd,
919                                      output->crtc_id,
920                                      output->current->fb_id, 0, 0,
921                                      &output->connector_id, 1, &drm_mode->mode_info);
922
923                 if (ret) {
924                         weston_log("failed to set mode (%dx%d) %u Hz\n",
925                                 drm_mode->base.width,
926                                 drm_mode->base.height,
927                                 drm_mode->base.refresh / 1000);
928                         ret = -1;
929                 } else {
930                         output->base.current->flags = 0;
931                         output->base.current = &drm_mode->base;
932                         drm_mode->base.flags = 
933                                 WL_OUTPUT_MODE_CURRENT | WL_OUTPUT_MODE_PREFERRED;
934                         ret = 0;
935                 }
936
937                 return ret;
938         }
939
940         drm_mode->base.flags =
941                 WL_OUTPUT_MODE_CURRENT | WL_OUTPUT_MODE_PREFERRED;
942
943         surface = gbm_surface_create(ec->gbm,
944                                  drm_mode->base.width,
945                                  drm_mode->base.height,
946                                  GBM_FORMAT_XRGB8888,
947                                  GBM_BO_USE_SCANOUT |
948                                  GBM_BO_USE_RENDERING);
949         if (!surface) {
950                 weston_log("failed to create gbm surface\n");
951                 return -1;
952         }
953
954         egl_surface =
955                 eglCreateWindowSurface(ec->base.egl_display,
956                                        ec->base.egl_config,
957                                        surface, NULL);
958
959         if (egl_surface == EGL_NO_SURFACE) {
960                 weston_log("failed to create egl surface\n");
961                 goto err;
962         }
963
964         ret = drmModeSetCrtc(ec->drm.fd,
965                              output->crtc_id,
966                              output->current->fb_id, 0, 0,
967                              &output->connector_id, 1, &drm_mode->mode_info);
968         if (ret) {
969                 weston_log("failed to set mode\n");
970                 goto err;
971         }
972
973         /* reset rendering stuff. */
974         if (output->current) {
975                 if (output->current->is_client_buffer)
976                         gbm_bo_destroy(output->current->bo);
977                 else
978                         gbm_surface_release_buffer(output->surface,
979                                                    output->current->bo);
980         }
981         output->current = NULL;
982
983         if (output->next) {
984                 if (output->next->is_client_buffer)
985                         gbm_bo_destroy(output->next->bo);
986                 else
987                         gbm_surface_release_buffer(output->surface,
988                                                    output->next->bo);
989         }
990         output->next = NULL;
991
992         eglDestroySurface(ec->base.egl_display, output->egl_surface);
993         gbm_surface_destroy(output->surface);
994         output->egl_surface = egl_surface;
995         output->surface = surface;
996
997         /*update output*/
998         output->base.current = &drm_mode->base;
999         output->base.dirty = 1;
1000         weston_output_move(&output->base, output->base.x, output->base.y);
1001         return 0;
1002
1003 err:
1004         eglDestroySurface(ec->base.egl_display, egl_surface);
1005         gbm_surface_destroy(surface);
1006         return -1;
1007 }
1008
1009 static int
1010 on_drm_input(int fd, uint32_t mask, void *data)
1011 {
1012         drmEventContext evctx;
1013
1014         memset(&evctx, 0, sizeof evctx);
1015         evctx.version = DRM_EVENT_CONTEXT_VERSION;
1016         evctx.page_flip_handler = page_flip_handler;
1017         evctx.vblank_handler = vblank_handler;
1018         drmHandleEvent(fd, &evctx);
1019
1020         return 1;
1021 }
1022
1023 static int
1024 init_egl(struct drm_compositor *ec, struct udev_device *device)
1025 {
1026         EGLint major, minor, n;
1027         const char *filename, *sysnum;
1028         int fd;
1029         static const EGLint context_attribs[] = {
1030                 EGL_CONTEXT_CLIENT_VERSION, 2,
1031                 EGL_NONE
1032         };
1033
1034         static const EGLint config_attribs[] = {
1035                 EGL_SURFACE_TYPE, EGL_WINDOW_BIT,
1036                 EGL_RED_SIZE, 1,
1037                 EGL_GREEN_SIZE, 1,
1038                 EGL_BLUE_SIZE, 1,
1039                 EGL_ALPHA_SIZE, 0,
1040                 EGL_RENDERABLE_TYPE, EGL_OPENGL_ES2_BIT,
1041                 EGL_NONE
1042         };
1043
1044         sysnum = udev_device_get_sysnum(device);
1045         if (sysnum)
1046                 ec->drm.id = atoi(sysnum);
1047         if (!sysnum || ec->drm.id < 0) {
1048                 weston_log("cannot get device sysnum\n");
1049                 return -1;
1050         }
1051
1052         filename = udev_device_get_devnode(device);
1053         fd = open(filename, O_RDWR | O_CLOEXEC);
1054         if (fd < 0) {
1055                 /* Probably permissions error */
1056                 weston_log("couldn't open %s, skipping\n",
1057                         udev_device_get_devnode(device));
1058                 return -1;
1059         }
1060
1061         weston_log("using %s\n", filename);
1062
1063         ec->drm.fd = fd;
1064         ec->gbm = gbm_create_device(ec->drm.fd);
1065         ec->base.egl_display = eglGetDisplay(ec->gbm);
1066         if (ec->base.egl_display == NULL) {
1067                 weston_log("failed to create display\n");
1068                 return -1;
1069         }
1070
1071         if (!eglInitialize(ec->base.egl_display, &major, &minor)) {
1072                 weston_log("failed to initialize display\n");
1073                 return -1;
1074         }
1075
1076         if (!eglBindAPI(EGL_OPENGL_ES_API)) {
1077                 weston_log("failed to bind api EGL_OPENGL_ES_API\n");
1078                 return -1;
1079         }
1080
1081         if (!eglChooseConfig(ec->base.egl_display, config_attribs,
1082                              &ec->base.egl_config, 1, &n) || n != 1) {
1083                 weston_log("failed to choose config: %d\n", n);
1084                 return -1;
1085         }
1086
1087         ec->base.egl_context =
1088                 eglCreateContext(ec->base.egl_display, ec->base.egl_config,
1089                                  EGL_NO_CONTEXT, context_attribs);
1090         if (ec->base.egl_context == NULL) {
1091                 weston_log("failed to create context\n");
1092                 return -1;
1093         }
1094
1095         ec->dummy_surface = gbm_surface_create(ec->gbm, 10, 10,
1096                                                GBM_FORMAT_XRGB8888,
1097                                                GBM_BO_USE_RENDERING);
1098         if (!ec->dummy_surface) {
1099                 weston_log("failed to create dummy gbm surface\n");
1100                 return -1;
1101         }
1102
1103         ec->dummy_egl_surface =
1104                 eglCreateWindowSurface(ec->base.egl_display,
1105                                        ec->base.egl_config,
1106                                        ec->dummy_surface,
1107                                        NULL);
1108         if (ec->dummy_egl_surface == EGL_NO_SURFACE) {
1109                 weston_log("failed to create egl surface\n");
1110                 return -1;
1111         }
1112
1113         if (!eglMakeCurrent(ec->base.egl_display, ec->dummy_egl_surface,
1114                             ec->dummy_egl_surface, ec->base.egl_context)) {
1115                 weston_log("failed to make context current\n");
1116                 return -1;
1117         }
1118
1119         return 0;
1120 }
1121
1122 static drmModeModeInfo builtin_1024x768 = {
1123         63500,                  /* clock */
1124         1024, 1072, 1176, 1328, 0,
1125         768, 771, 775, 798, 0,
1126         59920,
1127         DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC,
1128         0,
1129         "1024x768"
1130 };
1131
1132
1133 static int
1134 drm_output_add_mode(struct drm_output *output, drmModeModeInfo *info)
1135 {
1136         struct drm_mode *mode;
1137         uint64_t refresh;
1138
1139         mode = malloc(sizeof *mode);
1140         if (mode == NULL)
1141                 return -1;
1142
1143         mode->base.flags = 0;
1144         mode->base.width = info->hdisplay;
1145         mode->base.height = info->vdisplay;
1146
1147         /* Calculate higher precision (mHz) refresh rate */
1148         refresh = (info->clock * 1000000LL / info->htotal +
1149                    info->vtotal / 2) / info->vtotal;
1150
1151         if (info->flags & DRM_MODE_FLAG_INTERLACE)
1152                 refresh *= 2;
1153         if (info->flags & DRM_MODE_FLAG_DBLSCAN)
1154                 refresh /= 2;
1155         if (info->vscan > 1)
1156             refresh /= info->vscan;
1157
1158         mode->base.refresh = refresh;
1159         mode->mode_info = *info;
1160         wl_list_insert(output->base.mode_list.prev, &mode->base.link);
1161
1162         return 0;
1163 }
1164
1165 static int
1166 drm_subpixel_to_wayland(int drm_value)
1167 {
1168         switch (drm_value) {
1169         default:
1170         case DRM_MODE_SUBPIXEL_UNKNOWN:
1171                 return WL_OUTPUT_SUBPIXEL_UNKNOWN;
1172         case DRM_MODE_SUBPIXEL_NONE:
1173                 return WL_OUTPUT_SUBPIXEL_NONE;
1174         case DRM_MODE_SUBPIXEL_HORIZONTAL_RGB:
1175                 return WL_OUTPUT_SUBPIXEL_HORIZONTAL_RGB;
1176         case DRM_MODE_SUBPIXEL_HORIZONTAL_BGR:
1177                 return WL_OUTPUT_SUBPIXEL_HORIZONTAL_BGR;
1178         case DRM_MODE_SUBPIXEL_VERTICAL_RGB:
1179                 return WL_OUTPUT_SUBPIXEL_VERTICAL_RGB;
1180         case DRM_MODE_SUBPIXEL_VERTICAL_BGR:
1181                 return WL_OUTPUT_SUBPIXEL_VERTICAL_BGR;
1182         }
1183 }
1184
1185 static void
1186 sprite_handle_buffer_destroy(struct wl_listener *listener, void *data)
1187 {
1188         struct drm_sprite *sprite =
1189                 container_of(listener, struct drm_sprite,
1190                              destroy_listener);
1191         struct drm_compositor *compositor = sprite->compositor;
1192
1193         sprite->surface = NULL;
1194         drmModeRmFB(compositor->drm.fd, sprite->fb_id);
1195         sprite->fb_id = 0;
1196 }
1197
1198 static void
1199 sprite_handle_pending_buffer_destroy(struct wl_listener *listener, void *data)
1200 {
1201         struct drm_sprite *sprite =
1202                 container_of(listener, struct drm_sprite,
1203                              pending_destroy_listener);
1204         struct drm_compositor *compositor = sprite->compositor;
1205
1206         sprite->pending_surface = NULL;
1207         drmModeRmFB(compositor->drm.fd, sprite->pending_fb_id);
1208         sprite->pending_fb_id = 0;
1209 }
1210
1211 /* returns a value between 0-255 range, where higher is brighter */
1212 static uint32_t
1213 drm_get_backlight(struct drm_output *output)
1214 {
1215         long brightness, max_brightness, norm;
1216
1217         brightness = backlight_get_brightness(output->backlight);
1218         max_brightness = backlight_get_max_brightness(output->backlight);
1219
1220         /* convert it on a scale of 0 to 255 */
1221         norm = (brightness * 255)/(max_brightness);
1222
1223         return (uint32_t) norm;
1224 }
1225
1226 /* values accepted are between 0-255 range */
1227 static void
1228 drm_set_backlight(struct weston_output *output_base, uint32_t value)
1229 {
1230         struct drm_output *output = (struct drm_output *) output_base;
1231         long max_brightness, new_brightness;
1232
1233         if (!output->backlight)
1234                 return;
1235
1236         if (value > 255)
1237                 return;
1238
1239         max_brightness = backlight_get_max_brightness(output->backlight);
1240
1241         /* get denormalized value */
1242         new_brightness = (value * max_brightness) / 255;
1243
1244         backlight_set_brightness(output->backlight, new_brightness);
1245 }
1246
1247 static drmModePropertyPtr
1248 drm_get_prop(int fd, drmModeConnectorPtr connector, const char *name)
1249 {
1250         drmModePropertyPtr props;
1251         int i;
1252
1253         for (i = 0; i < connector->count_props; i++) {
1254                 props = drmModeGetProperty(fd, connector->props[i]);
1255                 if (!props)
1256                         continue;
1257
1258                 if (!strcmp(props->name, name))
1259                         return props;
1260
1261                 drmModeFreeProperty(props);
1262         }
1263
1264         return NULL;
1265 }
1266
1267 static void
1268 drm_set_dpms(struct weston_output *output_base, enum dpms_enum level)
1269 {
1270         struct drm_output *output = (struct drm_output *) output_base;
1271         struct weston_compositor *ec = output_base->compositor;
1272         struct drm_compositor *c = (struct drm_compositor *) ec;
1273         drmModeConnectorPtr connector;
1274         drmModePropertyPtr prop;
1275
1276         connector = drmModeGetConnector(c->drm.fd, output->connector_id);
1277         if (!connector)
1278                 return;
1279
1280         prop = drm_get_prop(c->drm.fd, connector, "DPMS");
1281         if (!prop) {
1282                 drmModeFreeConnector(connector);
1283                 return;
1284         }
1285
1286         drmModeConnectorSetProperty(c->drm.fd, connector->connector_id,
1287                                     prop->prop_id, level);
1288         drmModeFreeProperty(prop);
1289         drmModeFreeConnector(connector);
1290 }
1291
1292 static int
1293 create_output_for_connector(struct drm_compositor *ec,
1294                             drmModeRes *resources,
1295                             drmModeConnector *connector,
1296                             int x, int y, struct udev_device *drm_device)
1297 {
1298         struct drm_output *output;
1299         struct drm_mode *drm_mode, *next;
1300         drmModeEncoder *encoder;
1301         int i, ret;
1302
1303         encoder = drmModeGetEncoder(ec->drm.fd, connector->encoders[0]);
1304         if (encoder == NULL) {
1305                 weston_log("No encoder for connector.\n");
1306                 return -1;
1307         }
1308
1309         for (i = 0; i < resources->count_crtcs; i++) {
1310                 if (encoder->possible_crtcs & (1 << i) &&
1311                     !(ec->crtc_allocator & (1 << resources->crtcs[i])))
1312                         break;
1313         }
1314         if (i == resources->count_crtcs) {
1315                 weston_log("No usable crtc for encoder.\n");
1316                 drmModeFreeEncoder(encoder);
1317                 return -1;
1318         }
1319
1320         output = malloc(sizeof *output);
1321         if (output == NULL) {
1322                 drmModeFreeEncoder(encoder);
1323                 return -1;
1324         }
1325
1326         memset(output, 0, sizeof *output);
1327         output->base.subpixel = drm_subpixel_to_wayland(connector->subpixel);
1328         output->base.make = "unknown";
1329         output->base.model = "unknown";
1330         wl_list_init(&output->base.mode_list);
1331
1332         output->crtc_id = resources->crtcs[i];
1333         ec->crtc_allocator |= (1 << output->crtc_id);
1334         output->connector_id = connector->connector_id;
1335         ec->connector_allocator |= (1 << output->connector_id);
1336
1337         output->original_crtc = drmModeGetCrtc(ec->drm.fd, output->crtc_id);
1338         drmModeFreeEncoder(encoder);
1339
1340         for (i = 0; i < connector->count_modes; i++) {
1341                 ret = drm_output_add_mode(output, &connector->modes[i]);
1342                 if (ret)
1343                         goto err_free;
1344         }
1345
1346         if (connector->count_modes == 0) {
1347                 ret = drm_output_add_mode(output, &builtin_1024x768);
1348                 if (ret)
1349                         goto err_free;
1350         }
1351
1352         drm_mode = container_of(output->base.mode_list.next,
1353                                 struct drm_mode, base.link);
1354         output->base.current = &drm_mode->base;
1355         drm_mode->base.flags =
1356                 WL_OUTPUT_MODE_CURRENT | WL_OUTPUT_MODE_PREFERRED;
1357
1358         output->surface = gbm_surface_create(ec->gbm,
1359                                              output->base.current->width,
1360                                              output->base.current->height,
1361                                              GBM_FORMAT_XRGB8888,
1362                                              GBM_BO_USE_SCANOUT |
1363                                              GBM_BO_USE_RENDERING);
1364         if (!output->surface) {
1365                 weston_log("failed to create gbm surface\n");
1366                 goto err_free;
1367         }
1368
1369         output->egl_surface =
1370                 eglCreateWindowSurface(ec->base.egl_display,
1371                                        ec->base.egl_config,
1372                                        output->surface,
1373                                        NULL);
1374         if (output->egl_surface == EGL_NO_SURFACE) {
1375                 weston_log("failed to create egl surface\n");
1376                 goto err_surface;
1377         }
1378
1379         output->cursor_bo[0] =
1380                 gbm_bo_create(ec->gbm, 64, 64, GBM_FORMAT_ARGB8888,
1381                               GBM_BO_USE_CURSOR_64X64 | GBM_BO_USE_WRITE);
1382         output->cursor_bo[1] =
1383                 gbm_bo_create(ec->gbm, 64, 64, GBM_FORMAT_ARGB8888,
1384                               GBM_BO_USE_CURSOR_64X64 | GBM_BO_USE_WRITE);
1385
1386         output->backlight = backlight_init(drm_device,
1387                                            connector->connector_type);
1388         if (output->backlight) {
1389                 output->base.set_backlight = drm_set_backlight;
1390                 output->base.backlight_current = drm_get_backlight(output);
1391         }
1392
1393         weston_output_init(&output->base, &ec->base, x, y,
1394                            connector->mmWidth, connector->mmHeight,
1395                            WL_OUTPUT_FLIPPED);
1396
1397         wl_list_insert(ec->base.output_list.prev, &output->base.link);
1398
1399         output->base.origin = output->base.current;
1400         output->base.repaint = drm_output_repaint;
1401         output->base.destroy = drm_output_destroy;
1402         output->base.assign_planes = drm_assign_planes;
1403         output->base.set_dpms = drm_set_dpms;
1404         output->base.switch_mode = drm_output_switch_mode;
1405
1406         weston_log("kms connector %d, crtc %d at mode %dx%d@%.1f\n",
1407                    output->connector_id, output->crtc_id,
1408                    output->base.current->width,
1409                    output->base.current->height,
1410                    output->base.current->refresh / 1000.0);
1411
1412         return 0;
1413
1414 err_surface:
1415         gbm_surface_destroy(output->surface);
1416 err_free:
1417         wl_list_for_each_safe(drm_mode, next, &output->base.mode_list,
1418                                                         base.link) {
1419                 wl_list_remove(&drm_mode->base.link);
1420                 free(drm_mode);
1421         }
1422
1423         drmModeFreeCrtc(output->original_crtc);
1424         ec->crtc_allocator &= ~(1 << output->crtc_id);
1425         ec->connector_allocator &= ~(1 << output->connector_id);
1426         free(output);
1427
1428         return -1;
1429 }
1430
1431 static void
1432 create_sprites(struct drm_compositor *ec)
1433 {
1434         struct drm_sprite *sprite;
1435         drmModePlaneRes *plane_res;
1436         drmModePlane *plane;
1437         uint32_t i;
1438
1439         plane_res = drmModeGetPlaneResources(ec->drm.fd);
1440         if (!plane_res) {
1441                 weston_log("failed to get plane resources: %s\n",
1442                         strerror(errno));
1443                 return;
1444         }
1445
1446         for (i = 0; i < plane_res->count_planes; i++) {
1447                 plane = drmModeGetPlane(ec->drm.fd, plane_res->planes[i]);
1448                 if (!plane)
1449                         continue;
1450
1451                 sprite = malloc(sizeof(*sprite) + ((sizeof(uint32_t)) *
1452                                                    plane->count_formats));
1453                 if (!sprite) {
1454                         weston_log("%s: out of memory\n",
1455                                 __func__);
1456                         free(plane);
1457                         continue;
1458                 }
1459
1460                 memset(sprite, 0, sizeof *sprite);
1461
1462                 sprite->possible_crtcs = plane->possible_crtcs;
1463                 sprite->plane_id = plane->plane_id;
1464                 sprite->surface = NULL;
1465                 sprite->pending_surface = NULL;
1466                 sprite->fb_id = 0;
1467                 sprite->pending_fb_id = 0;
1468                 sprite->destroy_listener.notify = sprite_handle_buffer_destroy;
1469                 sprite->pending_destroy_listener.notify =
1470                         sprite_handle_pending_buffer_destroy;
1471                 sprite->compositor = ec;
1472                 sprite->count_formats = plane->count_formats;
1473                 memcpy(sprite->formats, plane->formats,
1474                        plane->count_formats * sizeof(plane->formats[0]));
1475                 drmModeFreePlane(plane);
1476
1477                 wl_list_insert(&ec->sprite_list, &sprite->link);
1478         }
1479
1480         free(plane_res->planes);
1481         free(plane_res);
1482 }
1483
1484 static void
1485 destroy_sprites(struct drm_compositor *compositor)
1486 {
1487         struct drm_sprite *sprite, *next;
1488         struct drm_output *output;
1489
1490         output = container_of(compositor->base.output_list.next,
1491                               struct drm_output, base.link);
1492
1493         wl_list_for_each_safe(sprite, next, &compositor->sprite_list, link) {
1494                 drmModeSetPlane(compositor->drm.fd,
1495                                 sprite->plane_id,
1496                                 output->crtc_id, 0, 0,
1497                                 0, 0, 0, 0, 0, 0, 0, 0);
1498                 drmModeRmFB(compositor->drm.fd, sprite->fb_id);
1499                 free(sprite);
1500         }
1501 }
1502
1503 static int
1504 create_outputs(struct drm_compositor *ec, uint32_t option_connector,
1505                struct udev_device *drm_device)
1506 {
1507         drmModeConnector *connector;
1508         drmModeRes *resources;
1509         int i;
1510         int x = 0, y = 0;
1511
1512         resources = drmModeGetResources(ec->drm.fd);
1513         if (!resources) {
1514                 weston_log("drmModeGetResources failed\n");
1515                 return -1;
1516         }
1517
1518         ec->crtcs = calloc(resources->count_crtcs, sizeof(uint32_t));
1519         if (!ec->crtcs) {
1520                 drmModeFreeResources(resources);
1521                 return -1;
1522         }
1523
1524         ec->num_crtcs = resources->count_crtcs;
1525         memcpy(ec->crtcs, resources->crtcs, sizeof(uint32_t) * ec->num_crtcs);
1526
1527         for (i = 0; i < resources->count_connectors; i++) {
1528                 connector = drmModeGetConnector(ec->drm.fd,
1529                                                 resources->connectors[i]);
1530                 if (connector == NULL)
1531                         continue;
1532
1533                 if (connector->connection == DRM_MODE_CONNECTED &&
1534                     (option_connector == 0 ||
1535                      connector->connector_id == option_connector)) {
1536                         if (create_output_for_connector(ec, resources,
1537                                                         connector, x, y,
1538                                                         drm_device) < 0) {
1539                                 drmModeFreeConnector(connector);
1540                                 continue;
1541                         }
1542
1543                         x += container_of(ec->base.output_list.prev,
1544                                           struct weston_output,
1545                                           link)->current->width;
1546                 }
1547
1548                 drmModeFreeConnector(connector);
1549         }
1550
1551         if (wl_list_empty(&ec->base.output_list)) {
1552                 weston_log("No currently active connector found.\n");
1553                 drmModeFreeResources(resources);
1554                 return -1;
1555         }
1556
1557         drmModeFreeResources(resources);
1558
1559         return 0;
1560 }
1561
1562 static void
1563 update_outputs(struct drm_compositor *ec, struct udev_device *drm_device)
1564 {
1565         drmModeConnector *connector;
1566         drmModeRes *resources;
1567         struct drm_output *output, *next;
1568         int x = 0, y = 0;
1569         int x_offset = 0, y_offset = 0;
1570         uint32_t connected = 0, disconnects = 0;
1571         int i;
1572
1573         resources = drmModeGetResources(ec->drm.fd);
1574         if (!resources) {
1575                 weston_log("drmModeGetResources failed\n");
1576                 return;
1577         }
1578
1579         /* collect new connects */
1580         for (i = 0; i < resources->count_connectors; i++) {
1581                 int connector_id = resources->connectors[i];
1582
1583                 connector = drmModeGetConnector(ec->drm.fd, connector_id);
1584                 if (connector == NULL)
1585                         continue;
1586
1587                 if (connector->connection != DRM_MODE_CONNECTED) {
1588                         drmModeFreeConnector(connector);
1589                         continue;
1590                 }
1591
1592                 connected |= (1 << connector_id);
1593
1594                 if (!(ec->connector_allocator & (1 << connector_id))) {
1595                         struct weston_output *last =
1596                                 container_of(ec->base.output_list.prev,
1597                                              struct weston_output, link);
1598
1599                         /* XXX: not yet needed, we die with 0 outputs */
1600                         if (!wl_list_empty(&ec->base.output_list))
1601                                 x = last->x + last->current->width;
1602                         else
1603                                 x = 0;
1604                         y = 0;
1605                         create_output_for_connector(ec, resources,
1606                                                     connector, x, y,
1607                                                     drm_device);
1608                         weston_log("connector %d connected\n", connector_id);
1609
1610                 }
1611                 drmModeFreeConnector(connector);
1612         }
1613         drmModeFreeResources(resources);
1614
1615         disconnects = ec->connector_allocator & ~connected;
1616         if (disconnects) {
1617                 wl_list_for_each_safe(output, next, &ec->base.output_list,
1618                                       base.link) {
1619                         if (x_offset != 0 || y_offset != 0) {
1620                                 weston_output_move(&output->base,
1621                                                  output->base.x - x_offset,
1622                                                  output->base.y - y_offset);
1623                         }
1624
1625                         if (disconnects & (1 << output->connector_id)) {
1626                                 disconnects &= ~(1 << output->connector_id);
1627                                 weston_log("connector %d disconnected\n",
1628                                        output->connector_id);
1629                                 x_offset += output->base.current->width;
1630                                 drm_output_destroy(&output->base);
1631                         }
1632                 }
1633         }
1634
1635         /* FIXME: handle zero outputs, without terminating */   
1636         if (ec->connector_allocator == 0)
1637                 wl_display_terminate(ec->base.wl_display);
1638 }
1639
1640 static int
1641 udev_event_is_hotplug(struct drm_compositor *ec, struct udev_device *device)
1642 {
1643         const char *sysnum;
1644         const char *val;
1645
1646         sysnum = udev_device_get_sysnum(device);
1647         if (!sysnum || atoi(sysnum) != ec->drm.id)
1648                 return 0;
1649
1650         val = udev_device_get_property_value(device, "HOTPLUG");
1651         if (!val)
1652                 return 0;
1653
1654         return strcmp(val, "1") == 0;
1655 }
1656
1657 static int
1658 udev_drm_event(int fd, uint32_t mask, void *data)
1659 {
1660         struct drm_compositor *ec = data;
1661         struct udev_device *event;
1662
1663         event = udev_monitor_receive_device(ec->udev_monitor);
1664
1665         if (udev_event_is_hotplug(ec, event))
1666                 update_outputs(ec, event);
1667
1668         udev_device_unref(event);
1669
1670         return 1;
1671 }
1672
1673 static void
1674 drm_destroy(struct weston_compositor *ec)
1675 {
1676         struct drm_compositor *d = (struct drm_compositor *) ec;
1677         struct weston_seat *seat, *next;
1678
1679         wl_list_for_each_safe(seat, next, &ec->seat_list, link)
1680                 evdev_input_destroy(seat);
1681
1682         wl_event_source_remove(d->udev_drm_source);
1683         wl_event_source_remove(d->drm_source);
1684
1685         weston_compositor_shutdown(ec);
1686
1687         /* Work around crash in egl_dri2.c's dri2_make_current() */
1688         eglMakeCurrent(ec->egl_display, EGL_NO_SURFACE, EGL_NO_SURFACE,
1689                        EGL_NO_CONTEXT);
1690         eglTerminate(ec->egl_display);
1691         eglReleaseThread();
1692
1693         gbm_device_destroy(d->gbm);
1694         destroy_sprites(d);
1695         if (weston_launcher_drm_set_master(&d->base, d->drm.fd, 0) < 0)
1696                 weston_log("failed to drop master: %m\n");
1697         tty_destroy(d->tty);
1698
1699         free(d);
1700 }
1701
1702 static void
1703 drm_compositor_set_modes(struct drm_compositor *compositor)
1704 {
1705         struct drm_output *output;
1706         struct drm_mode *drm_mode;
1707         int ret;
1708
1709         wl_list_for_each(output, &compositor->base.output_list, base.link) {
1710                 drm_mode = (struct drm_mode *) output->base.current;
1711                 ret = drmModeSetCrtc(compositor->drm.fd, output->crtc_id,
1712                                      output->current->fb_id, 0, 0,
1713                                      &output->connector_id, 1,
1714                                      &drm_mode->mode_info);
1715                 if (ret < 0) {
1716                         weston_log(
1717                                 "failed to set mode %dx%d for output at %d,%d: %m\n",
1718                                 drm_mode->base.width, drm_mode->base.height, 
1719                                 output->base.x, output->base.y);
1720                 }
1721         }
1722 }
1723
1724 static void
1725 vt_func(struct weston_compositor *compositor, int event)
1726 {
1727         struct drm_compositor *ec = (struct drm_compositor *) compositor;
1728         struct weston_output *output;
1729         struct weston_seat *seat;
1730         struct drm_sprite *sprite;
1731         struct drm_output *drm_output;
1732
1733         switch (event) {
1734         case TTY_ENTER_VT:
1735                 compositor->focus = 1;
1736                 if (weston_launcher_drm_set_master(&ec->base, ec->drm.fd, 1)) {
1737                         weston_log("failed to set master: %m\n");
1738                         wl_display_terminate(compositor->wl_display);
1739                 }
1740                 compositor->state = ec->prev_state;
1741                 drm_compositor_set_modes(ec);
1742                 weston_compositor_damage_all(compositor);
1743                 wl_list_for_each(seat, &compositor->seat_list, link) {
1744                         evdev_add_devices(ec->udev, seat);
1745                         evdev_enable_udev_monitor(ec->udev, seat);
1746                 }
1747                 break;
1748         case TTY_LEAVE_VT:
1749                 wl_list_for_each(seat, &compositor->seat_list, link) {
1750                         evdev_disable_udev_monitor(seat);
1751                         evdev_remove_devices(seat);
1752                 }
1753
1754                 compositor->focus = 0;
1755                 ec->prev_state = compositor->state;
1756                 compositor->state = WESTON_COMPOSITOR_SLEEPING;
1757
1758                 /* If we have a repaint scheduled (either from a
1759                  * pending pageflip or the idle handler), make sure we
1760                  * cancel that so we don't try to pageflip when we're
1761                  * vt switched away.  The SLEEPING state will prevent
1762                  * further attemps at repainting.  When we switch
1763                  * back, we schedule a repaint, which will process
1764                  * pending frame callbacks. */
1765
1766                 wl_list_for_each(output, &ec->base.output_list, link) {
1767                         output->repaint_needed = 0;
1768                         drm_output_set_cursor(output, NULL);
1769                 }
1770
1771                 drm_output = container_of(ec->base.output_list.next,
1772                                           struct drm_output, base.link);
1773
1774                 wl_list_for_each(sprite, &ec->sprite_list, link)
1775                         drmModeSetPlane(ec->drm.fd,
1776                                         sprite->plane_id,
1777                                         drm_output->crtc_id, 0, 0,
1778                                         0, 0, 0, 0, 0, 0, 0, 0);
1779
1780                 if (weston_launcher_drm_set_master(&ec->base, ec->drm.fd, 0) < 0)
1781                         weston_log("failed to drop master: %m\n");
1782
1783                 break;
1784         };
1785 }
1786
1787 static void
1788 switch_vt_binding(struct wl_seat *seat, uint32_t time, uint32_t key, void *data)
1789 {
1790         struct drm_compositor *ec = data;
1791
1792         tty_activate_vt(ec->tty, key - KEY_F1 + 1);
1793 }
1794
1795 static const char default_seat[] = "seat0";
1796
1797 static struct weston_compositor *
1798 drm_compositor_create(struct wl_display *display,
1799                       int connector, const char *seat, int tty,
1800                       int argc, char *argv[], const char *config_file)
1801 {
1802         struct drm_compositor *ec;
1803         struct udev_enumerate *e;
1804         struct udev_list_entry *entry;
1805         struct udev_device *device, *drm_device;
1806         const char *path, *device_seat;
1807         struct wl_event_loop *loop;
1808         struct weston_seat *weston_seat, *next;
1809         uint32_t key;
1810
1811         weston_log("initializing drm backend\n");
1812
1813         ec = malloc(sizeof *ec);
1814         if (ec == NULL)
1815                 return NULL;
1816         memset(ec, 0, sizeof *ec);
1817
1818         if (weston_compositor_init(&ec->base, display, argc, argv,
1819                                    config_file) < 0) {
1820                 weston_log("weston_compositor_init failed\n");
1821                 goto err_base;
1822         }
1823
1824         ec->udev = udev_new();
1825         if (ec->udev == NULL) {
1826                 weston_log("failed to initialize udev context\n");
1827                 goto err_compositor;
1828         }
1829
1830         ec->base.wl_display = display;
1831         ec->tty = tty_create(&ec->base, vt_func, tty);
1832         if (!ec->tty) {
1833                 weston_log("failed to initialize tty\n");
1834                 goto err_udev;
1835         }
1836
1837         e = udev_enumerate_new(ec->udev);
1838         udev_enumerate_add_match_subsystem(e, "drm");
1839         udev_enumerate_add_match_sysname(e, "card[0-9]*");
1840
1841         udev_enumerate_scan_devices(e);
1842         drm_device = NULL;
1843         udev_list_entry_foreach(entry, udev_enumerate_get_list_entry(e)) {
1844                 path = udev_list_entry_get_name(entry);
1845                 device = udev_device_new_from_syspath(ec->udev, path);
1846                 device_seat =
1847                         udev_device_get_property_value(device, "ID_SEAT");
1848                 if (!device_seat)
1849                         device_seat = default_seat;
1850                 if (strcmp(device_seat, seat) == 0) {
1851                         drm_device = device;
1852                         break;
1853                 }
1854                 udev_device_unref(device);
1855         }
1856
1857         if (drm_device == NULL) {
1858                 weston_log("no drm device found\n");
1859                 goto err_udev_enum;
1860         }
1861
1862         if (init_egl(ec, drm_device) < 0) {
1863                 weston_log("failed to initialize egl\n");
1864                 goto err_udev_dev;
1865         }
1866
1867         ec->base.destroy = drm_destroy;
1868
1869         ec->base.focus = 1;
1870
1871         ec->prev_state = WESTON_COMPOSITOR_ACTIVE;
1872
1873         if (weston_compositor_init_gl(&ec->base) < 0)
1874                 goto err_egl;
1875
1876         for (key = KEY_F1; key < KEY_F9; key++)
1877                 weston_compositor_add_key_binding(&ec->base, key,
1878                                                   MODIFIER_CTRL | MODIFIER_ALT,
1879                                                   switch_vt_binding, ec);
1880
1881         wl_list_init(&ec->sprite_list);
1882         create_sprites(ec);
1883
1884         if (create_outputs(ec, connector, drm_device) < 0) {
1885                 weston_log("failed to create output for %s\n", path);
1886                 goto err_sprite;
1887         }
1888
1889         path = NULL;
1890
1891         evdev_input_create(&ec->base, ec->udev, seat);
1892
1893         loop = wl_display_get_event_loop(ec->base.wl_display);
1894         ec->drm_source =
1895                 wl_event_loop_add_fd(loop, ec->drm.fd,
1896                                      WL_EVENT_READABLE, on_drm_input, ec);
1897
1898         ec->udev_monitor = udev_monitor_new_from_netlink(ec->udev, "udev");
1899         if (ec->udev_monitor == NULL) {
1900                 weston_log("failed to intialize udev monitor\n");
1901                 goto err_drm_source;
1902         }
1903         udev_monitor_filter_add_match_subsystem_devtype(ec->udev_monitor,
1904                                                         "drm", NULL);
1905         ec->udev_drm_source =
1906                 wl_event_loop_add_fd(loop,
1907                                      udev_monitor_get_fd(ec->udev_monitor),
1908                                      WL_EVENT_READABLE, udev_drm_event, ec);
1909
1910         if (udev_monitor_enable_receiving(ec->udev_monitor) < 0) {
1911                 weston_log("failed to enable udev-monitor receiving\n");
1912                 goto err_udev_monitor;
1913         }
1914
1915         udev_device_unref(drm_device);
1916         udev_enumerate_unref(e);
1917
1918         return &ec->base;
1919
1920 err_udev_monitor:
1921         wl_event_source_remove(ec->udev_drm_source);
1922         udev_monitor_unref(ec->udev_monitor);
1923 err_drm_source:
1924         wl_event_source_remove(ec->drm_source);
1925         wl_list_for_each_safe(weston_seat, next, &ec->base.seat_list, link)
1926                 evdev_input_destroy(weston_seat);
1927 err_sprite:
1928         destroy_sprites(ec);
1929 err_egl:
1930         eglMakeCurrent(ec->base.egl_display, EGL_NO_SURFACE, EGL_NO_SURFACE,
1931                        EGL_NO_CONTEXT);
1932         eglTerminate(ec->base.egl_display);
1933         eglReleaseThread();
1934         gbm_device_destroy(ec->gbm);
1935 err_udev_dev:
1936         udev_device_unref(drm_device);
1937 err_udev_enum:
1938         udev_enumerate_unref(e);
1939         tty_destroy(ec->tty);
1940 err_udev:
1941         udev_unref(ec->udev);
1942 err_compositor:
1943         weston_compositor_shutdown(&ec->base);
1944 err_base:
1945         free(ec);
1946         return NULL;
1947 }
1948
1949 WL_EXPORT struct weston_compositor *
1950 backend_init(struct wl_display *display, int argc, char *argv[],
1951              const char *config_file)
1952 {
1953         int connector = 0, tty = 0;
1954         const char *seat = default_seat;
1955
1956         const struct weston_option drm_options[] = {
1957                 { WESTON_OPTION_INTEGER, "connector", 0, &connector },
1958                 { WESTON_OPTION_STRING, "seat", 0, &seat },
1959                 { WESTON_OPTION_INTEGER, "tty", 0, &tty },
1960         };
1961
1962         parse_options(drm_options, ARRAY_LENGTH(drm_options), argc, argv);
1963
1964         return drm_compositor_create(display, connector, seat, tty, argc, argv,
1965                                      config_file);
1966 }