ofono/tools/tty-redirector.c

/*
 *
 *  oFono - Open Source Telephony
 *
 *  Copyright (C) 2011-2012  Intel Corporation. All rights reserved.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */

#ifdef HAVE_CONFIG_H
#include <config.h>
#endif

#define _GNU_SOURCE
#include <stdio.h>
#include <fcntl.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <stdbool.h>
#include <termios.h>
#include <signal.h>
#include <sys/signalfd.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>

#include <glib.h>

#define IFX_RESET_PATH "/sys/module/hsi_ffl_tty/parameters/reset_modem"

static gchar *option_device = NULL;
static gboolean option_ifx = FALSE;

static GMainLoop *main_loop;
static bool main_terminated;

static int device_fd = -1;
static int client_fd = -1;

static guint device_watch = 0;
static guint client_watch = 0;

static gboolean shutdown_timeout(gpointer user_data)
{
	g_main_loop_quit(main_loop);

	return FALSE;
}

static void do_terminate(void)
{
	if (main_terminated)
		return;

	main_terminated = true;

	g_timeout_add_seconds(1, shutdown_timeout, NULL);
}

static gboolean signal_handler(GIOChannel *channel, GIOCondition cond,
							gpointer user_data)
{
	struct signalfd_siginfo si;
	ssize_t result;
	int fd;

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP))
		return FALSE;

	fd = g_io_channel_unix_get_fd(channel);

	result = read(fd, &si, sizeof(si));
	if (result != sizeof(si))
		return FALSE;

	switch (si.ssi_signo) {
	case SIGINT:
	case SIGTERM:
		do_terminate();
		break;
	}

	return TRUE;
}

static guint create_watch(int fd, GIOFunc func)
{
	GIOChannel *channel;
	guint source;

	channel = g_io_channel_unix_new(fd);

	g_io_channel_set_close_on_unref(channel, TRUE);
	g_io_channel_set_encoding(channel, NULL, NULL);
	g_io_channel_set_buffered(channel, FALSE);

	source = g_io_add_watch(channel,
			G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL, func, NULL);

	g_io_channel_unref(channel);

	return source;
}

static guint setup_signalfd(void)
{
	sigset_t mask;
	int fd;

	sigemptyset(&mask);
	sigaddset(&mask, SIGINT);
	sigaddset(&mask, SIGTERM);

	if (sigprocmask(SIG_BLOCK, &mask, NULL) < 0) {
		perror("Failed to set signal mask");
		return 0;
	}

	fd = signalfd(-1, &mask, 0);
	if (fd < 0) {
		perror("Failed to create signal descriptor");
		return 0;
	}

	return create_watch(fd, signal_handler);
}

static int write_file(const char *path, const char *value)
{
	ssize_t written;
	int fd;

	fd = open(path, O_RDWR | O_NOCTTY | O_CLOEXEC);
	if (fd < 0) {
		perror("Failed to open file");
		return -1;
	}

	written = write(fd, value, strlen(value));
	if (written < 0) {
		perror("Failed to write value");
		return -1;
	}

	return 0;
}

static int open_device(const char *path)
{
	struct termios ti;
	int fd;

	/* Switch TTY to raw mode */
	memset(&ti, 0, sizeof(ti));
	cfmakeraw(&ti);

	fd = open(path, O_RDWR | O_NOCTTY | O_CLOEXEC);
	if (fd < 0) {
		perror("Failed to open device");
		return -1;
	}

	tcflush(fd, TCIOFLUSH);
	tcsetattr(fd, TCSANOW, &ti);

	return fd;
}

static gboolean forward_data(GIOCondition cond, int input_fd, int output_fd)
{
	unsigned char buf[1024];
	ssize_t bytes_read, bytes_written;

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP))
		return FALSE;

	bytes_read = read(input_fd, buf, sizeof(buf));
	if (bytes_read < 0)
		return FALSE;

	bytes_written = write(output_fd, buf, bytes_read);
	if (bytes_written != bytes_read)
		return FALSE;

	return TRUE;
}

static gboolean device_handler(GIOChannel *channel, GIOCondition cond,
							gpointer user_data)
{
	if (forward_data(cond, device_fd, client_fd) == FALSE) {
		g_printerr("Closing device descriptor\n");
		if (client_watch > 0) {
			g_source_remove(client_watch);
			client_watch = 0;
		}

		device_watch = 0;
		return FALSE;
	}

	return TRUE;
}

