xref: /OK3568_Linux_fs/kernel/arch/um/os-Linux/drivers/tuntap_user.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) 2001 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include <stdio.h>
7*4882a593Smuzhiyun #include <unistd.h>
8*4882a593Smuzhiyun #include <errno.h>
9*4882a593Smuzhiyun #include <string.h>
10*4882a593Smuzhiyun #include <linux/if_tun.h>
11*4882a593Smuzhiyun #include <net/if.h>
12*4882a593Smuzhiyun #include <sys/ioctl.h>
13*4882a593Smuzhiyun #include <sys/socket.h>
14*4882a593Smuzhiyun #include <sys/wait.h>
15*4882a593Smuzhiyun #include <sys/uio.h>
16*4882a593Smuzhiyun #include <kern_util.h>
17*4882a593Smuzhiyun #include <os.h>
18*4882a593Smuzhiyun #include "tuntap.h"
19*4882a593Smuzhiyun 
tuntap_user_init(void * data,void * dev)20*4882a593Smuzhiyun static int tuntap_user_init(void *data, void *dev)
21*4882a593Smuzhiyun {
22*4882a593Smuzhiyun 	struct tuntap_data *pri = data;
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun 	pri->dev = dev;
25*4882a593Smuzhiyun 	return 0;
26*4882a593Smuzhiyun }
27*4882a593Smuzhiyun 
tuntap_add_addr(unsigned char * addr,unsigned char * netmask,void * data)28*4882a593Smuzhiyun static void tuntap_add_addr(unsigned char *addr, unsigned char *netmask,
29*4882a593Smuzhiyun 			    void *data)
30*4882a593Smuzhiyun {
31*4882a593Smuzhiyun 	struct tuntap_data *pri = data;
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun 	tap_check_ips(pri->gate_addr, addr);
34*4882a593Smuzhiyun 	if ((pri->fd == -1) || pri->fixed_config)
35*4882a593Smuzhiyun 		return;
36*4882a593Smuzhiyun 	open_addr(addr, netmask, pri->dev_name);
37*4882a593Smuzhiyun }
38*4882a593Smuzhiyun 
tuntap_del_addr(unsigned char * addr,unsigned char * netmask,void * data)39*4882a593Smuzhiyun static void tuntap_del_addr(unsigned char *addr, unsigned char *netmask,
40*4882a593Smuzhiyun 			    void *data)
41*4882a593Smuzhiyun {
42*4882a593Smuzhiyun 	struct tuntap_data *pri = data;
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun 	if ((pri->fd == -1) || pri->fixed_config)
45*4882a593Smuzhiyun 		return;
46*4882a593Smuzhiyun 	close_addr(addr, netmask, pri->dev_name);
47*4882a593Smuzhiyun }
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun struct tuntap_pre_exec_data {
50*4882a593Smuzhiyun 	int stdout_fd;
51*4882a593Smuzhiyun 	int close_me;
52*4882a593Smuzhiyun };
53*4882a593Smuzhiyun 
tuntap_pre_exec(void * arg)54*4882a593Smuzhiyun static void tuntap_pre_exec(void *arg)
55*4882a593Smuzhiyun {
56*4882a593Smuzhiyun 	struct tuntap_pre_exec_data *data = arg;
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun 	dup2(data->stdout_fd, 1);
59*4882a593Smuzhiyun 	close(data->close_me);
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun 
tuntap_open_tramp(char * gate,int * fd_out,int me,int remote,char * buffer,int buffer_len,int * used_out)62*4882a593Smuzhiyun static int tuntap_open_tramp(char *gate, int *fd_out, int me, int remote,
63*4882a593Smuzhiyun 			     char *buffer, int buffer_len, int *used_out)
64*4882a593Smuzhiyun {
65*4882a593Smuzhiyun 	struct tuntap_pre_exec_data data;
66*4882a593Smuzhiyun 	char version_buf[sizeof("nnnnn\0")];
67*4882a593Smuzhiyun 	char *argv[] = { "uml_net", version_buf, "tuntap", "up", gate,
68*4882a593Smuzhiyun 			 NULL };
69*4882a593Smuzhiyun 	char buf[CMSG_SPACE(sizeof(*fd_out))];
70*4882a593Smuzhiyun 	struct msghdr msg;
71*4882a593Smuzhiyun 	struct cmsghdr *cmsg;
72*4882a593Smuzhiyun 	struct iovec iov;
73*4882a593Smuzhiyun 	int pid, n, err;
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun 	sprintf(version_buf, "%d", UML_NET_VERSION);
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun 	data.stdout_fd = remote;
78*4882a593Smuzhiyun 	data.close_me = me;
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun 	pid = run_helper(tuntap_pre_exec, &data, argv);
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	if (pid < 0)
83*4882a593Smuzhiyun 		return pid;
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun 	close(remote);
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 	msg.msg_name = NULL;
88*4882a593Smuzhiyun 	msg.msg_namelen = 0;
89*4882a593Smuzhiyun 	if (buffer != NULL) {
90*4882a593Smuzhiyun 		iov = ((struct iovec) { buffer, buffer_len });
91*4882a593Smuzhiyun 		msg.msg_iov = &iov;
92*4882a593Smuzhiyun 		msg.msg_iovlen = 1;
93*4882a593Smuzhiyun 	}
94*4882a593Smuzhiyun 	else {
95*4882a593Smuzhiyun 		msg.msg_iov = NULL;
96*4882a593Smuzhiyun 		msg.msg_iovlen = 0;
97*4882a593Smuzhiyun 	}
98*4882a593Smuzhiyun 	msg.msg_control = buf;
99*4882a593Smuzhiyun 	msg.msg_controllen = sizeof(buf);
100*4882a593Smuzhiyun 	msg.msg_flags = 0;
101*4882a593Smuzhiyun 	n = recvmsg(me, &msg, 0);
102*4882a593Smuzhiyun 	*used_out = n;
103*4882a593Smuzhiyun 	if (n < 0) {
104*4882a593Smuzhiyun 		err = -errno;
105*4882a593Smuzhiyun 		printk(UM_KERN_ERR "tuntap_open_tramp : recvmsg failed - "
106*4882a593Smuzhiyun 		       "errno = %d\n", errno);
107*4882a593Smuzhiyun 		return err;
108*4882a593Smuzhiyun 	}
109*4882a593Smuzhiyun 	helper_wait(pid);
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 	cmsg = CMSG_FIRSTHDR(&msg);
112*4882a593Smuzhiyun 	if (cmsg == NULL) {
113*4882a593Smuzhiyun 		printk(UM_KERN_ERR "tuntap_open_tramp : didn't receive a "
114*4882a593Smuzhiyun 		       "message\n");
115*4882a593Smuzhiyun 		return -EINVAL;
116*4882a593Smuzhiyun 	}
117*4882a593Smuzhiyun 	if ((cmsg->cmsg_level != SOL_SOCKET) ||
118*4882a593Smuzhiyun 	   (cmsg->cmsg_type != SCM_RIGHTS)) {
119*4882a593Smuzhiyun 		printk(UM_KERN_ERR "tuntap_open_tramp : didn't receive a "
120*4882a593Smuzhiyun 		       "descriptor\n");
121*4882a593Smuzhiyun 		return -EINVAL;
122*4882a593Smuzhiyun 	}
123*4882a593Smuzhiyun 	*fd_out = ((int *) CMSG_DATA(cmsg))[0];
124*4882a593Smuzhiyun 	os_set_exec_close(*fd_out);
125*4882a593Smuzhiyun 	return 0;
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun 
tuntap_open(void * data)128*4882a593Smuzhiyun static int tuntap_open(void *data)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun 	struct ifreq ifr;
131*4882a593Smuzhiyun 	struct tuntap_data *pri = data;
132*4882a593Smuzhiyun 	char *output, *buffer;
133*4882a593Smuzhiyun 	int err, fds[2], len, used;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	err = tap_open_common(pri->dev, pri->gate_addr);
136*4882a593Smuzhiyun 	if (err < 0)
137*4882a593Smuzhiyun 		return err;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	if (pri->fixed_config) {
140*4882a593Smuzhiyun 		pri->fd = os_open_file("/dev/net/tun",
141*4882a593Smuzhiyun 				       of_cloexec(of_rdwr(OPENFLAGS())), 0);
142*4882a593Smuzhiyun 		if (pri->fd < 0) {
143*4882a593Smuzhiyun 			printk(UM_KERN_ERR "Failed to open /dev/net/tun, "
144*4882a593Smuzhiyun 			       "err = %d\n", -pri->fd);
145*4882a593Smuzhiyun 			return pri->fd;
146*4882a593Smuzhiyun 		}
147*4882a593Smuzhiyun 		memset(&ifr, 0, sizeof(ifr));
148*4882a593Smuzhiyun 		ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
149*4882a593Smuzhiyun 		strlcpy(ifr.ifr_name, pri->dev_name, sizeof(ifr.ifr_name));
150*4882a593Smuzhiyun 		if (ioctl(pri->fd, TUNSETIFF, &ifr) < 0) {
151*4882a593Smuzhiyun 			err = -errno;
152*4882a593Smuzhiyun 			printk(UM_KERN_ERR "TUNSETIFF failed, errno = %d\n",
153*4882a593Smuzhiyun 			       errno);
154*4882a593Smuzhiyun 			close(pri->fd);
155*4882a593Smuzhiyun 			return err;
156*4882a593Smuzhiyun 		}
157*4882a593Smuzhiyun 	}
158*4882a593Smuzhiyun 	else {
159*4882a593Smuzhiyun 		err = socketpair(AF_UNIX, SOCK_DGRAM, 0, fds);
160*4882a593Smuzhiyun 		if (err) {
161*4882a593Smuzhiyun 			err = -errno;
162*4882a593Smuzhiyun 			printk(UM_KERN_ERR "tuntap_open : socketpair failed - "
163*4882a593Smuzhiyun 			       "errno = %d\n", errno);
164*4882a593Smuzhiyun 			return err;
165*4882a593Smuzhiyun 		}
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 		buffer = get_output_buffer(&len);
168*4882a593Smuzhiyun 		if (buffer != NULL)
169*4882a593Smuzhiyun 			len--;
170*4882a593Smuzhiyun 		used = 0;
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 		err = tuntap_open_tramp(pri->gate_addr, &pri->fd, fds[0],
173*4882a593Smuzhiyun 					fds[1], buffer, len, &used);
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 		output = buffer;
176*4882a593Smuzhiyun 		if (err < 0) {
177*4882a593Smuzhiyun 			printk("%s", output);
178*4882a593Smuzhiyun 			free_output_buffer(buffer);
179*4882a593Smuzhiyun 			printk(UM_KERN_ERR "tuntap_open_tramp failed - "
180*4882a593Smuzhiyun 			       "err = %d\n", -err);
181*4882a593Smuzhiyun 			return err;
182*4882a593Smuzhiyun 		}
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 		pri->dev_name = uml_strdup(buffer);
185*4882a593Smuzhiyun 		output += IFNAMSIZ;
186*4882a593Smuzhiyun 		printk("%s", output);
187*4882a593Smuzhiyun 		free_output_buffer(buffer);
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 		close(fds[0]);
190*4882a593Smuzhiyun 		iter_addresses(pri->dev, open_addr, pri->dev_name);
191*4882a593Smuzhiyun 	}
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	return pri->fd;
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun 
tuntap_close(int fd,void * data)196*4882a593Smuzhiyun static void tuntap_close(int fd, void *data)
197*4882a593Smuzhiyun {
198*4882a593Smuzhiyun 	struct tuntap_data *pri = data;
199*4882a593Smuzhiyun 
200*4882a593Smuzhiyun 	if (!pri->fixed_config)
201*4882a593Smuzhiyun 		iter_addresses(pri->dev, close_addr, pri->dev_name);
202*4882a593Smuzhiyun 	close(fd);
203*4882a593Smuzhiyun 	pri->fd = -1;
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun const struct net_user_info tuntap_user_info = {
207*4882a593Smuzhiyun 	.init		= tuntap_user_init,
208*4882a593Smuzhiyun 	.open		= tuntap_open,
209*4882a593Smuzhiyun 	.close	 	= tuntap_close,
210*4882a593Smuzhiyun 	.remove	 	= NULL,
211*4882a593Smuzhiyun 	.add_address	= tuntap_add_addr,
212*4882a593Smuzhiyun 	.delete_address = tuntap_del_addr,
213*4882a593Smuzhiyun 	.mtu		= ETH_MAX_PACKET,
214*4882a593Smuzhiyun 	.max_packet	= ETH_MAX_PACKET + ETH_HEADER_OTHER,
215*4882a593Smuzhiyun };
216