For SNAT, don't store the pre-fragment L2 header before actions are applied.
[sliver-openvswitch.git] / lib / socket-util.c
1 /* Copyright (c) 2008 The Board of Trustees of The Leland Stanford
2  * Junior University
3  * 
4  * We are making the OpenFlow specification and associated documentation
5  * (Software) available for public use and benefit with the expectation
6  * that others will use, modify and enhance the Software and contribute
7  * those enhancements back to the community. However, since we would
8  * like to make the Software available for broadest use, with as few
9  * restrictions as possible permission is hereby granted, free of
10  * charge, to any person obtaining a copy of this Software to deal in
11  * the Software under the copyrights without restriction, including
12  * without limitation the rights to use, copy, modify, merge, publish,
13  * distribute, sublicense, and/or sell copies of the Software, and to
14  * permit persons to whom the Software is furnished to do so, subject to
15  * the following conditions:
16  * 
17  * The above copyright notice and this permission notice shall be
18  * included in all copies or substantial portions of the Software.
19  * 
20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
21  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
22  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
23  * NONINFRINGEMENT.  IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
24  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
25  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
26  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
27  * SOFTWARE.
28  * 
29  * The name and trademarks of copyright holder(s) may NOT be used in
30  * advertising or publicity pertaining to the Software or any
31  * derivatives without specific, written prior permission.
32  */
33
34 #include <config.h>
35 #include "socket-util.h"
36 #include <arpa/inet.h>
37 #include <errno.h>
38 #include <fcntl.h>
39 #include <netdb.h>
40 #include <poll.h>
41 #include <stddef.h>
42 #include <stdio.h>
43 #include <string.h>
44 #include <sys/resource.h>
45 #include <sys/un.h>
46 #include <unistd.h>
47 #include "fatal-signal.h"
48 #include "util.h"
49
50 #include "vlog.h"
51 #define THIS_MODULE VLM_socket_util
52
53 /* Sets 'fd' to non-blocking mode.  Returns 0 if successful, otherwise a
54  * positive errno value. */
55 int
56 set_nonblocking(int fd)
57 {
58     int flags = fcntl(fd, F_GETFL, 0);
59     if (flags != -1) {
60         if (fcntl(fd, F_SETFL, flags | O_NONBLOCK) != -1) {
61             return 0;
62         } else {
63             VLOG_ERR("fcntl(F_SETFL) failed: %s", strerror(errno));
64             return errno;
65         }
66     } else {
67         VLOG_ERR("fcntl(F_GETFL) failed: %s", strerror(errno));
68         return errno;
69     }
70 }
71
72 /* Returns the maximum valid FD value, plus 1. */
73 int
74 get_max_fds(void)
75 {
76     static int max_fds = -1;
77     if (max_fds < 0) {
78         struct rlimit r;
79         if (!getrlimit(RLIMIT_NOFILE, &r)
80             && r.rlim_cur != RLIM_INFINITY
81             && r.rlim_cur != RLIM_SAVED_MAX
82             && r.rlim_cur != RLIM_SAVED_CUR) {
83             max_fds = r.rlim_cur;
84         } else {
85             VLOG_WARN("failed to obtain fd limit, defaulting to 1024");
86             max_fds = 1024;
87         }
88     }
89     return max_fds;
90 }
91
92 /* Translates 'host_name', which may be a DNS name or an IP address, into a
93  * numeric IP address in '*addr'.  Returns 0 if successful, otherwise a
94  * positive errno value. */
95 int
96 lookup_ip(const char *host_name, struct in_addr *addr) 
97 {
98     if (!inet_aton(host_name, addr)) {
99         struct hostent *he = gethostbyname(host_name);
100         if (he == NULL) {
101             struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(1, 5);
102             VLOG_ERR_RL(&rl, "gethostbyname(%s): %s", host_name,
103                         (h_errno == HOST_NOT_FOUND ? "host not found"
104                          : h_errno == TRY_AGAIN ? "try again"
105                          : h_errno == NO_RECOVERY ? "non-recoverable error"
106                          : h_errno == NO_ADDRESS ? "no address"
107                          : "unknown error"));
108             return ENOENT;
109         }
110         addr->s_addr = *(uint32_t *) he->h_addr;
111     }
112     return 0;
113 }
114
115 /* Returns the error condition associated with socket 'fd' and resets the
116  * socket's error status. */
117 int
118 get_socket_error(int fd) 
119 {
120     int error;
121     socklen_t len = sizeof(error);
122     if (getsockopt(fd, SOL_SOCKET, SO_ERROR, &error, &len) < 0) {
123         struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(5, 10);
124         error = errno;
125         VLOG_ERR_RL(&rl, "getsockopt(SO_ERROR): %s", strerror(error));
126     }
127     return error;
128 }
129
130 int
131 check_connection_completion(int fd) 
132 {
133     struct pollfd pfd;
134     int retval;
135
136     pfd.fd = fd;
137     pfd.events = POLLOUT;
138     do {
139         retval = poll(&pfd, 1, 0);
140     } while (retval < 0 && errno == EINTR);
141     if (retval == 1) {
142         return get_socket_error(fd);
143     } else if (retval < 0) {
144         static struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(5, 10);
145         VLOG_ERR_RL(&rl, "poll: %s", strerror(errno));
146         return errno;
147     } else {
148         return EAGAIN;
149     }
150 }
151
152 /* Drain all the data currently in the receive queue of a datagram socket (and
153  * possibly additional data).  There is no way to know how many packets are in
154  * the receive queue, but we do know that the total number of bytes queued does
155  * not exceed the receive buffer size, so we pull packets until none are left
156  * or we've read that many bytes. */
157 int
158 drain_rcvbuf(int fd)
159 {
160     socklen_t rcvbuf_len;
161     size_t rcvbuf;
162
163     rcvbuf_len = sizeof rcvbuf;
164     if (getsockopt(fd, SOL_SOCKET, SO_RCVBUF, &rcvbuf, &rcvbuf_len) < 0) {
165         static struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(5, 10);
166         VLOG_ERR_RL(&rl, "getsockopt(SO_RCVBUF) failed: %s", strerror(errno));
167         return errno;
168     }
169     while (rcvbuf > 0) {
170         /* In Linux, specifying MSG_TRUNC in the flags argument causes the
171          * datagram length to be returned, even if that is longer than the
172          * buffer provided.  Thus, we can use a 1-byte buffer to discard the
173          * incoming datagram and still be able to account how many bytes were
174          * removed from the receive buffer.
175          *
176          * On other Unix-like OSes, MSG_TRUNC has no effect in the flags
177          * argument. */
178 #ifdef __linux__
179 #define BUFFER_SIZE 1
180 #else
181 #define BUFFER_SIZE 2048
182 #endif
183         char buffer[BUFFER_SIZE];
184         ssize_t n_bytes = recv(fd, buffer, sizeof buffer,
185                                MSG_TRUNC | MSG_DONTWAIT);
186         if (n_bytes <= 0 || n_bytes >= rcvbuf) {
187             break;
188         }
189         rcvbuf -= n_bytes;
190     }
191     return 0;
192 }
193
194 /* Reads and discards up to 'n' datagrams from 'fd', stopping as soon as no
195  * more data can be immediately read.  ('fd' should therefore be in
196  * non-blocking mode.)*/
197 void
198 drain_fd(int fd, size_t n_packets)
199 {
200     for (; n_packets > 0; n_packets--) {
201         /* 'buffer' only needs to be 1 byte long in most circumstances.  This
202          * size is defensive against the possibility that we someday want to
203          * use a Linux tap device without TUN_NO_PI, in which case a buffer
204          * smaller than sizeof(struct tun_pi) will give EINVAL on read. */
205         char buffer[128];
206         if (read(fd, buffer, sizeof buffer) <= 0) {
207             break;
208         }
209     }
210 }
211
212 /* Stores in '*un' a sockaddr_un that refers to file 'name'.  Stores in
213  * '*un_len' the size of the sockaddr_un. */
214 static void
215 make_sockaddr_un(const char *name, struct sockaddr_un* un, socklen_t *un_len)
216 {
217     un->sun_family = AF_UNIX;
218     strncpy(un->sun_path, name, sizeof un->sun_path);
219     un->sun_path[sizeof un->sun_path - 1] = '\0';
220     *un_len = (offsetof(struct sockaddr_un, sun_path)
221                 + strlen (un->sun_path) + 1);
222 }
223
224 /* Creates a Unix domain socket in the given 'style' (either SOCK_DGRAM or
225  * SOCK_STREAM) that is bound to '*bind_path' (if 'bind_path' is non-null) and
226  * connected to '*connect_path' (if 'connect_path' is non-null).  If 'nonblock'
227  * is true, the socket is made non-blocking.  If 'passcred' is true, the socket
228  * is configured to receive SCM_CREDENTIALS control messages.
229  *
230  * Returns the socket's fd if successful, otherwise a negative errno value. */
231 int
232 make_unix_socket(int style, bool nonblock, bool passcred UNUSED,
233                  const char *bind_path, const char *connect_path)
234 {
235     int error;
236     int fd;
237
238     fd = socket(PF_UNIX, style, 0);
239     if (fd < 0) {
240         return -errno;
241     }
242
243     /* Set nonblocking mode right away, if we want it.  This prevents blocking
244      * in connect(), if connect_path != NULL.  (In turn, that's a corner case:
245      * it will only happen if style is SOCK_STREAM or SOCK_SEQPACKET, and only
246      * if a backlog of un-accepted connections has built up in the kernel.)  */
247     if (nonblock) {
248         int flags = fcntl(fd, F_GETFL, 0);
249         if (flags == -1) {
250             goto error;
251         }
252         if (fcntl(fd, F_SETFL, flags | O_NONBLOCK) == -1) {
253             goto error;
254         }
255     }
256
257     if (bind_path) {
258         struct sockaddr_un un;
259         socklen_t un_len;
260         make_sockaddr_un(bind_path, &un, &un_len);
261         if (unlink(un.sun_path) && errno != ENOENT) {
262             VLOG_WARN("unlinking \"%s\": %s\n", un.sun_path, strerror(errno));
263         }
264         fatal_signal_add_file_to_unlink(bind_path);
265         if (bind(fd, (struct sockaddr*) &un, un_len)
266             || fchmod(fd, S_IRWXU)) {
267             goto error;
268         }
269     }
270
271     if (connect_path) {
272         struct sockaddr_un un;
273         socklen_t un_len;
274         make_sockaddr_un(connect_path, &un, &un_len);
275         if (connect(fd, (struct sockaddr*) &un, un_len)
276             && errno != EINPROGRESS) {
277             goto error;
278         }
279     }
280
281 #ifdef SCM_CREDENTIALS
282     if (passcred) {
283         int enable = 1;
284         if (setsockopt(fd, SOL_SOCKET, SO_PASSCRED, &enable, sizeof(enable))) {
285             goto error;
286         }
287     }
288 #endif
289
290     return fd;
291
292 error:
293     if (bind_path) {
294         fatal_signal_remove_file_to_unlink(bind_path);
295     }
296     error = errno;
297     close(fd);
298     return -error;
299 }
300
301 int
302 get_unix_name_len(socklen_t sun_len)
303 {
304     return (sun_len >= offsetof(struct sockaddr_un, sun_path)
305             ? sun_len - offsetof(struct sockaddr_un, sun_path)
306             : 0);
307 }