diff options
Diffstat (limited to 'src/compositor-rpi.c')
-rw-r--r-- | src/compositor-rpi.c | 844 |
1 files changed, 844 insertions, 0 deletions
diff --git a/src/compositor-rpi.c b/src/compositor-rpi.c new file mode 100644 index 00000000..60926325 --- /dev/null +++ b/src/compositor-rpi.c @@ -0,0 +1,844 @@ +/* + * Copyright © 2008-2011 Kristian Høgsberg + * Copyright © 2011 Intel Corporation + * Copyright © 2012-2013 Raspberry Pi Foundation + * + * Permission to use, copy, modify, distribute, and sell this software and + * its documentation for any purpose is hereby granted without fee, provided + * that the above copyright notice appear in all copies and that both that + * copyright notice and this permission notice appear in supporting + * documentation, and that the name of the copyright holders not be used in + * advertising or publicity pertaining to distribution of the software + * without specific, written prior permission. The copyright holders make + * no representations about the suitability of this software for any + * purpose. It is provided "as is" without express or implied warranty. + * + * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS + * SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND + * FITNESS, IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY + * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER + * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF + * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN + * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. + */ + +#include "config.h" + +#include <errno.h> +#include <stdlib.h> +#include <stdio.h> +#include <string.h> +#include <math.h> +#include <sys/types.h> +#include <fcntl.h> +#include <unistd.h> + +#include <libudev.h> + +#ifdef HAVE_BCM_HOST +# include <bcm_host.h> +#else +# include "rpi-bcm-stubs.h" +#endif + +#include "compositor.h" +#include "rpi-renderer.h" +#include "evdev.h" +#include "launcher-util.h" + +#if 0 +#define DBG(...) \ + weston_log(__VA_ARGS__) +#else +#define DBG(...) do {} while (0) +#endif + +struct rpi_compositor; +struct rpi_output; + +struct rpi_flippipe { + int readfd; + int writefd; + struct wl_event_source *source; +}; + +struct rpi_output { + struct rpi_compositor *compositor; + struct weston_output base; + int single_buffer; + + struct weston_mode mode; + struct rpi_flippipe flippipe; + + DISPMANX_DISPLAY_HANDLE_T display; +}; + +struct rpi_seat { + struct weston_seat base; + struct wl_list devices_list; + + struct udev_monitor *udev_monitor; + struct wl_event_source *udev_monitor_source; + char *seat_id; +}; + +struct rpi_compositor { + struct weston_compositor base; + uint32_t prev_state; + + struct udev *udev; + struct wl_listener session_listener; + + int single_buffer; +}; + +static inline struct rpi_output * +to_rpi_output(struct weston_output *base) +{ + return container_of(base, struct rpi_output, base); +} + +static inline struct rpi_seat * +to_rpi_seat(struct weston_seat *base) +{ + return container_of(base, struct rpi_seat, base); +} + +static inline struct rpi_compositor * +to_rpi_compositor(struct weston_compositor *base) +{ + return container_of(base, struct rpi_compositor, base); +} + +static uint64_t +rpi_get_current_time(void) +{ + struct timeval tv; + + /* XXX: use CLOCK_MONOTONIC instead? */ + gettimeofday(&tv, NULL); + return (uint64_t)tv.tv_sec * 1000 + tv.tv_usec / 1000; +} + +static void +rpi_flippipe_update_complete(DISPMANX_UPDATE_HANDLE_T update, void *data) +{ + /* This function runs in a different thread. */ + struct rpi_flippipe *flippipe = data; + uint64_t time; + ssize_t ret; + + /* manufacture flip completion timestamp */ + time = rpi_get_current_time(); + + ret = write(flippipe->writefd, &time, sizeof time); + if (ret != sizeof time) + weston_log("ERROR: %s failed to write, ret %zd, errno %d\n", + __func__, ret, errno); +} + +static int +rpi_dispmanx_update_submit(DISPMANX_UPDATE_HANDLE_T update, + struct rpi_output *output) +{ + /* + * The callback registered here will eventually be called + * in a different thread context. Therefore we cannot call + * the usual functions from rpi_flippipe_update_complete(). + * Instead, we have a pipe for passing the message from the + * thread, waking up the Weston main event loop, calling + * rpi_flippipe_handler(), and then ending up in + * rpi_output_update_complete() in the main thread context, + * where we can do the frame finishing work. + */ + return vc_dispmanx_update_submit(update, rpi_flippipe_update_complete, + &output->flippipe); +} + +static void +rpi_output_update_complete(struct rpi_output *output, uint64_t time); + +static int +rpi_flippipe_handler(int fd, uint32_t mask, void *data) +{ + struct rpi_output *output = data; + ssize_t ret; + uint64_t time; + + if (mask != WL_EVENT_READABLE) + weston_log("ERROR: unexpected mask 0x%x in %s\n", + mask, __func__); + + ret = read(fd, &time, sizeof time); + if (ret != sizeof time) { + weston_log("ERROR: %s failed to read, ret %zd, errno %d\n", + __func__, ret, errno); + } + + rpi_output_update_complete(output, time); + + return 1; +} + +static int +rpi_flippipe_init(struct rpi_flippipe *flippipe, struct rpi_output *output) +{ + struct wl_event_loop *loop; + int fd[2]; + + if (pipe2(fd, O_CLOEXEC) == -1) + return -1; + + flippipe->readfd = fd[0]; + flippipe->writefd = fd[1]; + + loop = wl_display_get_event_loop(output->compositor->base.wl_display); + flippipe->source = wl_event_loop_add_fd(loop, flippipe->readfd, + WL_EVENT_READABLE, + rpi_flippipe_handler, output); + + if (!flippipe->source) { + close(flippipe->readfd); + close(flippipe->writefd); + return -1; + } + + return 0; +} + +static void +rpi_flippipe_release(struct rpi_flippipe *flippipe) +{ + wl_event_source_remove(flippipe->source); + close(flippipe->readfd); + close(flippipe->writefd); +} + +static void +rpi_output_start_repaint_loop(struct weston_output *output) +{ + uint64_t time; + + time = rpi_get_current_time(); + weston_output_finish_frame(output, time); +} + +static int +rpi_output_repaint(struct weston_output *base, pixman_region32_t *damage) +{ + struct rpi_output *output = to_rpi_output(base); + struct rpi_compositor *compositor = output->compositor; + struct weston_plane *primary_plane = &compositor->base.primary_plane; + DISPMANX_UPDATE_HANDLE_T update; + + DBG("frame update start\n"); + + /* Update priority higher than in rpi-renderer's + * output destroy function, see rpi_output_destroy(). + */ + update = vc_dispmanx_update_start(1); + + rpi_renderer_set_update_handle(&output->base, update); + compositor->base.renderer->repaint_output(&output->base, damage); + + pixman_region32_subtract(&primary_plane->damage, + &primary_plane->damage, damage); + + /* schedule callback to rpi_output_update_complete() */ + rpi_dispmanx_update_submit(update, output); + DBG("frame update submitted\n"); + return 0; +} + +static void +rpi_output_update_complete(struct rpi_output *output, uint64_t time) +{ + DBG("frame update complete(%" PRIu64 ")\n", time); + rpi_renderer_finish_frame(&output->base); + weston_output_finish_frame(&output->base, time); +} + +static void +rpi_output_destroy(struct weston_output *base) +{ + struct rpi_output *output = to_rpi_output(base); + + DBG("%s\n", __func__); + + rpi_renderer_output_destroy(base); + + /* rpi_renderer_output_destroy() will schedule a removal of + * all Dispmanx Elements, and wait for the update to complete. + * Assuming updates are sequential, the wait should guarantee, + * that any pending rpi_flippipe_update_complete() callbacks + * have happened already. Therefore we can destroy the flippipe + * now. + */ + rpi_flippipe_release(&output->flippipe); + + wl_list_remove(&output->base.link); + weston_output_destroy(&output->base); + + vc_dispmanx_display_close(output->display); + + free(output); +} + +static const char *transform_names[] = { + [WL_OUTPUT_TRANSFORM_NORMAL] = "normal", + [WL_OUTPUT_TRANSFORM_90] = "90", + [WL_OUTPUT_TRANSFORM_180] = "180", + [WL_OUTPUT_TRANSFORM_270] = "270", + [WL_OUTPUT_TRANSFORM_FLIPPED] = "flipped", + [WL_OUTPUT_TRANSFORM_FLIPPED_90] = "flipped-90", + [WL_OUTPUT_TRANSFORM_FLIPPED_180] = "flipped-180", + [WL_OUTPUT_TRANSFORM_FLIPPED_270] = "flipped-270", +}; + +static int +str2transform(const char *name) +{ + unsigned i; + + for (i = 0; i < ARRAY_LENGTH(transform_names); i++) + if (strcmp(name, transform_names[i]) == 0) + return i; + + return -1; +} + +static const char * +transform2str(uint32_t output_transform) +{ + if (output_transform >= ARRAY_LENGTH(transform_names)) + return "<illegal value>"; + + return transform_names[output_transform]; +} + +static int +rpi_output_create(struct rpi_compositor *compositor, uint32_t transform) +{ + struct rpi_output *output; + DISPMANX_MODEINFO_T modeinfo; + int ret; + float mm_width, mm_height; + + output = calloc(1, sizeof *output); + if (!output) + return -1; + + output->compositor = compositor; + output->single_buffer = compositor->single_buffer; + + if (rpi_flippipe_init(&output->flippipe, output) < 0) { + weston_log("Creating message pipe failed.\n"); + goto out_free; + } + + output->display = vc_dispmanx_display_open(DISPMANX_ID_HDMI); + if (!output->display) { + weston_log("Failed to open dispmanx HDMI display.\n"); + goto out_pipe; + } + + ret = vc_dispmanx_display_get_info(output->display, &modeinfo); + if (ret < 0) { + weston_log("Failed to get display mode information.\n"); + goto out_dmx_close; + } + + output->base.start_repaint_loop = rpi_output_start_repaint_loop; + output->base.repaint = rpi_output_repaint; + output->base.destroy = rpi_output_destroy; + output->base.assign_planes = NULL; + output->base.set_backlight = NULL; + output->base.set_dpms = NULL; + output->base.switch_mode = NULL; + + /* XXX: use tvservice to get information from and control the + * HDMI and SDTV outputs. See: + * /opt/vc/include/interface/vmcs_host/vc_tvservice.h + */ + + /* only one static mode in list */ + output->mode.flags = + WL_OUTPUT_MODE_CURRENT | WL_OUTPUT_MODE_PREFERRED; + output->mode.width = modeinfo.width; + output->mode.height = modeinfo.height; + output->mode.refresh = 60000; + wl_list_init(&output->base.mode_list); + wl_list_insert(&output->base.mode_list, &output->mode.link); + + output->base.current_mode = &output->mode; + output->base.subpixel = WL_OUTPUT_SUBPIXEL_UNKNOWN; + output->base.make = "unknown"; + output->base.model = "unknown"; + + /* guess 96 dpi */ + mm_width = modeinfo.width * (25.4f / 96.0f); + mm_height = modeinfo.height * (25.4f / 96.0f); + + weston_output_init(&output->base, &compositor->base, + 0, 0, round(mm_width), round(mm_height), + transform, 1); + + if (rpi_renderer_output_create(&output->base, output->display) < 0) + goto out_output; + + wl_list_insert(compositor->base.output_list.prev, &output->base.link); + + weston_log("Raspberry Pi HDMI output %dx%d px\n", + output->mode.width, output->mode.height); + weston_log_continue(STAMP_SPACE "guessing %d Hz and 96 dpi\n", + output->mode.refresh / 1000); + weston_log_continue(STAMP_SPACE "orientation: %s\n", + transform2str(output->base.transform)); + + if (!strncmp(transform2str(output->base.transform), "flipped", 7)) + weston_log("warning: flipped output transforms may not work\n"); + + return 0; + +out_output: + weston_output_destroy(&output->base); + +out_dmx_close: + vc_dispmanx_display_close(output->display); + +out_pipe: + rpi_flippipe_release(&output->flippipe); + +out_free: + free(output); + return -1; +} + +static void +rpi_led_update(struct weston_seat *seat_base, enum weston_led leds) +{ + struct rpi_seat *seat = to_rpi_seat(seat_base); + struct evdev_device *device; + + wl_list_for_each(device, &seat->devices_list, link) + evdev_led_update(device, leds); +} + +static const char default_seat[] = "seat0"; + +static void +device_added(struct udev_device *udev_device, struct rpi_seat *master) +{ + struct evdev_device *device; + const char *devnode; + const char *device_seat; + int fd; + + device_seat = udev_device_get_property_value(udev_device, "ID_SEAT"); + if (!device_seat) + device_seat = default_seat; + + if (strcmp(device_seat, master->seat_id)) + return; + + devnode = udev_device_get_devnode(udev_device); + + /* Use non-blocking mode so that we can loop on read on + * evdev_device_data() until all events on the fd are + * read. mtdev_get() also expects this. */ + fd = open(devnode, O_RDWR | O_NONBLOCK | O_CLOEXEC); + if (fd < 0) { + weston_log("opening input device '%s' failed.\n", devnode); + return; + } + + device = evdev_device_create(&master->base, devnode, fd); + if (!device) { + close(fd); + weston_log("not using input device '%s'.\n", devnode); + return; + } + + wl_list_insert(master->devices_list.prev, &device->link); +} + +static void +evdev_add_devices(struct udev *udev, struct weston_seat *seat_base) +{ + struct rpi_seat *seat = to_rpi_seat(seat_base); + struct udev_enumerate *e; + struct udev_list_entry *entry; + struct udev_device *device; + const char *path, *sysname; + + e = udev_enumerate_new(udev); + udev_enumerate_add_match_subsystem(e, "input"); + udev_enumerate_scan_devices(e); + udev_list_entry_foreach(entry, udev_enumerate_get_list_entry(e)) { + path = udev_list_entry_get_name(entry); + device = udev_device_new_from_syspath(udev, path); + + sysname = udev_device_get_sysname(device); + if (strncmp("event", sysname, 5) != 0) { + udev_device_unref(device); + continue; + } + + device_added(device, seat); + + udev_device_unref(device); + } + udev_enumerate_unref(e); + + evdev_notify_keyboard_focus(&seat->base, &seat->devices_list); + + if (wl_list_empty(&seat->devices_list)) { + weston_log( + "warning: no input devices on entering Weston. " + "Possible causes:\n" + "\t- no permissions to read /dev/input/event*\n" + "\t- seats misconfigured " + "(Weston backend option 'seat', " + "udev device property ID_SEAT)\n"); + } +} + +static int +evdev_udev_handler(int fd, uint32_t mask, void *data) +{ + struct rpi_seat *seat = data; + struct udev_device *udev_device; + struct evdev_device *device, *next; + const char *action; + const char *devnode; + + udev_device = udev_monitor_receive_device(seat->udev_monitor); + if (!udev_device) + return 1; + + action = udev_device_get_action(udev_device); + if (!action) + goto out; + + if (strncmp("event", udev_device_get_sysname(udev_device), 5) != 0) + goto out; + + if (!strcmp(action, "add")) { + device_added(udev_device, seat); + } + else if (!strcmp(action, "remove")) { + devnode = udev_device_get_devnode(udev_device); + wl_list_for_each_safe(device, next, &seat->devices_list, link) + if (!strcmp(device->devnode, devnode)) { + weston_log("input device %s, %s removed\n", + device->devname, device->devnode); + evdev_device_destroy(device); + break; + } + } + +out: + udev_device_unref(udev_device); + + return 0; +} + +static int +evdev_enable_udev_monitor(struct udev *udev, struct weston_seat *seat_base) +{ + struct rpi_seat *master = to_rpi_seat(seat_base); + struct wl_event_loop *loop; + struct weston_compositor *c = master->base.compositor; + int fd; + + master->udev_monitor = udev_monitor_new_from_netlink(udev, "udev"); + if (!master->udev_monitor) { + weston_log("udev: failed to create the udev monitor\n"); + return 0; + } + + udev_monitor_filter_add_match_subsystem_devtype(master->udev_monitor, + "input", NULL); + + if (udev_monitor_enable_receiving(master->udev_monitor)) { + weston_log("udev: failed to bind the udev monitor\n"); + udev_monitor_unref(master->udev_monitor); + return 0; + } + + loop = wl_display_get_event_loop(c->wl_display); + fd = udev_monitor_get_fd(master->udev_monitor); + master->udev_monitor_source = + wl_event_loop_add_fd(loop, fd, WL_EVENT_READABLE, + evdev_udev_handler, master); + if (!master->udev_monitor_source) { + udev_monitor_unref(master->udev_monitor); + return 0; + } + + return 1; +} + +static void +evdev_disable_udev_monitor(struct weston_seat *seat_base) +{ + struct rpi_seat *seat = to_rpi_seat(seat_base); + + if (!seat->udev_monitor) + return; + + udev_monitor_unref(seat->udev_monitor); + seat->udev_monitor = NULL; + wl_event_source_remove(seat->udev_monitor_source); + seat->udev_monitor_source = NULL; +} + +static void +evdev_input_create(struct weston_compositor *c, struct udev *udev, + const char *seat_id) +{ + struct rpi_seat *seat; + + seat = zalloc(sizeof *seat); + if (seat == NULL) + return; + + weston_seat_init(&seat->base, c, "default"); + seat->base.led_update = rpi_led_update; + + wl_list_init(&seat->devices_list); + seat->seat_id = strdup(seat_id); + if (!evdev_enable_udev_monitor(udev, &seat->base)) { + free(seat->seat_id); + free(seat); + return; + } + + evdev_add_devices(udev, &seat->base); +} + +static void +evdev_remove_devices(struct weston_seat *seat_base) +{ + struct rpi_seat *seat = to_rpi_seat(seat_base); + struct evdev_device *device, *next; + + wl_list_for_each_safe(device, next, &seat->devices_list, link) + evdev_device_destroy(device); + + if (seat->base.keyboard) + notify_keyboard_focus_out(&seat->base); +} + +static void +evdev_input_destroy(struct weston_seat *seat_base) +{ + struct rpi_seat *seat = to_rpi_seat(seat_base); + + evdev_remove_devices(seat_base); + evdev_disable_udev_monitor(&seat->base); + + weston_seat_release(seat_base); + free(seat->seat_id); + free(seat); +} + +static void +rpi_compositor_destroy(struct weston_compositor *base) +{ + struct rpi_compositor *compositor = to_rpi_compositor(base); + struct weston_seat *seat, *next; + + wl_list_for_each_safe(seat, next, &compositor->base.seat_list, link) + evdev_input_destroy(seat); + + /* destroys outputs, too */ + weston_compositor_shutdown(&compositor->base); + + compositor->base.renderer->destroy(&compositor->base); + weston_launcher_destroy(compositor->base.launcher); + + bcm_host_deinit(); + free(compositor); +} + +static void +session_notify(struct wl_listener *listener, void *data) +{ + struct rpi_compositor *compositor = data; + struct weston_seat *seat; + struct weston_output *output; + + if (compositor->base.session_active) { + weston_log("activating session\n"); + compositor->base.focus = 1; + compositor->base.state = compositor->prev_state; + weston_compositor_damage_all(&compositor->base); + wl_list_for_each(seat, &compositor->base.seat_list, link) { + evdev_add_devices(compositor->udev, seat); + evdev_enable_udev_monitor(compositor->udev, seat); + } + } else { + weston_log("deactivating session\n"); + wl_list_for_each(seat, &compositor->base.seat_list, link) { + evdev_disable_udev_monitor(seat); + evdev_remove_devices(seat); + } + + compositor->base.focus = 0; + compositor->prev_state = compositor->base.state; + weston_compositor_offscreen(&compositor->base); + + /* If we have a repaint scheduled (either from a + * pending pageflip or the idle handler), make sure we + * cancel that so we don't try to pageflip when we're + * vt switched away. The OFFSCREEN state will prevent + * further attemps at repainting. When we switch + * back, we schedule a repaint, which will process + * pending frame callbacks. */ + + wl_list_for_each(output, + &compositor->base.output_list, link) { + output->repaint_needed = 0; + } + }; +} + +static void +rpi_restore(struct weston_compositor *compositor) +{ + weston_launcher_restore(compositor->launcher); +} + +static void +switch_vt_binding(struct weston_seat *seat, uint32_t time, uint32_t key, void *data) +{ + struct weston_compositor *compositor = data; + + weston_launcher_activate_vt(compositor->launcher, key - KEY_F1 + 1); +} + +struct rpi_parameters { + int tty; + struct rpi_renderer_parameters renderer; + uint32_t output_transform; +}; + +static struct weston_compositor * +rpi_compositor_create(struct wl_display *display, int *argc, char *argv[], + struct weston_config *config, + struct rpi_parameters *param) +{ + struct rpi_compositor *compositor; + const char *seat = default_seat; + uint32_t key; + + weston_log("initializing Raspberry Pi backend\n"); + + compositor = calloc(1, sizeof *compositor); + if (compositor == NULL) + return NULL; + + if (weston_compositor_init(&compositor->base, display, argc, argv, + config) < 0) + goto out_free; + + compositor->udev = udev_new(); + if (compositor->udev == NULL) { + weston_log("Failed to initialize udev context.\n"); + goto out_compositor; + } + + compositor->session_listener.notify = session_notify; + wl_signal_add(&compositor->base.session_signal, + &compositor ->session_listener); + compositor->base.launcher = + weston_launcher_connect(&compositor->base, param->tty); + if (!compositor->base.launcher) { + weston_log("Failed to initialize tty.\n"); + goto out_udev; + } + + compositor->base.destroy = rpi_compositor_destroy; + compositor->base.restore = rpi_restore; + + compositor->base.focus = 1; + compositor->prev_state = WESTON_COMPOSITOR_ACTIVE; + compositor->single_buffer = param->renderer.single_buffer; + + weston_log("Dispmanx planes are %s buffered.\n", + compositor->single_buffer ? "single" : "double"); + + for (key = KEY_F1; key < KEY_F9; key++) + weston_compositor_add_key_binding(&compositor->base, key, + MODIFIER_CTRL | MODIFIER_ALT, + switch_vt_binding, compositor); + + /* + * bcm_host_init() creates threads. + * Therefore we must have all signal handlers set and signals blocked + * before calling it. Otherwise the signals may end in the bcm + * threads and cause the default behaviour there. For instance, + * SIGUSR1 used for VT switching caused Weston to terminate there. + */ + bcm_host_init(); + + if (rpi_renderer_create(&compositor->base, ¶m->renderer) < 0) + goto out_launcher; + + if (rpi_output_create(compositor, param->output_transform) < 0) + goto out_renderer; + + evdev_input_create(&compositor->base, compositor->udev, seat); + + return &compositor->base; + +out_renderer: + compositor->base.renderer->destroy(&compositor->base); + +out_launcher: + weston_launcher_destroy(compositor->base.launcher); + +out_udev: + udev_unref(compositor->udev); + +out_compositor: + weston_compositor_shutdown(&compositor->base); + +out_free: + bcm_host_deinit(); + free(compositor); + + return NULL; +} + +WL_EXPORT struct weston_compositor * +backend_init(struct wl_display *display, int *argc, char *argv[], + struct weston_config *config) +{ + const char *transform = "normal"; + int ret; + + struct rpi_parameters param = { + .tty = 0, /* default to current tty */ + .renderer.single_buffer = 0, + .output_transform = WL_OUTPUT_TRANSFORM_NORMAL, + }; + + const struct weston_option rpi_options[] = { + { WESTON_OPTION_INTEGER, "tty", 0, ¶m.tty }, + { WESTON_OPTION_BOOLEAN, "single-buffer", 0, + ¶m.renderer.single_buffer }, + { WESTON_OPTION_STRING, "transform", 0, &transform }, + }; + + parse_options(rpi_options, ARRAY_LENGTH(rpi_options), argc, argv); + + ret = str2transform(transform); + if (ret < 0) + weston_log("invalid transform \"%s\"\n", transform); + else + param.output_transform = ret; + + return rpi_compositor_create(display, argc, argv, config, ¶m); +} |