1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (C) 2001 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
4  * Copyright (C) 2001 Lennert Buytenhek (buytenh@gnu.org) and
5  * James Leu (jleu@mindspring.net).
6  * Copyright (C) 2001 by various other people who didn't put their name here.
7  */
8 
9 #include <stdint.h>
10 #include <string.h>
11 #include <unistd.h>
12 #include <errno.h>
13 #include <sys/types.h>
14 #include <sys/socket.h>
15 #include <sys/time.h>
16 #include <sys/un.h>
17 #include "daemon.h"
18 #include <net_user.h>
19 #include <os.h>
20 #include <um_malloc.h>
21 
22 enum request_type { REQ_NEW_CONTROL };
23 
24 #define SWITCH_MAGIC 0xfeedface
25 
26 struct request_v3 {
27 	uint32_t magic;
28 	uint32_t version;
29 	enum request_type type;
30 	struct sockaddr_un sock;
31 };
32 
new_addr(void * name,int len)33 static struct sockaddr_un *new_addr(void *name, int len)
34 {
35 	struct sockaddr_un *sun;
36 
37 	sun = uml_kmalloc(sizeof(struct sockaddr_un), UM_GFP_KERNEL);
38 	if (sun == NULL) {
39 		printk(UM_KERN_ERR "new_addr: allocation of sockaddr_un "
40 		       "failed\n");
41 		return NULL;
42 	}
43 	sun->sun_family = AF_UNIX;
44 	memcpy(sun->sun_path, name, len);
45 	return sun;
46 }
47 
connect_to_switch(struct daemon_data * pri)48 static int connect_to_switch(struct daemon_data *pri)
49 {
50 	struct sockaddr_un *ctl_addr = pri->ctl_addr;
51 	struct sockaddr_un *local_addr = pri->local_addr;
52 	struct sockaddr_un *sun;
53 	struct request_v3 req;
54 	int fd, n, err;
55 
56 	pri->control = socket(AF_UNIX, SOCK_STREAM, 0);
57 	if (pri->control < 0) {
58 		err = -errno;
59 		printk(UM_KERN_ERR "daemon_open : control socket failed, "
60 		       "errno = %d\n", -err);
61 		return err;
62 	}
63 
64 	if (connect(pri->control, (struct sockaddr *) ctl_addr,
65 		   sizeof(*ctl_addr)) < 0) {
66 		err = -errno;
67 		printk(UM_KERN_ERR "daemon_open : control connect failed, "
68 		       "errno = %d\n", -err);
69 		goto out;
70 	}
71 
72 	fd = socket(AF_UNIX, SOCK_DGRAM, 0);
73 	if (fd < 0) {
74 		err = -errno;
75 		printk(UM_KERN_ERR "daemon_open : data socket failed, "
76 		       "errno = %d\n", -err);
77 		goto out;
78 	}
79 	if (bind(fd, (struct sockaddr *) local_addr, sizeof(*local_addr)) < 0) {
80 		err = -errno;
81 		printk(UM_KERN_ERR "daemon_open : data bind failed, "
82 		       "errno = %d\n", -err);
83 		goto out_close;
84 	}
85 
86 	sun = uml_kmalloc(sizeof(struct sockaddr_un), UM_GFP_KERNEL);
87 	if (sun == NULL) {
88 		printk(UM_KERN_ERR "new_addr: allocation of sockaddr_un "
89 		       "failed\n");
90 		err = -ENOMEM;
91 		goto out_close;
92 	}
93 
94 	req.magic = SWITCH_MAGIC;
95 	req.version = SWITCH_VERSION;
96 	req.type = REQ_NEW_CONTROL;
97 	req.sock = *local_addr;
98 	n = write(pri->control, &req, sizeof(req));
99 	if (n != sizeof(req)) {
100 		printk(UM_KERN_ERR "daemon_open : control setup request "
101 		       "failed, err = %d\n", -errno);
102 		err = -ENOTCONN;
103 		goto out_free;
104 	}
105 
106 	n = read(pri->control, sun, sizeof(*sun));
107 	if (n != sizeof(*sun)) {
108 		printk(UM_KERN_ERR "daemon_open : read of data socket failed, "
109 		       "err = %d\n", -errno);
110 		err = -ENOTCONN;
111 		goto out_free;
112 	}
113 
114 	pri->data_addr = sun;
115 	return fd;
116 
117  out_free:
118 	kfree(sun);
119  out_close:
120 	close(fd);
121  out:
122 	close(pri->control);
123 	return err;
124 }
125 
daemon_user_init(void * data,void * dev)126 static int daemon_user_init(void *data, void *dev)
127 {
128 	struct daemon_data *pri = data;
129 	struct timeval tv;
130 	struct {
131 		char zero;
132 		int pid;
133 		int usecs;
134 	} name;
135 
136 	if (!strcmp(pri->sock_type, "unix"))
137 		pri->ctl_addr = new_addr(pri->ctl_sock,
138 					 strlen(pri->ctl_sock) + 1);
139 	name.zero = 0;
140 	name.pid = os_getpid();
141 	gettimeofday(&tv, NULL);
142 	name.usecs = tv.tv_usec;
143 	pri->local_addr = new_addr(&name, sizeof(name));
144 	pri->dev = dev;
145 	pri->fd = connect_to_switch(pri);
146 	if (pri->fd < 0) {
147 		kfree(pri->local_addr);
148 		pri->local_addr = NULL;
149 		return pri->fd;
150 	}
151 
152 	return 0;
153 }
154 
daemon_open(void * data)155 static int daemon_open(void *data)
156 {
157 	struct daemon_data *pri = data;
158 	return pri->fd;
159 }
160 
daemon_remove(void * data)161 static void daemon_remove(void *data)
162 {
163 	struct daemon_data *pri = data;
164 
165 	close(pri->fd);
166 	pri->fd = -1;
167 	close(pri->control);
168 	pri->control = -1;
169 
170 	kfree(pri->data_addr);
171 	pri->data_addr = NULL;
172 	kfree(pri->ctl_addr);
173 	pri->ctl_addr = NULL;
174 	kfree(pri->local_addr);
175 	pri->local_addr = NULL;
176 }
177 
daemon_user_write(int fd,void * buf,int len,struct daemon_data * pri)178 int daemon_user_write(int fd, void *buf, int len, struct daemon_data *pri)
179 {
180 	struct sockaddr_un *data_addr = pri->data_addr;
181 
182 	return net_sendto(fd, buf, len, data_addr, sizeof(*data_addr));
183 }
184 
185 const struct net_user_info daemon_user_info = {
186 	.init		= daemon_user_init,
187 	.open		= daemon_open,
188 	.close	 	= NULL,
189 	.remove	 	= daemon_remove,
190 	.add_address	= NULL,
191 	.delete_address = NULL,
192 	.mtu		= ETH_MAX_PACKET,
193 	.max_packet	= ETH_MAX_PACKET + ETH_HEADER_OTHER,
194 };
195