NetBSD/tests/net/fdpass/fdpass.c

/*	$NetBSD: fdpass.c,v 1.1 2012/08/13 11:15:05 christos Exp $	*/
/* $OpenBSD: monitor_fdpass.c,v 1.19 2010/01/12 00:58:25 djm Exp $ */
/*
 * Copyright 2001 Niels Provos <provos@citi.umich.edu>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__RCSID("$NetBSD: fdpass.c,v 1.1 2012/08/13 11:15:05 christos Exp $");
#include <sys/types.h>
#include <sys/socket.h>
#include <sys/uio.h>
#include <sys/wait.h>

#include <stdio.h>
#include <errno.h>
#include <err.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <poll.h>
#include <string.h>

static int debug;

static int
send_fd(int sock, int fd)
{
	struct msghdr msg;
	union {
		struct cmsghdr hdr;
		char buf[1024];
	} cmsgbuf;
	struct cmsghdr *cmsg;
	struct iovec vec;
	char ch = '\0';
	ssize_t n;
	struct pollfd pfd;

	if (sizeof(cmsgbuf.buf) < CMSG_SPACE(sizeof(int)))
		errx(1, "%s: %zu < %zu, recompile", __func__, 
		    sizeof(cmsgbuf.buf), CMSG_SPACE(sizeof(int)));

	memset(&msg, 0, sizeof(msg));
	msg.msg_control = &cmsgbuf.buf;
	msg.msg_controllen = CMSG_SPACE(sizeof(int));
	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;
	msg.msg_controllen = cmsg->cmsg_len;

	vec.iov_base = &ch;
	vec.iov_len = 1;
	msg.msg_iov = &vec;
	msg.msg_iovlen = 1;

	pfd.fd = sock;
	pfd.events = POLLOUT;
	while ((n = sendmsg(sock, &msg, 0)) == -1 &&
	    (errno == EAGAIN || errno == EINTR)) {
		(void)poll(&pfd, 1, -1);
	}
	switch (n) {
	case -1:
		err(1, "%s: sendmsg(%d)", __func__, fd);
	case 1:
		if (debug)
			fprintf(stderr, "%d: send fd %d\n", getpid(), fd);
		return 0;
	default:
		errx(1, "%s: sendmsg: expected sent 1 got %ld",
		    __func__, (long)n);
	}
}

static int
recv_fd(int sock)
{
	struct msghdr msg;
	union {
		struct cmsghdr hdr;
		char buf[1024];
	} cmsgbuf;
	struct cmsghdr *cmsg;
	struct iovec vec;
	ssize_t n;
	char ch;
	int fd;
	struct pollfd pfd;

	if (sizeof(cmsgbuf.buf) < CMSG_SPACE(sizeof(int)))
		errx(1, "%s: %zu < %zu, recompile", __func__, 
		    sizeof(cmsgbuf.buf), CMSG_SPACE(sizeof(int)));

	memset(&msg, 0, sizeof(msg));
	vec.iov_base = &ch;
	vec.iov_len = 1;
	msg.msg_iov = &vec;
	msg.msg_iovlen = 1;
	msg.msg_control = &cmsgbuf.buf;
	msg.msg_controllen = CMSG_SPACE(sizeof(int));

	pfd.fd = sock;
	pfd.events = POLLIN;
	while ((n = recvmsg(sock, &msg, 0)) == -1 &&
	    (errno == EAGAIN || errno == EINTR)) {
		(void)poll(&pfd, 1, -1);
	}
	switch (n) {
	case -1:
		err(1, "%s: recvmsg", __func__);
	case 1:
		break;
	default:
		errx(1, "%s: recvmsg: expected received 1 got %ld",
		    __func__, (long)n);
	}

	cmsg = CMSG_FIRSTHDR(&msg);
	if (cmsg == NULL)
		errx(1, "%s: no message header", __func__);

	if (cmsg->cmsg_type != SCM_RIGHTS)
		err(1, "%s: expected type %d got %d", __func__,
		    SCM_RIGHTS, cmsg->cmsg_type);
	fd = (*(int *)CMSG_DATA(cmsg));
	if (debug)
		fprintf(stderr, "%d: recv fd %d\n", getpid(), fd);
	return fd;
}

static void usage(void) __attribute__((__noreturn__));

static void
usage(void)
{
	fprintf(stderr, "Usage: %s [-vd] -i <input> -o <output>\n"
	    "\t %s [-v] -p <progname>\n", getprogname(), getprogname());
	exit(EXIT_FAILURE);
}

int
main(int argc, char *argv[])
{
	int s[2], fd, status, c, verbose;
	char buf[1024], *prog;

	prog = NULL;
	s[0] = s[1] = -1;
	verbose = 0;

	while ((c = getopt(argc, argv, "di:o:p:")) != -1)
		switch (c) {
		case 'd':
			debug++;
			break;
		case 'i':
			s[0] = atoi(optarg);
			break;
		case 'o':
			s[1] = atoi(optarg);
			break;
		case 'p':
			prog = optarg;
			break;
		default:
			usage();
		}

	if ((s[0] == -1 && s[1] != -1) || (s[0] != -1 && s[1] == -1))
		usage();

	if (s[0] == -1) {
		if (socketpair(AF_LOCAL, SOCK_DGRAM, 0, s) == -1)
			err(1, "socketpair");
	} else
		goto recv;

	switch (fork()) {
	case -1:
		err(1, "fork");
	default:
		fd = open("foo", O_RDWR|O_CREAT|O_TRUNC, 0666);
		if (fd == -1)
			err(1, "open");
		send_fd(s[0], fd);
		wait(&status);
		return 0;
	case 0:
		if (prog != NULL) {
			char i[64], o[64];
			snprintf(i, sizeof(i), "%d", s[0]);
			snprintf(o, sizeof(o), "%d", s[1]);
			execlp(prog, prog, "-i", i, "-o", o, NULL);
			err(1, "execlp");
		}
	recv:
		fd = recv_fd(s[1]);
		if (verbose) {
			snprintf(buf, sizeof(buf), "ls -l /proc/%d/fd",
			    getpid());
			system(buf);
		}
		if (write(fd, "foo\n", 4) == -1)
			err(1, "write");
		close(fd);
		return 0;
	}
}