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