sortix-mirror/display/server.c

/*
 * Copyright (c) 2014, 2015, 2016, 2023 Jonas 'Sortie' Termansen.
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, 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.
 *
 * server.c
 * Display server main loop.
 */

#include <sys/ioctl.h>
#include <sys/socket.h>
#include <sys/termmode.h>
#include <sys/un.h>
#include <sys/wait.h>

#include <assert.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <poll.h>
#include <stddef.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include <display-protocol.h>

#include "connection.h"
#include "display.h"
#include "server.h"
#include "vgafont.h"

static int open_local_server_socket(const char* path, int flags)
{
	size_t path_length = strlen(path);
	size_t addr_size = offsetof(struct sockaddr_un, sun_path) + path_length + 1;
	struct sockaddr_un* sockaddr = malloc(addr_size);
	if ( !sockaddr )
		return -1;
	sockaddr->sun_family = AF_LOCAL;
	strcpy(sockaddr->sun_path, path);
	int fd = socket(AF_LOCAL, SOCK_STREAM | flags, 0);
	if ( fd < 0 )
		return free(sockaddr), -1;
	if ( bind(fd, (const struct sockaddr*) sockaddr, addr_size) < 0 )
		return close(fd), free(sockaddr), -1;
	if ( listen(fd, SOMAXCONN) < 0 )
		return close(fd), free(sockaddr), -1;
	free(sockaddr);
	return fd;
}

void server_initialize(struct server* server, struct display* display,
                       const char* tty, const char* mouse, const char* socket)
{
	memset(server, 0, sizeof(*server));

	server->display = display;

	load_font();

	server->tty_fd = 0;
	if ( tty || !isatty(server->tty_fd) )
	{
		tty = tty ? tty : "/dev/tty";
		server->tty_fd = open(tty, O_RDONLY);
		if ( server->tty_fd < 0 )
			err(1, tty);
	}

	// TODO: Support for multiple displays.
	struct tiocgdisplays gdisplays = {0};
	gdisplays.count = 1;
	gdisplays.displays = &display->display;
	if ( ioctl(server->tty_fd, TIOCGDISPLAYS, &gdisplays) < 0 ||
	     gdisplays.count == 0 )
		errx(1, "%s: No video devices are associated with this terminal", tty);

	server->mouse_fd = open(mouse, O_RDONLY | O_CLOEXEC);
	if ( server->mouse_fd < 0 )
		err(1, "%s", mouse);

	server->server_path = socket;
	server->server_fd = open_local_server_socket(server->server_path,
	                                             SOCK_NONBLOCK | SOCK_CLOEXEC);
	if ( server->server_fd < 0 )
		err(1, "open_local_server_socket: %s", server->server_path);

	unsigned int termmode =
		TERMMODE_KBKEY | TERMMODE_UNICODE | TERMMODE_NONBLOCK;
	if ( settermmode(server->tty_fd, termmode) < 0 )
		err(1, "settermmode");

	server->pfds_count = server_pfds_count(server);
	server->pfds =
		reallocarray(NULL, sizeof(struct pollfd), server->pfds_count);
	if ( !server->pfds )
		err(1, "malloc");
}

bool server_accept(struct server* server)
{
	int client_fd = accept4(server->server_fd, NULL, NULL, SOCK_NONBLOCK);
	if ( client_fd < 0 )
	{
		warn("accept: %s", server->server_path);
		return false;
	}

	if ( server->connections_used == server->connections_length )
	{
		size_t new_length = server->connections_length * 2;
		if ( !new_length )
			new_length = 16;
		struct connection** new_connections =
			reallocarray(server->connections, new_length,
			             sizeof(struct connection*));
		if ( !new_connections )
		{
			warn("dropped connection: %s: malloc", server->server_path);
			close(client_fd);
			return false;
		}
		server->connections = new_connections;
		server->connections_length = new_length;
	}

	size_t new_pfds_count = server_pfds_count(server) + 1;
	struct pollfd* new_pfds =
		reallocarray(server->pfds, sizeof(struct pollfd), new_pfds_count);
	if ( !new_pfds )
	{
		warn("dropped connection: %s: malloc", server->server_path);
		close(client_fd);
		return false;
	}
	server->pfds = new_pfds;
	server->pfds_count = new_pfds_count;

	struct connection* connection = malloc(sizeof(struct connection));
	if ( !connection )
	{
		warn("dropped connection: %s: malloc", server->server_path);
		close(client_fd);
		return false;
	}
	server->connections[server->connections_used++] = connection;
	connection_initialize(connection, server->display, client_fd);

	return true;
}