static gboolean client_handler(GIOChannel *channel, GIOCondition cond,
							gpointer user_data)
{
	if (forward_data(cond, client_fd, device_fd) == FALSE) {
		g_printerr("Closing client connection\n");
		if (device_watch > 0) {
			g_source_remove(device_watch);
			device_watch = 0;
		}

		client_watch = 0;
		return FALSE;
	}

	return TRUE;
}

static gboolean accept_handler(GIOChannel *channel, GIOCondition cond,
							gpointer user_data)
{
	struct sockaddr_in addr;
	socklen_t addrlen;
	int fd, nfd;

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP))
		return FALSE;

	fd = g_io_channel_unix_get_fd(channel);

	memset(&addr, 0, sizeof(addr));
	addrlen = sizeof(addr);

	nfd = accept4(fd, (struct sockaddr *) &addr, &addrlen, SOCK_CLOEXEC);
	if (nfd < 0)
		return TRUE;

	if (device_watch > 0) {
		g_printerr("Closing previous descriptors\n");
		g_source_remove(device_watch);
		device_watch = 0;

		if (client_watch > 0) {
			g_source_remove(client_watch);
			client_watch = 0;
		}
	}

	if (option_ifx == TRUE) {
		write_file(IFX_RESET_PATH, "1");
		sleep(1);
		write_file(IFX_RESET_PATH, "0");
		sleep(1);
	}

	device_fd = open_device(option_device);
	if (device_fd < 0) {
		close(nfd);
		return TRUE;
	}

	device_watch = create_watch(device_fd, device_handler);
	if (device_watch == 0) {
		close(nfd);
		return TRUE;
	}

	client_watch = create_watch(nfd, client_handler);
	if (client_watch == 0) {
		g_source_remove(device_watch);
		device_watch = 0;
		close(nfd);
		return TRUE;
	}

	client_fd = nfd;

	return TRUE;
}

static guint setup_server(void)
{
	struct sockaddr_in addr;
	int fd, opt = 1;

	fd = socket(PF_INET, SOCK_STREAM | SOCK_CLOEXEC, 0);
	if (fd < 0) {
		perror("Failed to open server socket");
		return 0;
	}

	setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &opt, sizeof(opt));

	memset(&addr, 0, sizeof(addr));
	addr.sin_family = AF_INET;
	addr.sin_addr.s_addr = INADDR_ANY;
	addr.sin_port = htons(12345);

	if (bind(fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
		perror("Failed to bind server socket");
		close(fd);
		return 0;
	}

	if (listen(fd, 1) < 0) {
		perror("Failed to listen server socket");
		close(fd);
		return 0;
	}

	return create_watch(fd, accept_handler);
}

static GOptionEntry options[] = {
	{ "device", 0, 0, G_OPTION_ARG_STRING, &option_device,
				"Specify device to use", "DEVNODE" },
	{ "ifx", 0, 0, G_OPTION_ARG_NONE, &option_ifx,
				"Use Infineon reset handling" },
	{ NULL },
};

int main(int argc, char **argv)
{
	GOptionContext *context;
	GError *error = NULL;
	guint signal_watch;
	guint server_watch;

	context = g_option_context_new(NULL);
	g_option_context_add_main_entries(context, options, NULL);

	if (g_option_context_parse(context, &argc, &argv, &error) == FALSE) {
		if (error != NULL) {
			g_printerr("%s\n", error->message);
			g_error_free(error);
		} else
			g_printerr("An unknown error occurred\n");
		return EXIT_FAILURE;
	}

	g_option_context_free(context);

	if (option_device == NULL) {
		if (option_ifx == TRUE) {
			option_device = g_strdup("/dev/ttyIFX0");
		} else {
			g_printerr("No valid device specified\n");
			return EXIT_FAILURE;
		}
	}

	main_loop = g_main_loop_new(NULL, FALSE);
	signal_watch = setup_signalfd();
	server_watch = setup_server();

	g_main_loop_run(main_loop);

	g_source_remove(server_watch);
	g_source_remove(signal_watch);
	g_main_loop_unref(main_loop);

	g_free(option_device);

	return EXIT_SUCCESS;
}