18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) 2001 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <stdio.h>
78c2ecf20Sopenharmony_ci#include <unistd.h>
88c2ecf20Sopenharmony_ci#include <stdarg.h>
98c2ecf20Sopenharmony_ci#include <errno.h>
108c2ecf20Sopenharmony_ci#include <stddef.h>
118c2ecf20Sopenharmony_ci#include <string.h>
128c2ecf20Sopenharmony_ci#include <sys/socket.h>
138c2ecf20Sopenharmony_ci#include <sys/wait.h>
148c2ecf20Sopenharmony_ci#include <net_user.h>
158c2ecf20Sopenharmony_ci#include <os.h>
168c2ecf20Sopenharmony_ci#include <um_malloc.h>
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ciint tap_open_common(void *dev, char *gate_addr)
198c2ecf20Sopenharmony_ci{
208c2ecf20Sopenharmony_ci	int tap_addr[4];
218c2ecf20Sopenharmony_ci
228c2ecf20Sopenharmony_ci	if (gate_addr == NULL)
238c2ecf20Sopenharmony_ci		return 0;
248c2ecf20Sopenharmony_ci	if (sscanf(gate_addr, "%d.%d.%d.%d", &tap_addr[0],
258c2ecf20Sopenharmony_ci		  &tap_addr[1], &tap_addr[2], &tap_addr[3]) != 4) {
268c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "Invalid tap IP address - '%s'\n",
278c2ecf20Sopenharmony_ci		       gate_addr);
288c2ecf20Sopenharmony_ci		return -EINVAL;
298c2ecf20Sopenharmony_ci	}
308c2ecf20Sopenharmony_ci	return 0;
318c2ecf20Sopenharmony_ci}
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_civoid tap_check_ips(char *gate_addr, unsigned char *eth_addr)
348c2ecf20Sopenharmony_ci{
358c2ecf20Sopenharmony_ci	int tap_addr[4];
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_ci	if ((gate_addr != NULL) &&
388c2ecf20Sopenharmony_ci	    (sscanf(gate_addr, "%d.%d.%d.%d", &tap_addr[0],
398c2ecf20Sopenharmony_ci		    &tap_addr[1], &tap_addr[2], &tap_addr[3]) == 4) &&
408c2ecf20Sopenharmony_ci	    (eth_addr[0] == tap_addr[0]) &&
418c2ecf20Sopenharmony_ci	    (eth_addr[1] == tap_addr[1]) &&
428c2ecf20Sopenharmony_ci	    (eth_addr[2] == tap_addr[2]) &&
438c2ecf20Sopenharmony_ci	    (eth_addr[3] == tap_addr[3])) {
448c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "The tap IP address and the UML eth IP "
458c2ecf20Sopenharmony_ci		       "address must be different\n");
468c2ecf20Sopenharmony_ci	}
478c2ecf20Sopenharmony_ci}
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci/* Do reliable error handling as this fails frequently enough. */
508c2ecf20Sopenharmony_civoid read_output(int fd, char *output, int len)
518c2ecf20Sopenharmony_ci{
528c2ecf20Sopenharmony_ci	int remain, ret, expected;
538c2ecf20Sopenharmony_ci	char c;
548c2ecf20Sopenharmony_ci	char *str;
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_ci	if (output == NULL) {
578c2ecf20Sopenharmony_ci		output = &c;
588c2ecf20Sopenharmony_ci		len = sizeof(c);
598c2ecf20Sopenharmony_ci	}
608c2ecf20Sopenharmony_ci
618c2ecf20Sopenharmony_ci	*output = '\0';
628c2ecf20Sopenharmony_ci	ret = read(fd, &remain, sizeof(remain));
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci	if (ret != sizeof(remain)) {
658c2ecf20Sopenharmony_ci		if (ret < 0)
668c2ecf20Sopenharmony_ci			ret = -errno;
678c2ecf20Sopenharmony_ci		expected = sizeof(remain);
688c2ecf20Sopenharmony_ci		str = "length";
698c2ecf20Sopenharmony_ci		goto err;
708c2ecf20Sopenharmony_ci	}
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci	while (remain != 0) {
738c2ecf20Sopenharmony_ci		expected = (remain < len) ? remain : len;
748c2ecf20Sopenharmony_ci		ret = read(fd, output, expected);
758c2ecf20Sopenharmony_ci		if (ret != expected) {
768c2ecf20Sopenharmony_ci			if (ret < 0)
778c2ecf20Sopenharmony_ci				ret = -errno;
788c2ecf20Sopenharmony_ci			str = "data";
798c2ecf20Sopenharmony_ci			goto err;
808c2ecf20Sopenharmony_ci		}
818c2ecf20Sopenharmony_ci		remain -= ret;
828c2ecf20Sopenharmony_ci	}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	return;
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_cierr:
878c2ecf20Sopenharmony_ci	if (ret < 0)
888c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "read_output - read of %s failed, "
898c2ecf20Sopenharmony_ci		       "errno = %d\n", str, -ret);
908c2ecf20Sopenharmony_ci	else
918c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "read_output - read of %s failed, read only "
928c2ecf20Sopenharmony_ci		       "%d of %d bytes\n", str, ret, expected);
938c2ecf20Sopenharmony_ci}
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ciint net_read(int fd, void *buf, int len)
968c2ecf20Sopenharmony_ci{
978c2ecf20Sopenharmony_ci	int n;
988c2ecf20Sopenharmony_ci
998c2ecf20Sopenharmony_ci	n = read(fd,  buf,  len);
1008c2ecf20Sopenharmony_ci
1018c2ecf20Sopenharmony_ci	if ((n < 0) && (errno == EAGAIN))
1028c2ecf20Sopenharmony_ci		return 0;
1038c2ecf20Sopenharmony_ci	else if (n == 0)
1048c2ecf20Sopenharmony_ci		return -ENOTCONN;
1058c2ecf20Sopenharmony_ci	return n;
1068c2ecf20Sopenharmony_ci}
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_ciint net_recvfrom(int fd, void *buf, int len)
1098c2ecf20Sopenharmony_ci{
1108c2ecf20Sopenharmony_ci	int n;
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci	CATCH_EINTR(n = recvfrom(fd,  buf,  len, 0, NULL, NULL));
1138c2ecf20Sopenharmony_ci	if (n < 0) {
1148c2ecf20Sopenharmony_ci		if (errno == EAGAIN)
1158c2ecf20Sopenharmony_ci			return 0;
1168c2ecf20Sopenharmony_ci		return -errno;
1178c2ecf20Sopenharmony_ci	}
1188c2ecf20Sopenharmony_ci	else if (n == 0)
1198c2ecf20Sopenharmony_ci		return -ENOTCONN;
1208c2ecf20Sopenharmony_ci	return n;
1218c2ecf20Sopenharmony_ci}
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ciint net_write(int fd, void *buf, int len)
1248c2ecf20Sopenharmony_ci{
1258c2ecf20Sopenharmony_ci	int n;
1268c2ecf20Sopenharmony_ci
1278c2ecf20Sopenharmony_ci	n = write(fd, buf, len);
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_ci	if ((n < 0) && (errno == EAGAIN))
1308c2ecf20Sopenharmony_ci		return 0;
1318c2ecf20Sopenharmony_ci	else if (n == 0)
1328c2ecf20Sopenharmony_ci		return -ENOTCONN;
1338c2ecf20Sopenharmony_ci	return n;
1348c2ecf20Sopenharmony_ci}
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ciint net_send(int fd, void *buf, int len)
1378c2ecf20Sopenharmony_ci{
1388c2ecf20Sopenharmony_ci	int n;
1398c2ecf20Sopenharmony_ci
1408c2ecf20Sopenharmony_ci	CATCH_EINTR(n = send(fd, buf, len, 0));
1418c2ecf20Sopenharmony_ci	if (n < 0) {
1428c2ecf20Sopenharmony_ci		if (errno == EAGAIN)
1438c2ecf20Sopenharmony_ci			return 0;
1448c2ecf20Sopenharmony_ci		return -errno;
1458c2ecf20Sopenharmony_ci	}
1468c2ecf20Sopenharmony_ci	else if (n == 0)
1478c2ecf20Sopenharmony_ci		return -ENOTCONN;
1488c2ecf20Sopenharmony_ci	return n;
1498c2ecf20Sopenharmony_ci}
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_ciint net_sendto(int fd, void *buf, int len, void *to, int sock_len)
1528c2ecf20Sopenharmony_ci{
1538c2ecf20Sopenharmony_ci	int n;
1548c2ecf20Sopenharmony_ci
1558c2ecf20Sopenharmony_ci	CATCH_EINTR(n = sendto(fd, buf, len, 0, (struct sockaddr *) to,
1568c2ecf20Sopenharmony_ci			       sock_len));
1578c2ecf20Sopenharmony_ci	if (n < 0) {
1588c2ecf20Sopenharmony_ci		if (errno == EAGAIN)
1598c2ecf20Sopenharmony_ci			return 0;
1608c2ecf20Sopenharmony_ci		return -errno;
1618c2ecf20Sopenharmony_ci	}
1628c2ecf20Sopenharmony_ci	else if (n == 0)
1638c2ecf20Sopenharmony_ci		return -ENOTCONN;
1648c2ecf20Sopenharmony_ci	return n;
1658c2ecf20Sopenharmony_ci}
1668c2ecf20Sopenharmony_ci
1678c2ecf20Sopenharmony_cistruct change_pre_exec_data {
1688c2ecf20Sopenharmony_ci	int close_me;
1698c2ecf20Sopenharmony_ci	int stdout_fd;
1708c2ecf20Sopenharmony_ci};
1718c2ecf20Sopenharmony_ci
1728c2ecf20Sopenharmony_cistatic void change_pre_exec(void *arg)
1738c2ecf20Sopenharmony_ci{
1748c2ecf20Sopenharmony_ci	struct change_pre_exec_data *data = arg;
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	close(data->close_me);
1778c2ecf20Sopenharmony_ci	dup2(data->stdout_fd, 1);
1788c2ecf20Sopenharmony_ci}
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_cistatic int change_tramp(char **argv, char *output, int output_len)
1818c2ecf20Sopenharmony_ci{
1828c2ecf20Sopenharmony_ci	int pid, fds[2], err;
1838c2ecf20Sopenharmony_ci	struct change_pre_exec_data pe_data;
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_ci	err = os_pipe(fds, 1, 0);
1868c2ecf20Sopenharmony_ci	if (err < 0) {
1878c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "change_tramp - pipe failed, err = %d\n",
1888c2ecf20Sopenharmony_ci		       -err);
1898c2ecf20Sopenharmony_ci		return err;
1908c2ecf20Sopenharmony_ci	}
1918c2ecf20Sopenharmony_ci	pe_data.close_me = fds[0];
1928c2ecf20Sopenharmony_ci	pe_data.stdout_fd = fds[1];
1938c2ecf20Sopenharmony_ci	pid = run_helper(change_pre_exec, &pe_data, argv);
1948c2ecf20Sopenharmony_ci
1958c2ecf20Sopenharmony_ci	if (pid > 0)	/* Avoid hang as we won't get data in failure case. */
1968c2ecf20Sopenharmony_ci		read_output(fds[0], output, output_len);
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_ci	close(fds[0]);
1998c2ecf20Sopenharmony_ci	close(fds[1]);
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_ci	if (pid > 0)
2028c2ecf20Sopenharmony_ci		helper_wait(pid);
2038c2ecf20Sopenharmony_ci	return pid;
2048c2ecf20Sopenharmony_ci}
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_cistatic void change(char *dev, char *what, unsigned char *addr,
2078c2ecf20Sopenharmony_ci		   unsigned char *netmask)
2088c2ecf20Sopenharmony_ci{
2098c2ecf20Sopenharmony_ci	char addr_buf[sizeof("255.255.255.255\0")];
2108c2ecf20Sopenharmony_ci	char netmask_buf[sizeof("255.255.255.255\0")];
2118c2ecf20Sopenharmony_ci	char version[sizeof("nnnnn\0")];
2128c2ecf20Sopenharmony_ci	char *argv[] = { "uml_net", version, what, dev, addr_buf,
2138c2ecf20Sopenharmony_ci			 netmask_buf, NULL };
2148c2ecf20Sopenharmony_ci	char *output;
2158c2ecf20Sopenharmony_ci	int output_len, pid;
2168c2ecf20Sopenharmony_ci
2178c2ecf20Sopenharmony_ci	sprintf(version, "%d", UML_NET_VERSION);
2188c2ecf20Sopenharmony_ci	sprintf(addr_buf, "%d.%d.%d.%d", addr[0], addr[1], addr[2], addr[3]);
2198c2ecf20Sopenharmony_ci	sprintf(netmask_buf, "%d.%d.%d.%d", netmask[0], netmask[1],
2208c2ecf20Sopenharmony_ci		netmask[2], netmask[3]);
2218c2ecf20Sopenharmony_ci
2228c2ecf20Sopenharmony_ci	output_len = UM_KERN_PAGE_SIZE;
2238c2ecf20Sopenharmony_ci	output = uml_kmalloc(output_len, UM_GFP_KERNEL);
2248c2ecf20Sopenharmony_ci	if (output == NULL)
2258c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "change : failed to allocate output "
2268c2ecf20Sopenharmony_ci		       "buffer\n");
2278c2ecf20Sopenharmony_ci
2288c2ecf20Sopenharmony_ci	pid = change_tramp(argv, output, output_len);
2298c2ecf20Sopenharmony_ci	if (pid < 0) {
2308c2ecf20Sopenharmony_ci		kfree(output);
2318c2ecf20Sopenharmony_ci		return;
2328c2ecf20Sopenharmony_ci	}
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci	if (output != NULL) {
2358c2ecf20Sopenharmony_ci		printk("%s", output);
2368c2ecf20Sopenharmony_ci		kfree(output);
2378c2ecf20Sopenharmony_ci	}
2388c2ecf20Sopenharmony_ci}
2398c2ecf20Sopenharmony_ci
2408c2ecf20Sopenharmony_civoid open_addr(unsigned char *addr, unsigned char *netmask, void *arg)
2418c2ecf20Sopenharmony_ci{
2428c2ecf20Sopenharmony_ci	change(arg, "add", addr, netmask);
2438c2ecf20Sopenharmony_ci}
2448c2ecf20Sopenharmony_ci
2458c2ecf20Sopenharmony_civoid close_addr(unsigned char *addr, unsigned char *netmask, void *arg)
2468c2ecf20Sopenharmony_ci{
2478c2ecf20Sopenharmony_ci	change(arg, "del", addr, netmask);
2488c2ecf20Sopenharmony_ci}
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_cichar *split_if_spec(char *str, ...)
2518c2ecf20Sopenharmony_ci{
2528c2ecf20Sopenharmony_ci	char **arg, *end, *ret = NULL;
2538c2ecf20Sopenharmony_ci	va_list ap;
2548c2ecf20Sopenharmony_ci
2558c2ecf20Sopenharmony_ci	va_start(ap, str);
2568c2ecf20Sopenharmony_ci	while ((arg = va_arg(ap, char **)) != NULL) {
2578c2ecf20Sopenharmony_ci		if (*str == '\0')
2588c2ecf20Sopenharmony_ci			goto out;
2598c2ecf20Sopenharmony_ci		end = strchr(str, ',');
2608c2ecf20Sopenharmony_ci		if (end != str)
2618c2ecf20Sopenharmony_ci			*arg = str;
2628c2ecf20Sopenharmony_ci		if (end == NULL)
2638c2ecf20Sopenharmony_ci			goto out;
2648c2ecf20Sopenharmony_ci		*end++ = '\0';
2658c2ecf20Sopenharmony_ci		str = end;
2668c2ecf20Sopenharmony_ci	}
2678c2ecf20Sopenharmony_ci	ret = str;
2688c2ecf20Sopenharmony_ciout:
2698c2ecf20Sopenharmony_ci	va_end(ap);
2708c2ecf20Sopenharmony_ci	return ret;
2718c2ecf20Sopenharmony_ci}
272