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