-static inline int
-int_max(int a, int b)
-{
- return a > b ? a : b;
-}
-
-static void
-rpi_resource_init(struct rpi_resource *resource)
-{
- resource->handle = DISPMANX_NO_HANDLE;
-}
-
-static void
-rpi_resource_release(struct rpi_resource *resource)
-{
- if (resource->handle == DISPMANX_NO_HANDLE)
- return;
-
- vc_dispmanx_resource_delete(resource->handle);
- DBG("resource %p release\n", resource);
- resource->handle = DISPMANX_NO_HANDLE;
-}
-
-static int
-rpi_resource_realloc(struct rpi_resource *resource, VC_IMAGE_TYPE_T ifmt,
- int width, int height, int stride, int buffer_height)
-{
- uint32_t dummy;
-
- if (resource->handle != DISPMANX_NO_HANDLE &&
- resource->width == width &&
- resource->height == height &&
- resource->stride == stride &&
- resource->buffer_height == buffer_height &&
- resource->ifmt == ifmt)
- return 0;
-
- rpi_resource_release(resource);
-
- /* NOTE: if stride is not a multiple of 16 pixels in bytes,
- * the vc_image_* functions may break. Dispmanx elements
- * should be fine, though. Buffer_height probably has similar
- * constraints, too.
- */
- resource->handle =
- vc_dispmanx_resource_create(ifmt,
- width | (stride << 16),
- height | (buffer_height << 16),
- &dummy);
- if (resource->handle == DISPMANX_NO_HANDLE)
- return -1;
-
- resource->width = width;
- resource->height = height;
- resource->stride = stride;
- resource->buffer_height = buffer_height;
- resource->ifmt = ifmt;
- DBG("resource %p alloc\n", resource);
- return 0;
-}
-
-static VC_IMAGE_TYPE_T
-shm_buffer_get_vc_format(struct wl_buffer *buffer)
-{
- switch (wl_shm_buffer_get_format(buffer)) {
- case WL_SHM_FORMAT_XRGB8888:
- return VC_IMAGE_XRGB8888;
- case WL_SHM_FORMAT_ARGB8888:
- return VC_IMAGE_ARGB8888;
- default:
- /* invalid format */
- return VC_IMAGE_MIN;
- }
-}
-
-static int
-rpi_resource_update(struct rpi_resource *resource, struct wl_buffer *buffer,
- pixman_region32_t *region)
-{
- pixman_region32_t write_region;
- pixman_box32_t *r;
- VC_RECT_T rect;
- VC_IMAGE_TYPE_T ifmt;
- uint32_t *pixels;
- int width;
- int height;
- int stride;
- int ret;
-#ifdef HAVE_RESOURCE_WRITE_DATA_RECT
- int n;
-#endif
-
- if (!buffer)
- return -1;
-
- ifmt = shm_buffer_get_vc_format(buffer);
- width = wl_shm_buffer_get_width(buffer);
- height = wl_shm_buffer_get_height(buffer);
- stride = wl_shm_buffer_get_stride(buffer);
- pixels = wl_shm_buffer_get_data(buffer);
-
- if (rpi_resource_realloc(resource, ifmt, width, height,
- stride, height) < 0)
- return -1;
-
- pixman_region32_init(&write_region);
- pixman_region32_intersect_rect(&write_region, region,
- 0, 0, width, height);
-
-#ifdef HAVE_RESOURCE_WRITE_DATA_RECT
- /* XXX: Can this do a format conversion, so that scanout does not have to? */
- r = pixman_region32_rectangles(&write_region, &n);
- while (n--) {
- vc_dispmanx_rect_set(&rect, r[n].x1, r[n].y1,
- r[n].x2 - r[n].x1, r[n].y2 - r[n].y1);
-
- ret = vc_dispmanx_resource_write_data_rect(resource->handle,
- ifmt, stride,
- pixels, &rect,
- rect.x, rect.y);
- DBG("%s: %p %ux%u@%u,%u, ret %d\n", __func__, resource,
- rect.width, rect.height, rect.x, rect.y, ret);
- if (ret)
- break;
- }
-#else
- /* vc_dispmanx_resource_write_data() ignores ifmt,
- * rect.x, rect.width, and uses stride only for computing
- * the size of the transfer as rect.height * stride.
- * Therefore we can only write rows starting at x=0.
- * To be able to write more than one scanline at a time,
- * the resource must have been created with the same stride
- * as used here, and we must write full scanlines.
- */
-
- r = pixman_region32_extents(&write_region);
- vc_dispmanx_rect_set(&rect, 0, r->y1, width, r->y2 - r->y1);
- ret = vc_dispmanx_resource_write_data(resource->handle, ifmt,
- stride, pixels, &rect);
- DBG("%s: %p %ux%u@%u,%u, ret %d\n", __func__, resource,
- width, r->y2 - r->y1, 0, r->y1, ret);
-#endif
-
- pixman_region32_fini(&write_region);
-
- return ret ? -1 : 0;
-}
-
-static void
-rpi_element_handle_surface_destroy(struct wl_listener *listener, void *data)
-{
- struct rpi_element *element =
- container_of(listener, struct rpi_element,
- surface_destroy_listener);
-
- element->surface = NULL;
-}
-
-static struct rpi_element *
-rpi_element_create(struct rpi_output *output, struct weston_surface *surface)
-{
- struct rpi_element *element;
-
- element = calloc(1, sizeof *element);
- if (!element)
- return NULL;
-
- element->output = output;
- element->single_buffer = output->single_buffer;
- element->handle = DISPMANX_NO_HANDLE;
- rpi_resource_init(&element->resources[0]);
- rpi_resource_init(&element->resources[1]);
- element->front = &element->resources[0];
-
- if (element->single_buffer) {
- element->back = element->front;
- } else {
- element->back = &element->resources[1];
- }
-
- pixman_region32_init(&element->prev_damage);
-
- weston_plane_init(&element->plane, floor(surface->geometry.x),
- floor(surface->geometry.y));
-
- element->surface = surface;
- element->surface_destroy_listener.notify =
- rpi_element_handle_surface_destroy;
- wl_signal_add(&surface->resource.destroy_signal,
- &element->surface_destroy_listener);
-
- wl_list_insert(output->element_list.prev, &element->link);
-
- return element;
-}
-
-static void
-rpi_element_destroy(struct rpi_element *element)
-{
- struct weston_surface *surface = element->surface;
-
- if (surface) {
- if (surface->plane == &element->plane) {
- /* If a surface, that was on a plane, gets hidden,
- * it will not appear in the repaint surface list,
- * is never considered in rpi_output_assign_planes(),
- * and hence can stay assigned to this element's plane.
- * We need to reassign it here.
- */
- DBG("surface %p (%dx%d@%.1f,%.1f) to primary plane*\n",
- surface,
- surface->geometry.width, surface->geometry.height,
- surface->geometry.x, surface->geometry.y);
- weston_surface_move_to_plane(surface,
- &surface->compositor->primary_plane);
- }
- wl_list_remove(&element->surface_destroy_listener.link);
- }
-
- wl_list_remove(&element->link);
- weston_plane_release(&element->plane);
-
- if (element->handle != DISPMANX_NO_HANDLE)
- weston_log("ERROR rpi: destroying on-screen element\n");
-
- pixman_region32_fini(&element->prev_damage);
- rpi_resource_release(&element->resources[0]);
- rpi_resource_release(&element->resources[1]);
- DBG("element %p destroyed (%u)\n", element, element->handle);
-
- free(element);
-}
-
-static void
-rpi_element_reuse(struct rpi_element *element)
-{
- wl_list_remove(&element->link);
- wl_list_insert(element->output->element_list.prev, &element->link);
-}
-
-static void
-rpi_element_schedule_destroy(struct rpi_element *element)
-{
- wl_list_remove(&element->link);
- wl_list_insert(element->output->old_element_list.prev,
- &element->link);
-}
-
-static int
-rpi_element_damage(struct rpi_element *element, struct wl_buffer *buffer,
- pixman_region32_t *damage)
-{
- pixman_region32_t upload;
- int ret;
-
- if (!pixman_region32_not_empty(damage))
- return 0;
-
- DBG("element %p update resource %p\n", element, element->back);
-
- if (element->single_buffer) {
- ret = rpi_resource_update(element->back, buffer, damage);
- } else {
- pixman_region32_init(&upload);
- pixman_region32_union(&upload, &element->prev_damage, damage);
- ret = rpi_resource_update(element->back, buffer, &upload);
- pixman_region32_fini(&upload);
- }
-
- pixman_region32_copy(&element->prev_damage, damage);
- element->need_swap = 1;
-
- return ret;
-}
-
-static void
-rpi_element_compute_rects(struct rpi_element *element,
- VC_RECT_T *src_rect, VC_RECT_T *dst_rect)
-{
- struct weston_output *output = &element->output->base;
- int src_x, src_y;
- int dst_x, dst_y;
- int width, height;
-
- /* assume element->plane.{x,y} == element->surface->geometry.{x,y} */
- src_x = 0;
- src_y = 0;
- width = element->surface->geometry.width;
- height = element->surface->geometry.height;
-
- dst_x = element->plane.x - output->x;
- dst_y = element->plane.y - output->y;
-
- if (dst_x < 0) {
- width += dst_x;
- src_x -= dst_x;
- dst_x = 0;
- }
-
- if (dst_y < 0) {
- height += dst_y;
- src_y -= dst_y;
- dst_y = 0;
- }
-
- width = int_max(width, 0);
- height = int_max(height, 0);
-
- /* src_rect is in 16.16, dst_rect is in 32.0 unsigned fixed point */
- vc_dispmanx_rect_set(src_rect, src_x << 16, src_y << 16,
- width << 16, height << 16);
- vc_dispmanx_rect_set(dst_rect, dst_x, dst_y, width, height);
-}
-
-static void
-rpi_element_dmx_add(struct rpi_element *element,
- DISPMANX_UPDATE_HANDLE_T update, int layer)
-{
- VC_DISPMANX_ALPHA_T alphasetup = {
- DISPMANX_FLAGS_ALPHA_FROM_SOURCE | DISPMANX_FLAGS_ALPHA_PREMULT,
- 255, /* opacity 0-255 */
- 0 /* mask resource handle */
- };
- VC_RECT_T dst_rect;
- VC_RECT_T src_rect;
-
- rpi_element_compute_rects(element, &src_rect, &dst_rect);
-
- element->handle = vc_dispmanx_element_add(
- update,
- element->output->display,
- layer,
- &dst_rect,
- element->back->handle,
- &src_rect,
- DISPMANX_PROTECTION_NONE,
- &alphasetup,
- NULL /* clamp */,
- DISPMANX_NO_ROTATE);
- DBG("element %p add %u\n", element, element->handle);
-}
-
-static void
-rpi_element_dmx_swap(struct rpi_element *element,
- DISPMANX_UPDATE_HANDLE_T update)
-{
- VC_RECT_T rect;
- pixman_box32_t *r;
-
- /* XXX: skip, iff resource was not reallocated, and single-buffering */
- vc_dispmanx_element_change_source(update, element->handle,
- element->back->handle);
-
- /* This is current damage now, after rpi_assign_plane() */
- r = pixman_region32_extents(&element->prev_damage);
-
- vc_dispmanx_rect_set(&rect, r->x1, r->y1,
- r->x2 - r->x1, r->y2 - r->y1);
- vc_dispmanx_element_modified(update, element->handle, &rect);
- DBG("element %p swap\n", element);
-}
-
-static void
-rpi_element_dmx_move(struct rpi_element *element,
- DISPMANX_UPDATE_HANDLE_T update, int layer)
-{
- VC_RECT_T dst_rect;
- VC_RECT_T src_rect;
-
- /* XXX: return early, if all attributes stay the same */
-
- rpi_element_compute_rects(element, &src_rect, &dst_rect);
-
- vc_dispmanx_element_change_attributes(
- update,
- element->handle,
- ELEMENT_CHANGE_LAYER |
- ELEMENT_CHANGE_DEST_RECT |
- ELEMENT_CHANGE_SRC_RECT,
- layer,
- 255,
- &dst_rect,
- &src_rect,
- DISPMANX_NO_HANDLE,
- VC_IMAGE_ROT0);
- DBG("element %p move\n", element);
-}
-
-static int
-rpi_element_update(struct rpi_element *element,
- DISPMANX_UPDATE_HANDLE_T update, int layer)
-{
- struct rpi_resource *tmp;
-
- if (element->handle == DISPMANX_NO_HANDLE) {
- /* need_swap is already true, see rpi_assign_plane() */
-
- rpi_element_dmx_add(element, update, layer);
- if (element->handle == DISPMANX_NO_HANDLE)
- weston_log("ERROR rpi: element_add() failed.\n");
- } else {
- if (element->need_swap)
- rpi_element_dmx_swap(element, update);
- rpi_element_dmx_move(element, update, layer);
- }
- element->layer = layer;
-
- if (element->need_swap) {
- tmp = element->front;
- element->front = element->back;
- element->back = tmp;
- element->need_swap = 0;
- DBG("new back %p, new front %p\n",
- element->back, element->front);
- }
-
- return 0;
-}
-