mirror of
https://github.com/zerotier/ZeroTierOne.git
synced 2024-12-24 07:06:39 +00:00
138 lines
3.1 KiB
C++
138 lines
3.1 KiB
C++
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <stdio.h>
|
|
#include <sys/socket.h>
|
|
|
|
#include "lwip/ip.h"
|
|
#include "lwip/ip_addr.h"
|
|
#include "lwip/ip_frag.h"
|
|
|
|
#ifndef _NETCON_UTILITIES_CPP
|
|
#define _NETCON_UTILITIES_CPP
|
|
|
|
namespace ZeroTier
|
|
{
|
|
/*
|
|
ip_addr_t convert_ip(struct sockaddr_in * addr)
|
|
{
|
|
ip_addr_t conn_addr;
|
|
struct sockaddr_in *ipv4 = addr;
|
|
short a = ip4_addr1(&(ipv4->sin_addr));
|
|
short b = ip4_addr2(&(ipv4->sin_addr));
|
|
short c = ip4_addr3(&(ipv4->sin_addr));
|
|
short d = ip4_addr4(&(ipv4->sin_addr));
|
|
IP4_ADDR(&conn_addr, a,b,c,d);
|
|
return conn_addr;
|
|
}
|
|
*/
|
|
|
|
/*
|
|
ip_addr_t ip_addr_sin(register struct sockaddr_in *sin) {
|
|
ip_addr_t ip;
|
|
*((struct sockaddr_in*) &ip) = *sin;
|
|
return ip;
|
|
}
|
|
*/
|
|
// Functions used to pass file descriptors between processes
|
|
|
|
ssize_t sock_fd_write(int sock, int fd)
|
|
{
|
|
ssize_t size;
|
|
struct msghdr msg;
|
|
struct iovec iov;
|
|
char buf = '\0';
|
|
int buflen = 1;
|
|
|
|
union
|
|
{
|
|
struct cmsghdr cmsghdr;
|
|
char control[CMSG_SPACE(sizeof (int))];
|
|
} cmsgu;
|
|
struct cmsghdr *cmsg;
|
|
|
|
iov.iov_base = &buf;
|
|
iov.iov_len = buflen;
|
|
|
|
msg.msg_name = NULL;
|
|
msg.msg_namelen = 0;
|
|
msg.msg_iov = &iov;
|
|
msg.msg_iovlen = 1;
|
|
|
|
if (fd != -1) {
|
|
msg.msg_control = cmsgu.control;
|
|
msg.msg_controllen = sizeof(cmsgu.control);
|
|
cmsg = CMSG_FIRSTHDR(&msg);
|
|
cmsg->cmsg_len = CMSG_LEN(sizeof (int));
|
|
cmsg->cmsg_level = SOL_SOCKET;
|
|
cmsg->cmsg_type = SCM_RIGHTS;
|
|
*((int *) CMSG_DATA(cmsg)) = fd;
|
|
} else {
|
|
msg.msg_control = NULL;
|
|
msg.msg_controllen = 0;
|
|
}
|
|
|
|
size = sendmsg(sock, &msg, 0);
|
|
if (size < 0)
|
|
perror ("sendmsg");
|
|
return size;
|
|
}
|
|
|
|
|
|
ssize_t sock_fd_read(int sock, void *buf, ssize_t bufsize, int *fd)
|
|
{
|
|
ssize_t size;
|
|
|
|
if (fd) {
|
|
struct msghdr msg;
|
|
struct iovec iov;
|
|
union
|
|
{
|
|
struct cmsghdr cmsghdr;
|
|
char control[CMSG_SPACE(sizeof (int))];
|
|
} cmsgu;
|
|
struct cmsghdr *cmsg;
|
|
|
|
iov.iov_base = buf;
|
|
iov.iov_len = bufsize;
|
|
|
|
msg.msg_name = NULL;
|
|
msg.msg_namelen = 0;
|
|
msg.msg_iov = &iov;
|
|
msg.msg_iovlen = 1;
|
|
msg.msg_control = cmsgu.control;
|
|
msg.msg_controllen = sizeof(cmsgu.control);
|
|
size = recvmsg (sock, &msg, 0);
|
|
if (size < 0) {
|
|
perror ("recvmsg");
|
|
exit(1);
|
|
}
|
|
cmsg = CMSG_FIRSTHDR(&msg);
|
|
if (cmsg && cmsg->cmsg_len == CMSG_LEN(sizeof(int))) {
|
|
if (cmsg->cmsg_level != SOL_SOCKET) {
|
|
fprintf (stderr, "invalid cmsg_level %d\n",
|
|
cmsg->cmsg_level);
|
|
exit(1);
|
|
}
|
|
if (cmsg->cmsg_type != SCM_RIGHTS) {
|
|
fprintf (stderr, "invalid cmsg_type %d\n",
|
|
cmsg->cmsg_type);
|
|
exit(1);
|
|
}
|
|
|
|
*fd = *((int *) CMSG_DATA(cmsg));
|
|
} else
|
|
*fd = -1;
|
|
} else {
|
|
size = read (sock, buf, bufsize);
|
|
if (size < 0) {
|
|
perror("read");
|
|
exit(1);
|
|
}
|
|
}
|
|
return size;
|
|
}
|
|
}
|
|
|
|
#endif
|