size_t server_pfds_count(const struct server* server)
{
	return 3 + server->connections_used;
}

void server_poll(struct server* server)
{
	int code;
	while ( 0 < waitpid(-1, &code, WNOHANG) )
	{
	}

	struct pollfd* pfds = server->pfds;

	pfds[0].fd = server->server_fd;
	pfds[0].events = POLLIN;
	pfds[0].revents = 0;
	pfds[1].fd = server->tty_fd;
	pfds[1].events = POLLIN;
	pfds[1].revents = 0;
	pfds[2].fd = server->mouse_fd;
	pfds[2].events = POLLIN;
	pfds[2].revents = 0;
	size_t cpfd_off = 3;

	size_t connections_polled = server->connections_used;
	for ( size_t i = 0; i < connections_polled; i++ )
	{
		struct pollfd* pfd = &pfds[cpfd_off + i];
		struct connection* connection = server->connections[i];
		pfd->fd = connection->fd;
		pfd->events = connection_interested_poll_events(connection);
		pfd->revents = 0;
	}
	size_t pfds_used = cpfd_off + connections_polled;

	int num_events = ppoll(pfds, pfds_used, NULL, NULL);
	if ( num_events < 0 )
		err(1, "poll");

	if ( pfds[0].revents )
	{
		// TODO: Handle if this can actually happen.
		assert(!(pfds[0].revents & POLLERR));
		assert(!(pfds[0].revents & POLLHUP));
		assert(!(pfds[0].revents & POLLNVAL));

		server_accept(server);
	}

	if ( pfds[1].revents )
	{
		// TODO: Handle if this can actually happen.
		assert(!(pfds[1].revents & POLLERR));
		assert(!(pfds[1].revents & POLLHUP));
		assert(!(pfds[1].revents & POLLNVAL));

		uint32_t codepoint;
		ssize_t size = sizeof(codepoint);
		while ( read(server->tty_fd, &codepoint, size) == size )
			display_keyboard_event(server->display, codepoint);
	}

	if ( pfds[2].revents )
	{
		// TODO: Handle if this can actually happen.
		assert(!(pfds[2].revents & POLLERR));
		assert(!(pfds[2].revents & POLLHUP));
		assert(!(pfds[2].revents & POLLNVAL));

		unsigned char events[64];
		ssize_t amount = read(server->mouse_fd, events, sizeof(events));
		for ( ssize_t i = 0; i < amount; i++ )
			display_mouse_event(server->display, events[i]);
	}

	bool any_disconnect = false;
	for ( size_t i = 0; i < connections_polled; i++ )
	{
		struct pollfd* pfd = &pfds[cpfd_off + i];
		if ( !pfd->revents )
			continue;
		struct connection* connection = server->connections[i];
		if ( pfd->revents & (POLLERR | POLLHUP | POLLNVAL) &&
		     !(pfd->revents & POLLIN) )
		{
			connection_destroy(connection);
			free(connection);
			server->connections[i] = NULL;
			any_disconnect = true;
			continue;
		}
		if ( pfd->revents & POLLOUT )
			connection_can_write(connection);
		if ( pfd->revents & POLLIN )
			connection_can_read(connection, server);
	}

	// Compact the array down here so the pfds match the connections above.
	if ( any_disconnect )
	{
		size_t new_used = 0;
		for ( size_t i = 0; i < server->connections_used; i++ )
		{
			if ( server->connections[i] )
				server->connections[new_used++] = server->connections[i];
		}
		server->connections_used = new_used;
	}
}

void server_mainloop(struct server* server)
{
	while ( true )
	{
		display_render(server->display);
		server_poll(server);
	}
}