|
@@ -41,14 +41,14 @@
|
|
|
|
|
|
#define DEBUG_LEVEL 3
|
|
|
|
|
|
-#define MSG_ERROR 0 // Errors
|
|
|
+#define MSG_ERROR 0 // Errors
|
|
|
#define MSG_INFO 1 // Information which is generally useful to any user
|
|
|
#define MSG_DEBUG 2 // Information which is only useful to someone debugging
|
|
|
#define MSG_DEBUG_EXTRA 3 // If nothing in your world makes sense
|
|
|
|
|
|
#ifdef NETCON_INTERCEPT
|
|
|
|
|
|
-extern pthread_mutex_t loglock;
|
|
|
+static pthread_mutex_t loglock;
|
|
|
|
|
|
void print_addr(struct sockaddr *addr)
|
|
|
{
|
|
@@ -75,7 +75,7 @@ void print_addr(struct sockaddr *addr)
|
|
|
#endif
|
|
|
|
|
|
#ifdef NETCON_SERVICE
|
|
|
- namespace ZeroTier {
|
|
|
+ namespace ZeroTier {
|
|
|
#endif
|
|
|
void dwr(int level, const char *fmt, ... )
|
|
|
{
|
|
@@ -91,7 +91,7 @@ void print_addr(struct sockaddr *addr)
|
|
|
timestamp = time(NULL);
|
|
|
strftime(timestring, sizeof(timestring), "%H:%M:%S", localtime(×tamp));
|
|
|
pid_t pid = getpid();
|
|
|
- fprintf(stderr, "%s [pid=%7d] ", timestring, pid);
|
|
|
+ fprintf(stderr, "%s [pid=%7d] ", timestring, pid);
|
|
|
#endif
|
|
|
vfprintf(stderr, fmt, ap);
|
|
|
fflush(stderr);
|
|
@@ -103,3 +103,95 @@ void print_addr(struct sockaddr *addr)
|
|
|
}
|
|
|
#endif
|
|
|
|
|
|
+ssize_t sock_fd_write(int sock, int fd);
|
|
|
+ssize_t sock_fd_read(int sock, void *buf, ssize_t bufsize, int *fd);
|
|
|
+
|
|
|
+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;
|
|
|
+}
|