3c8af4819e
With glibc, we can't reliably build a static binary with getprotobynumber(), which is currently used with -DDEBUG. Replace that with a small array of protocol strings. Signed-off-by: Stefano Brivio <sbrivio@redhat.com>
847 lines
20 KiB
C
847 lines
20 KiB
C
// SPDX-License-Identifier: AGPL-3.0-or-later
|
|
|
|
/* PASST - Plug A Simple Socket Transport
|
|
*
|
|
* passt.c - Daemon implementation
|
|
*
|
|
* Copyright (c) 2020-2021 Red Hat GmbH
|
|
* Author: Stefano Brivio <sbrivio@redhat.com>
|
|
*
|
|
* Grab Ethernet frames via AF_UNIX socket, build SOCK_DGRAM/SOCK_STREAM sockets
|
|
* for each 5-tuple from TCP, UDP packets, perform connection tracking and
|
|
* forward them. Forward packets received on sockets back to the UNIX domain
|
|
* socket (typically, a socket virtio_net file descriptor from qemu).
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <sys/epoll.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/types.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/resource.h>
|
|
#include <sys/uio.h>
|
|
#include <sys/un.h>
|
|
#include <ifaddrs.h>
|
|
#include <linux/if_ether.h>
|
|
#include <linux/if_packet.h>
|
|
#include <arpa/inet.h>
|
|
#include <linux/ip.h>
|
|
#include <linux/ipv6.h>
|
|
#include <linux/tcp.h>
|
|
#include <linux/udp.h>
|
|
#include <linux/icmpv6.h>
|
|
#include <linux/if_link.h>
|
|
#include <net/ethernet.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <net/if.h>
|
|
#include <netdb.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <linux/netlink.h>
|
|
#include <linux/rtnetlink.h>
|
|
#include <time.h>
|
|
#include <syslog.h>
|
|
#include <sys/stat.h>
|
|
|
|
#include "passt.h"
|
|
#include "arp.h"
|
|
#include "dhcp.h"
|
|
#include "ndp.h"
|
|
#include "dhcpv6.h"
|
|
#include "util.h"
|
|
#include "icmp.h"
|
|
#include "tcp.h"
|
|
#include "udp.h"
|
|
|
|
#define EPOLL_EVENTS 10
|
|
|
|
#define TAP_BUF_BYTES (ETH_MAX_MTU * 8)
|
|
#define TAP_BUF_FILL (TAP_BUF_BYTES - ETH_MAX_MTU - sizeof(uint32_t))
|
|
#define TAP_MSGS (TAP_BUF_BYTES / sizeof(struct ethhdr) + 1)
|
|
|
|
#define PKT_BUF_BYTES MAX(TAP_BUF_BYTES, SOCK_BUF_BYTES)
|
|
static char pkt_buf [PKT_BUF_BYTES];
|
|
|
|
#define TIMER_INTERVAL MIN(TCP_TIMER_INTERVAL, UDP_TIMER_INTERVAL)
|
|
|
|
#ifdef DEBUG
|
|
static char *ip_proto_str[IPPROTO_SCTP + 1] = {
|
|
[IPPROTO_ICMP] = "ICMP",
|
|
[IPPROTO_TCP] = "TCP",
|
|
[IPPROTO_UDP] = "UDP",
|
|
[IPPROTO_ICMPV6] = "ICMPV6",
|
|
[IPPROTO_SCTP] = "SCTP",
|
|
};
|
|
|
|
#define IP_PROTO_STR(n) \
|
|
(((n) <= IPPROTO_SCTP && ip_proto_str[(n)]) ? ip_proto_str[(n)] : "?")
|
|
|
|
#endif
|
|
|
|
/**
|
|
* sock_unix() - Create and bind AF_UNIX socket, add to epoll list
|
|
*
|
|
* Return: newly created socket, doesn't return on error
|
|
*/
|
|
static int sock_unix(void)
|
|
{
|
|
int fd = socket(AF_UNIX, SOCK_STREAM, 0);
|
|
struct sockaddr_un addr = {
|
|
.sun_family = AF_UNIX,
|
|
.sun_path = UNIX_SOCK_PATH,
|
|
};
|
|
|
|
if (fd < 0) {
|
|
perror("UNIX socket");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
unlink(UNIX_SOCK_PATH);
|
|
if (bind(fd, (const struct sockaddr *)&addr, sizeof(addr)) < 0) {
|
|
perror("UNIX socket bind");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
chmod(UNIX_SOCK_PATH,
|
|
S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH | S_IWOTH);
|
|
|
|
return fd;
|
|
}
|
|
|
|
/**
|
|
* struct nl_request - Netlink request filled and sent by get_routes()
|
|
* @nlh: Netlink message header
|
|
* @rtm: Routing Netlink message
|
|
*/
|
|
struct nl_request {
|
|
struct nlmsghdr nlh;
|
|
struct rtmsg rtm;
|
|
};
|
|
|
|
/**
|
|
* get_routes() - Get default route and fill in routable interface name
|
|
* @c: Execution context
|
|
*/
|
|
static void get_routes(struct ctx *c)
|
|
{
|
|
struct nl_request req = {
|
|
.nlh.nlmsg_type = RTM_GETROUTE,
|
|
.nlh.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP | NLM_F_EXCL,
|
|
.nlh.nlmsg_len = sizeof(struct nl_request),
|
|
.nlh.nlmsg_seq = 1,
|
|
.rtm.rtm_family = AF_INET,
|
|
.rtm.rtm_table = RT_TABLE_MAIN,
|
|
.rtm.rtm_scope = RT_SCOPE_UNIVERSE,
|
|
.rtm.rtm_type = RTN_UNICAST,
|
|
};
|
|
struct sockaddr_nl addr = {
|
|
.nl_family = AF_NETLINK,
|
|
};
|
|
struct nlmsghdr *nlh;
|
|
struct rtattr *rta;
|
|
struct rtmsg *rtm;
|
|
char buf[BUFSIZ];
|
|
int s, n, na;
|
|
|
|
c->v6 = -1;
|
|
|
|
s = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
|
|
if (s < 0) {
|
|
perror("netlink socket");
|
|
goto out;
|
|
}
|
|
|
|
if (bind(s, (struct sockaddr *)&addr, sizeof(addr)) < 0) {
|
|
perror("netlink bind");
|
|
goto out;
|
|
}
|
|
|
|
v6:
|
|
if (send(s, &req, sizeof(req), 0) < 0) {
|
|
perror("netlink send");
|
|
goto out;
|
|
}
|
|
|
|
n = recv(s, &buf, sizeof(buf), 0);
|
|
if (n < 0) {
|
|
perror("netlink recv");
|
|
goto out;
|
|
}
|
|
|
|
nlh = (struct nlmsghdr *)buf;
|
|
for ( ; NLMSG_OK(nlh, n); nlh = NLMSG_NEXT(nlh, n)) {
|
|
rtm = (struct rtmsg *)NLMSG_DATA(nlh);
|
|
|
|
if (rtm->rtm_dst_len ||
|
|
(rtm->rtm_family != AF_INET && rtm->rtm_family != AF_INET6))
|
|
continue;
|
|
|
|
rta = (struct rtattr *)RTM_RTA(rtm);
|
|
na = RTM_PAYLOAD(nlh);
|
|
for ( ; RTA_OK(rta, na); rta = RTA_NEXT(rta, na)) {
|
|
if (rta->rta_type == RTA_GATEWAY &&
|
|
rtm->rtm_family == AF_INET && !c->v4) {
|
|
memcpy(&c->gw4, RTA_DATA(rta), sizeof(c->gw4));
|
|
c->v4 = 1;
|
|
}
|
|
|
|
if (rta->rta_type == RTA_GATEWAY &&
|
|
rtm->rtm_family == AF_INET6 && !c->v6) {
|
|
memcpy(&c->gw6, RTA_DATA(rta), sizeof(c->gw6));
|
|
c->v6 = 1;
|
|
}
|
|
|
|
if (rta->rta_type == RTA_OIF && !*c->ifn) {
|
|
if_indextoname(*(unsigned *)RTA_DATA(rta),
|
|
c->ifn);
|
|
}
|
|
}
|
|
|
|
if (nlh->nlmsg_type == NLMSG_DONE)
|
|
break;
|
|
}
|
|
|
|
if (c->v6 == -1) {
|
|
c->v6 = 0;
|
|
req.rtm.rtm_family = AF_INET6;
|
|
req.nlh.nlmsg_seq++;
|
|
recv(s, &buf, sizeof(buf), 0);
|
|
goto v6;
|
|
}
|
|
|
|
out:
|
|
close(s);
|
|
|
|
if (!(c->v4 || c->v6) || !*c->ifn) {
|
|
err("No routing information");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* get_addrs() - Fetch MAC, IP addresses, masks of external routable interface
|
|
* @c: Execution context
|
|
*/
|
|
static void get_addrs(struct ctx *c)
|
|
{
|
|
struct ifreq ifr = {
|
|
.ifr_addr.sa_family = AF_INET,
|
|
};
|
|
struct ifaddrs *ifaddr, *ifa;
|
|
int s, v4 = 0, v6 = 0;
|
|
|
|
if (getifaddrs(&ifaddr) == -1) {
|
|
perror("getifaddrs");
|
|
goto out;
|
|
}
|
|
|
|
for (ifa = ifaddr; ifa; ifa = ifa->ifa_next) {
|
|
struct sockaddr_in *in_addr;
|
|
struct sockaddr_in6 *in6_addr;
|
|
|
|
if (strcmp(ifa->ifa_name, c->ifn))
|
|
continue;
|
|
|
|
if (!ifa->ifa_addr)
|
|
continue;
|
|
|
|
if (ifa->ifa_addr->sa_family == AF_INET && !v4) {
|
|
in_addr = (struct sockaddr_in *)ifa->ifa_addr;
|
|
c->addr4_seen = c->addr4 = in_addr->sin_addr.s_addr;
|
|
in_addr = (struct sockaddr_in *)ifa->ifa_netmask;
|
|
c->mask4 = in_addr->sin_addr.s_addr;
|
|
v4 = 1;
|
|
} else if (ifa->ifa_addr->sa_family == AF_INET6 && !v6) {
|
|
in6_addr = (struct sockaddr_in6 *)ifa->ifa_addr;
|
|
memcpy(&c->addr6, &in6_addr->sin6_addr,
|
|
sizeof(c->addr6));
|
|
memcpy(&c->addr6_seen, &in6_addr->sin6_addr,
|
|
sizeof(c->addr6_seen));
|
|
memcpy(&c->addr6_ll_seen, &in6_addr->sin6_addr,
|
|
sizeof(c->addr6_seen));
|
|
v6 = 1;
|
|
}
|
|
|
|
if (v4 == c->v4 && v6 == c->v6)
|
|
break;
|
|
}
|
|
|
|
freeifaddrs(ifaddr);
|
|
|
|
if (v4 != c->v4 || v6 != c->v6)
|
|
goto out;
|
|
|
|
s = socket(AF_INET, SOCK_DGRAM, 0);
|
|
if (s < 0) {
|
|
perror("socket SIOCGIFHWADDR");
|
|
goto out;
|
|
}
|
|
|
|
strncpy(ifr.ifr_name, c->ifn, IF_NAMESIZE);
|
|
if (ioctl(s, SIOCGIFHWADDR, &ifr) < 0) {
|
|
perror("SIOCGIFHWADDR");
|
|
goto out;
|
|
}
|
|
|
|
close(s);
|
|
memcpy(c->mac, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
|
|
|
|
return;
|
|
out:
|
|
err("Couldn't get addresses for routable interface");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
/**
|
|
* get_dns() - Get nameserver addresses from local /etc/resolv.conf
|
|
* @c: Execution context
|
|
*/
|
|
static void get_dns(struct ctx *c)
|
|
{
|
|
char buf[BUFSIZ], *p, *end;
|
|
int dns4 = 0, dns6 = 0;
|
|
FILE *r;
|
|
|
|
r = fopen("/etc/resolv.conf", "r");
|
|
while (fgets(buf, BUFSIZ, r) && !(dns4 && dns6)) {
|
|
if (!strstr(buf, "nameserver "))
|
|
continue;
|
|
p = strrchr(buf, ' ');
|
|
end = strpbrk(buf, "%\n");
|
|
if (end)
|
|
*end = 0;
|
|
if (p && inet_pton(AF_INET, p + 1, &c->dns4))
|
|
dns4 = 1;
|
|
if (p && inet_pton(AF_INET6, p + 1, &c->dns6))
|
|
dns6 = 1;
|
|
}
|
|
|
|
fclose(r);
|
|
if (dns4 || dns6)
|
|
return;
|
|
|
|
err("Couldn't get any nameserver address");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
/**
|
|
* tap4_handler() - IPv4 and ARP packet handler for tap file descriptor
|
|
* @c: Execution context
|
|
* @msg: Array of messages with the same L3 protocol
|
|
* @count: Count of messages with the same L3 protocol
|
|
* @now: Current timestamp
|
|
*
|
|
* Return: count of packets consumed by handlers
|
|
*/
|
|
static int tap4_handler(struct ctx *c, struct tap_msg *msg, size_t count,
|
|
struct timespec *now)
|
|
{
|
|
char buf_s[INET_ADDRSTRLEN] __attribute((__unused__));
|
|
char buf_d[INET_ADDRSTRLEN] __attribute((__unused__));
|
|
struct ethhdr *eh = (struct ethhdr *)msg[0].start;
|
|
struct iphdr *iph, *prev_iph = NULL;
|
|
struct udphdr *uh, *prev_uh = NULL;
|
|
size_t len = msg[0].len;
|
|
unsigned int i;
|
|
char *l4h;
|
|
|
|
if (!c->v4)
|
|
return count;
|
|
|
|
if (len < sizeof(*eh) + sizeof(*iph))
|
|
return 1;
|
|
|
|
if (arp(c, eh, len) || dhcp(c, eh, len))
|
|
return 1;
|
|
|
|
for (i = 0; i < count; i++) {
|
|
len = msg[i].len;
|
|
if (len < sizeof(*eh) + sizeof(*iph))
|
|
return 1;
|
|
|
|
eh = (struct ethhdr *)msg[i].start;
|
|
iph = (struct iphdr *)(eh + 1);
|
|
l4h = (char *)iph + iph->ihl * 4;
|
|
|
|
c->addr4_seen = iph->saddr;
|
|
|
|
msg[i].l4h = l4h;
|
|
msg[i].l4_len = len - ((intptr_t)l4h - (intptr_t)eh);
|
|
|
|
if (iph->protocol != IPPROTO_TCP &&
|
|
iph->protocol != IPPROTO_UDP)
|
|
break;
|
|
|
|
if (len < sizeof(*uh))
|
|
break;
|
|
|
|
uh = (struct udphdr *)l4h;
|
|
|
|
if (!i) {
|
|
prev_iph = iph;
|
|
prev_uh = uh;
|
|
continue;
|
|
}
|
|
|
|
if (iph->tos != prev_iph->tos ||
|
|
iph->frag_off != prev_iph->frag_off ||
|
|
iph->protocol != prev_iph->protocol ||
|
|
iph->saddr != prev_iph->saddr ||
|
|
iph->daddr != prev_iph->daddr ||
|
|
uh->source != prev_uh->source ||
|
|
uh->dest != prev_uh->dest)
|
|
break;
|
|
|
|
prev_iph = iph;
|
|
prev_uh = uh;
|
|
}
|
|
|
|
eh = (struct ethhdr *)msg[0].start;
|
|
iph = (struct iphdr *)(eh + 1);
|
|
|
|
if (iph->protocol == IPPROTO_TCP || iph->protocol == IPPROTO_UDP ||
|
|
iph->protocol == IPPROTO_SCTP) {
|
|
uh = (struct udphdr *)msg[0].l4h;
|
|
|
|
if (msg[0].len < sizeof(*uh))
|
|
return 1;
|
|
|
|
debug("%s from tap: %s:%i -> %s:%i (%i packet%s)",
|
|
IP_PROTO_STR(iph->protocol),
|
|
inet_ntop(AF_INET, &iph->saddr, buf_s, sizeof(buf_s)),
|
|
ntohs(uh->source),
|
|
inet_ntop(AF_INET, &iph->daddr, buf_d, sizeof(buf_d)),
|
|
ntohs(uh->dest),
|
|
i, i > 1 ? "s" : "");
|
|
} else if (iph->protocol == IPPROTO_ICMP) {
|
|
debug("icmp from tap: %s -> %s",
|
|
inet_ntop(AF_INET, &iph->saddr, buf_s, sizeof(buf_s)),
|
|
inet_ntop(AF_INET, &iph->daddr, buf_d, sizeof(buf_d)));
|
|
}
|
|
|
|
if (iph->protocol == IPPROTO_TCP)
|
|
return tcp_tap_handler(c, AF_INET, &iph->daddr, msg, i, now);
|
|
|
|
if (iph->protocol == IPPROTO_UDP)
|
|
return udp_tap_handler(c, AF_INET, &iph->daddr, msg, i, now);
|
|
|
|
if (iph->protocol == IPPROTO_ICMP)
|
|
icmp_tap_handler(c, AF_INET, &iph->daddr, msg, 1, now);
|
|
|
|
return 1;
|
|
}
|
|
|
|
/**
|
|
* tap6_handler() - IPv6 packet handler for tap file descriptor
|
|
* @c: Execution context
|
|
* @msg: Array of messages with the same L3 protocol
|
|
* @count: Count of messages with the same L3 protocol
|
|
* @now: Current timestamp
|
|
*/
|
|
static int tap6_handler(struct ctx *c, struct tap_msg *msg, size_t count,
|
|
struct timespec *now)
|
|
{
|
|
char buf_s[INET6_ADDRSTRLEN] __attribute((__unused__));
|
|
char buf_d[INET6_ADDRSTRLEN] __attribute((__unused__));
|
|
struct ethhdr *eh = (struct ethhdr *)msg[0].start;
|
|
struct udphdr *uh, *prev_uh = NULL;
|
|
uint8_t proto = 0, prev_proto = 0;
|
|
size_t len = msg[0].len;
|
|
struct ipv6hdr *ip6h;
|
|
unsigned int i;
|
|
char *l4h;
|
|
|
|
if (!c->v6)
|
|
return count;
|
|
|
|
if (len < sizeof(*eh) + sizeof(*ip6h))
|
|
return 1;
|
|
|
|
if (ndp(c, eh, len) || dhcpv6(c, eh, len))
|
|
return 1;
|
|
|
|
for (i = 0; i < count; i++) {
|
|
struct ipv6hdr *p_ip6h;
|
|
|
|
len = msg[i].len;
|
|
if (len < sizeof(*eh) + sizeof(*ip6h))
|
|
return 1;
|
|
|
|
eh = (struct ethhdr *)msg[i].start;
|
|
ip6h = (struct ipv6hdr *)(eh + 1);
|
|
l4h = ipv6_l4hdr(ip6h, &proto);
|
|
|
|
msg[i].l4h = l4h;
|
|
msg[i].l4_len = len - ((intptr_t)l4h - (intptr_t)eh);
|
|
|
|
if (IN6_IS_ADDR_LINKLOCAL(&ip6h->saddr))
|
|
c->addr6_ll_seen = ip6h->saddr;
|
|
else
|
|
c->addr6_seen = ip6h->saddr;
|
|
|
|
ip6h->saddr = c->addr6;
|
|
|
|
if (proto != IPPROTO_TCP && proto != IPPROTO_UDP)
|
|
break;
|
|
|
|
if (len < sizeof(*uh))
|
|
break;
|
|
|
|
uh = (struct udphdr *)l4h;
|
|
|
|
if (!i) {
|
|
p_ip6h = ip6h;
|
|
prev_proto = proto;
|
|
prev_uh = uh;
|
|
continue;
|
|
}
|
|
|
|
if (proto != prev_proto ||
|
|
memcmp(&ip6h->saddr, &p_ip6h->saddr, sizeof(ip6h->saddr)) ||
|
|
memcmp(&ip6h->daddr, &p_ip6h->daddr, sizeof(ip6h->daddr)) ||
|
|
uh->source != prev_uh->source ||
|
|
uh->dest != prev_uh->dest)
|
|
break;
|
|
|
|
p_ip6h = ip6h;
|
|
prev_proto = proto;
|
|
prev_uh = uh;
|
|
}
|
|
|
|
if (prev_proto)
|
|
proto = prev_proto;
|
|
|
|
eh = (struct ethhdr *)msg[0].start;
|
|
ip6h = (struct ipv6hdr *)(eh + 1);
|
|
|
|
if (proto == IPPROTO_ICMPV6) {
|
|
debug("icmpv6 from tap: %s ->\n\t%s",
|
|
inet_ntop(AF_INET6, &ip6h->saddr, buf_s, sizeof(buf_s)),
|
|
inet_ntop(AF_INET6, &ip6h->daddr, buf_d, sizeof(buf_d)));
|
|
} else if (proto == IPPROTO_TCP || proto == IPPROTO_UDP ||
|
|
proto == IPPROTO_SCTP) {
|
|
uh = (struct udphdr *)msg[0].l4h;
|
|
|
|
if (msg[0].len < sizeof(*uh))
|
|
return 1;
|
|
|
|
debug("%s from tap: [%s]:%i\n\t-> [%s]:%i (%i packet%s)",
|
|
IP_PROTO_STR(proto),
|
|
inet_ntop(AF_INET6, &ip6h->saddr, buf_s, sizeof(buf_s)),
|
|
ntohs(uh->source),
|
|
inet_ntop(AF_INET6, &ip6h->daddr, buf_d, sizeof(buf_d)),
|
|
ntohs(uh->dest),
|
|
i, i > 1 ? "s" : "");
|
|
}
|
|
|
|
if (proto == IPPROTO_TCP)
|
|
return tcp_tap_handler(c, AF_INET6, &ip6h->daddr, msg, i, now);
|
|
|
|
if (proto == IPPROTO_UDP)
|
|
return udp_tap_handler(c, AF_INET6, &ip6h->daddr, msg, i, now);
|
|
|
|
if (proto == IPPROTO_ICMPV6)
|
|
icmp_tap_handler(c, AF_INET6, &ip6h->daddr, msg, 1, now);
|
|
|
|
return 1;
|
|
}
|
|
|
|
/**
|
|
* tap_handler() - Packet handler for tap file descriptor
|
|
* @c: Execution context
|
|
* @now: Current timestamp
|
|
*
|
|
* Return: -ECONNRESET if tap connection was lost, 0 otherwise
|
|
*/
|
|
static int tap_handler(struct ctx *c, struct timespec *now)
|
|
{
|
|
struct tap_msg msg[TAP_MSGS];
|
|
int msg_count, same, i;
|
|
struct ethhdr *eh;
|
|
char *p = pkt_buf;
|
|
ssize_t n, rem;
|
|
|
|
while ((n = recv(c->fd_unix, p, TAP_BUF_FILL, MSG_DONTWAIT)) > 0) {
|
|
msg_count = 0;
|
|
|
|
while (n > (ssize_t)sizeof(uint32_t)) {
|
|
ssize_t len = ntohl(*(uint32_t *)p);
|
|
|
|
p += sizeof(uint32_t);
|
|
n -= sizeof(uint32_t);
|
|
|
|
if (len < (ssize_t)sizeof(*eh))
|
|
return 0;
|
|
|
|
/* At most one packet might not fit in a single read */
|
|
if (len > n) {
|
|
rem = recv(c->fd_unix, p + n, len - n,
|
|
MSG_DONTWAIT);
|
|
if ((n += rem) != len)
|
|
return 0;
|
|
}
|
|
|
|
msg[msg_count].start = p;
|
|
msg[msg_count++].len = len;
|
|
|
|
n -= len;
|
|
p += len;
|
|
}
|
|
|
|
i = 0;
|
|
while (i < msg_count) {
|
|
eh = (struct ethhdr *)msg[i].start;
|
|
|
|
memcpy(c->mac_guest, eh->h_source, ETH_ALEN);
|
|
|
|
switch (ntohs(eh->h_proto)) {
|
|
case ETH_P_ARP:
|
|
tap4_handler(c, msg + i, 1, now);
|
|
i++;
|
|
break;
|
|
case ETH_P_IP:
|
|
for (same = 1; i + same < msg_count &&
|
|
same < UIO_MAXIOV; same++) {
|
|
struct tap_msg *next = &msg[i + same];
|
|
|
|
eh = (struct ethhdr *)next->start;
|
|
if (ntohs(eh->h_proto) != ETH_P_IP)
|
|
break;
|
|
}
|
|
|
|
i += tap4_handler(c, msg + i, same, now);
|
|
break;
|
|
case ETH_P_IPV6:
|
|
for (same = 1; i + same < msg_count &&
|
|
same < UIO_MAXIOV; same++) {
|
|
struct tap_msg *next = &msg[i + same];
|
|
|
|
eh = (struct ethhdr *)next->start;
|
|
if (ntohs(eh->h_proto) != ETH_P_IPV6)
|
|
break;
|
|
}
|
|
|
|
i += tap6_handler(c, msg + i, same, now);
|
|
break;
|
|
default:
|
|
i++;
|
|
break;
|
|
}
|
|
}
|
|
|
|
p = pkt_buf;
|
|
}
|
|
|
|
if (n >= 0 || errno == EINTR || errno == EAGAIN || errno == EWOULDBLOCK)
|
|
return 0;
|
|
|
|
epoll_ctl(c->epollfd, EPOLL_CTL_DEL, c->fd_unix, NULL);
|
|
close(c->fd_unix);
|
|
|
|
return -ECONNRESET;
|
|
}
|
|
|
|
/**
|
|
* sock_handler() - Event handler for L4 sockets
|
|
* @c: Execution context
|
|
* @s: Socket associated to event
|
|
* @events: epoll events
|
|
* @now: Current timestamp
|
|
*/
|
|
static void sock_handler(struct ctx *c, int s, uint32_t events,
|
|
struct timespec *now)
|
|
{
|
|
socklen_t sl;
|
|
int proto;
|
|
|
|
sl = sizeof(proto);
|
|
|
|
if ( FD_PROTO(s, udp) && !FD_PROTO(s, icmp) && !FD_PROTO(s, tcp))
|
|
proto = IPPROTO_UDP;
|
|
else if (FD_PROTO(s, tcp) && !FD_PROTO(s, icmp) && !FD_PROTO(s, udp))
|
|
proto = IPPROTO_TCP;
|
|
else if (FD_PROTO(s, icmp) && !FD_PROTO(s, udp) && !FD_PROTO(s, tcp))
|
|
proto = IPPROTO_ICMP; /* Fits ICMPv6 below, too */
|
|
else if (getsockopt(s, SOL_SOCKET, SO_PROTOCOL, &proto, &sl))
|
|
proto = -1;
|
|
|
|
if (proto == -1) {
|
|
epoll_ctl(c->epollfd, EPOLL_CTL_DEL, s, NULL);
|
|
close(s);
|
|
return;
|
|
}
|
|
|
|
debug("%s: packet from socket %i", IP_PROTO_STR(proto), s);
|
|
|
|
if (proto == IPPROTO_ICMP || proto == IPPROTO_ICMPV6)
|
|
icmp_sock_handler(c, s, events, pkt_buf, now);
|
|
else if (proto == IPPROTO_TCP)
|
|
tcp_sock_handler( c, s, events, pkt_buf, now);
|
|
else if (proto == IPPROTO_UDP)
|
|
udp_sock_handler( c, s, events, pkt_buf, now);
|
|
}
|
|
|
|
/**
|
|
* timer_handler() - Run periodic tasks for L4 protocol handlers
|
|
* @c: Execution context
|
|
* @now: Current timestamp
|
|
*/
|
|
static void timer_handler(struct ctx *c, struct timespec *now)
|
|
{
|
|
if (timespec_diff_ms(now, &c->tcp.timer_run) >= TCP_TIMER_INTERVAL) {
|
|
tcp_timer(c, now);
|
|
c->tcp.timer_run = *now;
|
|
}
|
|
|
|
if (timespec_diff_ms(now, &c->udp.timer_run) >= UDP_TIMER_INTERVAL) {
|
|
udp_timer(c, now);
|
|
c->udp.timer_run = *now;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* usage() - Print usage and exit
|
|
* @name: Executable name
|
|
*/
|
|
void usage(const char *name)
|
|
{
|
|
fprintf(stderr, "Usage: %s\n", name);
|
|
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
/**
|
|
* main() - Entry point and main loop
|
|
* @argc: Argument count
|
|
* @argv: Interface names
|
|
*
|
|
* Return: 0 once interrupted, non-zero on failure
|
|
*/
|
|
int main(int argc, char **argv)
|
|
{
|
|
struct epoll_event events[EPOLL_EVENTS];
|
|
char buf6[3][INET6_ADDRSTRLEN];
|
|
char buf4[4][INET_ADDRSTRLEN];
|
|
struct epoll_event ev = { 0 };
|
|
struct ctx c = { 0 };
|
|
int nfds, i, fd_unix;
|
|
struct rlimit limit;
|
|
struct timespec now;
|
|
|
|
if (argc != 1)
|
|
usage(argv[0]);
|
|
|
|
if (clock_gettime(CLOCK_MONOTONIC, &now)) {
|
|
perror("clock_gettime");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
c.epollfd = epoll_create1(0);
|
|
if (c.epollfd == -1) {
|
|
perror("epoll_create1");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
if (getrlimit(RLIMIT_NOFILE, &limit)) {
|
|
perror("getrlimit");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
limit.rlim_cur = limit.rlim_max;
|
|
if (setrlimit(RLIMIT_NOFILE, &limit)) {
|
|
perror("setrlimit");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
#if DEBUG
|
|
openlog("passt", LOG_PERROR, LOG_DAEMON);
|
|
#else
|
|
openlog("passt", 0, LOG_DAEMON);
|
|
if (daemon(0, 0)) {
|
|
fprintf(stderr, "Failed to fork into background\n");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
#endif
|
|
|
|
get_routes(&c);
|
|
get_addrs(&c);
|
|
get_dns(&c);
|
|
|
|
fd_unix = sock_unix();
|
|
|
|
if (icmp_sock_init(&c) || tcp_sock_init(&c) || udp_sock_init(&c))
|
|
exit(EXIT_FAILURE);
|
|
|
|
if (c.v6)
|
|
dhcpv6_init(&c);
|
|
|
|
memset(&c.mac_guest, 0xff, sizeof(c.mac_guest));
|
|
|
|
if (c.v4) {
|
|
info("ARP:");
|
|
info(" address: %02x:%02x:%02x:%02x:%02x:%02x from %s",
|
|
c.mac[0], c.mac[1], c.mac[2], c.mac[3], c.mac[4], c.mac[5],
|
|
c.ifn);
|
|
info("DHCP:");
|
|
info(" assign: %s",
|
|
inet_ntop(AF_INET, &c.addr4, buf4[0], sizeof(buf4[0])));
|
|
info(" mask: %s",
|
|
inet_ntop(AF_INET, &c.mask4, buf4[0], sizeof(buf4[0])));
|
|
info(" router: %s",
|
|
inet_ntop(AF_INET, &c.gw4, buf4[2], sizeof(buf4[2])));
|
|
info(" DNS: %s",
|
|
inet_ntop(AF_INET, &c.dns4, buf4[3], sizeof(buf4[3])));
|
|
}
|
|
if (c.v6) {
|
|
info("NDP/DHCPv6:");
|
|
info(" assign: %s",
|
|
inet_ntop(AF_INET6, &c.addr6, buf6[0], sizeof(buf6[0])));
|
|
info(" router: %s",
|
|
inet_ntop(AF_INET6, &c.gw6, buf6[1], sizeof(buf6[1])));
|
|
info(" DNS: %s",
|
|
inet_ntop(AF_INET6, &c.dns6, buf6[2], sizeof(buf6[2])));
|
|
}
|
|
|
|
listen:
|
|
listen(fd_unix, 1);
|
|
info("You can now start qrap:");
|
|
info(" ./qrap 5 kvm ... -net socket,fd=5 -net nic,model=virtio");
|
|
info("or directly qemu, patched with:");
|
|
info(" qemu/0001-net-Allow-also-UNIX-domain-sockets-to-be-used-as-net.patch");
|
|
info("as follows:");
|
|
info(" kvm ... -net socket,connect="
|
|
UNIX_SOCK_PATH " -net nic,model=virtio");
|
|
|
|
c.fd_unix = accept(fd_unix, NULL, NULL);
|
|
ev.events = EPOLLIN | EPOLLRDHUP | EPOLLERR | EPOLLHUP;
|
|
ev.data.fd = c.fd_unix;
|
|
epoll_ctl(c.epollfd, EPOLL_CTL_ADD, c.fd_unix, &ev);
|
|
|
|
loop:
|
|
nfds = epoll_wait(c.epollfd, events, EPOLL_EVENTS, TIMER_INTERVAL);
|
|
if (nfds == -1 && errno != EINTR) {
|
|
perror("epoll_wait");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
clock_gettime(CLOCK_MONOTONIC, &now);
|
|
|
|
for (i = 0; i < nfds; i++) {
|
|
if (events[i].data.fd == c.fd_unix) {
|
|
if (events[i].events & EPOLLRDHUP ||
|
|
events[i].events & EPOLLHUP ||
|
|
events[i].events & EPOLLERR ||
|
|
tap_handler(&c, &now))
|
|
goto listen;
|
|
} else {
|
|
sock_handler(&c, events[i].data.fd, events[i].events,
|
|
&now);
|
|
}
|
|
}
|
|
|
|
timer_handler(&c, &now);
|
|
|
|
goto loop;
|
|
|
|
return 0;
|
|
}
|