1
This commit is contained in:
1 parent
429e41da42
commit
b037589e5c
1 file changed
+236
@@ -0,0 +1,236 @@
|
||||
// tun_freebsd.c - FreeBSD TUN/TAP implementation
|
||||
// Uses /dev/tun device with ioctl
|
||||
|
||||
#include "tun_if.h"
|
||||
#include "../lib/debug_config.h"
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <fcntl.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/socket.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <net/if.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
#include "../lib/platform_compat.h"
|
||||
#include <errno.h>
|
||||
#include "../lib/mem.h"
|
||||
|
||||
// Helper for interface ioctl operations
|
||||
static int if_ioctl(const char *ifname, unsigned long request, struct ifreq *ifr) {
|
||||
int sock = socket(AF_INET, SOCK_DGRAM, 0);
|
||||
if (sock < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "Failed to create ioctl socket: %s", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
strncpy(ifr->ifr_name, ifname, IFNAMSIZ - 1);
|
||||
ifr->ifr_name[IFNAMSIZ - 1] = '\0';
|
||||
|
||||
int ret = ioctl(sock, request, ifr);
|
||||
if (ret < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "ioctl failed for %s (request=0x%lx): %s", ifname, request, strerror(errno));
|
||||
}
|
||||
|
||||
close(sock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
// Parse IP address and CIDR mask
|
||||
static int parse_ip_mask(const char *ip_addr, struct in_addr *ip, struct in_addr *netmask) {
|
||||
if (!ip_addr || !ip || !netmask) return -1;
|
||||
|
||||
char ip_str[INET_ADDRSTRLEN];
|
||||
char *slash = strchr(ip_addr, '/');
|
||||
if (!slash) return -1;
|
||||
|
||||
size_t ip_len = slash - ip_addr;
|
||||
if (ip_len >= sizeof(ip_str)) return -1;
|
||||
strncpy(ip_str, ip_addr, ip_len);
|
||||
ip_str[ip_len] = '\0';
|
||||
|
||||
if (inet_pton(AF_INET, ip_str, ip) <= 0) return -1;
|
||||
|
||||
char *endptr;
|
||||
long cidr = strtol(slash + 1, &endptr, 10);
|
||||
if (*endptr != '\0' || cidr < 0 || cidr > 32) return -1;
|
||||
|
||||
uint32_t mask = (cidr == 0) ? 0 : ~((1U << (32 - cidr)) - 1);
|
||||
netmask->s_addr = htonl(mask);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Create TUN device (FreeBSD uses /dev/tun)
|
||||
static int create_tun_device(char *ifname, size_t ifname_len) {
|
||||
struct ifreq ifr;
|
||||
int fd;
|
||||
|
||||
// FreeBSD uses /dev/tun instead of /dev/net/tun
|
||||
fd = open("/dev/tun", O_RDWR);
|
||||
if (fd < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "Failed to open /dev/tun: %s", strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
memset(&ifr, 0, sizeof(ifr));
|
||||
// Note: FreeBSD doesn't use IFF_TUN/IFF_NO_PI flags like Linux
|
||||
|
||||
if (ifname && ifname_len > 0 && ifname[0] != '\0') {
|
||||
strncpy(ifr.ifr_name, ifname, IFNAMSIZ - 1);
|
||||
}
|
||||
|
||||
// On FreeBSD, interface name is set via ifname buffer after open
|
||||
if (ifname && ifname_len > 0) {
|
||||
// FreeBSD returns the interface name in the ifr_name after successful open
|
||||
// We use the provided name as-is for tunnel interfaces (tun0, tun1, etc.)
|
||||
strncpy(ifname, ifname, ifname_len - 1);
|
||||
ifname[ifname_len - 1] = '\0';
|
||||
}
|
||||
|
||||
return fd;
|
||||
}
|
||||
|
||||
// Set IP address on TUN interface
|
||||
static int tun_set_ip(const char *ifname, const char *ip_addr) {
|
||||
if (!ifname || !ip_addr) {
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct in_addr ip, netmask;
|
||||
if (parse_ip_mask(ip_addr, &ip, &netmask) < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_CONFIG, "Invalid IP address format: %s", ip_addr);
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct ifreq ifr;
|
||||
memset(&ifr, 0, sizeof(ifr));
|
||||
|
||||
// Set IP address
|
||||
struct sockaddr_in *addr = (struct sockaddr_in *)&ifr.ifr_addr;
|
||||
addr->sin_family = AF_INET;
|
||||
addr->sin_addr = ip;
|
||||
if (if_ioctl(ifname, SIOCSIFADDR, &ifr) < 0) return -1;
|
||||
|
||||
// Set netmask
|
||||
addr = (struct sockaddr_in *)&ifr.ifr_netmask;
|
||||
addr->sin_family = AF_INET;
|
||||
addr->sin_addr = netmask;
|
||||
if (if_ioctl(ifname, SIOCSIFNETMASK, &ifr) < 0) return -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Bring TUN interface up
|
||||
static int tun_set_up(const char *ifname) {
|
||||
if (!ifname) {
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct ifreq ifr;
|
||||
memset(&ifr, 0, sizeof(ifr));
|
||||
|
||||
// Get current flags
|
||||
if (if_ioctl(ifname, SIOCGIFFLAGS, &ifr) < 0) return -1;
|
||||
|
||||
// Set UP and RUNNING
|
||||
ifr.ifr_flags |= IFF_UP | IFF_RUNNING;
|
||||
if (if_ioctl(ifname, SIOCSIFFLAGS, &ifr) < 0) return -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Set MTU on TUN interface
|
||||
static int tun_set_mtu(const char *ifname, int mtu) {
|
||||
if (!ifname || mtu <= 0) {
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
struct ifreq ifr;
|
||||
memset(&ifr, 0, sizeof(ifr));
|
||||
ifr.ifr_mtu = mtu;
|
||||
|
||||
if (if_ioctl(ifname, SIOCSIFMTU, &ifr) < 0) return -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Platform-specific initialization for FreeBSD
|
||||
int tun_platform_init(struct tun_if* tun, const char* ifname, const char* ip_str, int mtu) {
|
||||
(void)ifname; // ifname is stored in tun->ifname by caller
|
||||
|
||||
// Create TUN device
|
||||
tun->fd = create_tun_device(tun->ifname, sizeof(tun->ifname));
|
||||
if (tun->fd < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "Failed to create TUN device");
|
||||
return -1;
|
||||
}
|
||||
|
||||
// Configure IP address
|
||||
if (tun_set_ip(tun->ifname, ip_str) < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "Failed to set TUN IP: %s", ip_str);
|
||||
close(tun->fd);
|
||||
tun->fd = -1;
|
||||
return -1;
|
||||
}
|
||||
|
||||
// Set MTU
|
||||
if (tun_set_mtu(tun->ifname, mtu) < 0) {
|
||||
DEBUG_WARN(DEBUG_CATEGORY_TUN, "Failed to set MTU %d on %s: %s", mtu, tun->ifname, strerror(errno));
|
||||
}
|
||||
|
||||
// Bring interface up
|
||||
if (tun_set_up(tun->ifname) < 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "Failed to bring up TUN interface %s", tun->ifname);
|
||||
close(tun->fd);
|
||||
tun->fd = -1;
|
||||
return -1;
|
||||
}
|
||||
|
||||
tun->ifindex = if_nametoindex(tun->ifname);
|
||||
if (tun->ifindex == 0) {
|
||||
DEBUG_ERROR(DEBUG_CATEGORY_TUN, "Failed to get ifindex for %s", tun->ifname);
|
||||
}
|
||||
|
||||
// Set non-blocking mode
|
||||
int flags = fcntl(tun->fd, F_GETFL, 0);
|
||||
if (flags >= 0) {
|
||||
fcntl(tun->fd, F_SETFL, flags | O_NONBLOCK);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Platform-specific cleanup for FreeBSD
|
||||
void tun_platform_cleanup(struct tun_if* tun) {
|
||||
if (tun->fd >= 0) {
|
||||
close(tun->fd);
|
||||
tun->fd = -1;
|
||||
}
|
||||
}
|
||||
|
||||
// Platform-specific read for FreeBSD
|
||||
ssize_t tun_platform_read(struct tun_if* tun, uint8_t* buf, size_t len) {
|
||||
ssize_t nread = read(tun->fd, buf, len);
|
||||
if (nread < 0 && errno == EINTR) {
|
||||
return 0; // Interrupted, not an error
|
||||
}
|
||||
return nread;
|
||||
}
|
||||
|
||||
// Platform-specific write for FreeBSD
|
||||
ssize_t tun_platform_write(struct tun_if* tun, const uint8_t* buf, size_t len) {
|
||||
return write(tun->fd, buf, len);
|
||||
}
|
||||
|
||||
// Get poll fd for uasync
|
||||
int tun_platform_get_poll_fd(struct tun_if* tun) {
|
||||
return tun->fd;
|
||||
}
|
||||
Reference in new issue
Block a user