source: trunk/debian/packages/libubox/trunk/usock.c @ 857

Last change on this file since 857 was 857, checked in by amain, 4 years ago

libubox: initial import / part 4

File size: 6.5 KB
Line 
1/*
2 * usock - socket helper functions
3 *
4 * Copyright (C) 2010 Steven Barth <steven@midlink.org>
5 * Copyright (C) 2011-2012 Felix Fietkau <nbd@openwrt.org>
6 *
7 * Permission to use, copy, modify, and/or distribute this software for any
8 * purpose with or without fee is hereby granted, provided that the above
9 * copyright notice and this permission notice appear in all copies.
10 *
11 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 */
19#include <sys/types.h>
20#include <sys/socket.h>
21#include <sys/un.h>
22#include <netdb.h>
23#include <poll.h>
24#include <stdlib.h>
25#include <unistd.h>
26#include <fcntl.h>
27#include <errno.h>
28#include <string.h>
29#include <stdbool.h>
30#include <stdio.h>
31#include <poll.h>
32
33#include "usock.h"
34#include "utils.h"
35
36static void usock_set_flags(int sock, unsigned int type)
37{
38        if (!(type & USOCK_NOCLOEXEC))
39                fcntl(sock, F_SETFD, fcntl(sock, F_GETFD) | FD_CLOEXEC);
40
41        if (type & USOCK_NONBLOCK)
42                fcntl(sock, F_SETFL, fcntl(sock, F_GETFL) | O_NONBLOCK);
43}
44
45static int usock_connect(int type, struct sockaddr *sa, int sa_len, int family, int socktype, bool server)
46{
47        int sock;
48
49        sock = socket(family, socktype, 0);
50        if (sock < 0)
51                return -1;
52
53        usock_set_flags(sock, type);
54
55        if (server) {
56                const int one = 1;
57                setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, &one, sizeof(one));
58
59                if (!bind(sock, sa, sa_len) &&
60                    (socktype != SOCK_STREAM || !listen(sock, SOMAXCONN)))
61                        return sock;
62        } else {
63                if (!connect(sock, sa, sa_len) || errno == EINPROGRESS)
64                        return sock;
65        }
66
67        close(sock);
68        return -1;
69}
70
71static int usock_unix(int type, const char *host)
72{
73        struct sockaddr_un sun = {.sun_family = AF_UNIX};
74        bool server = !!(type & USOCK_SERVER);
75        int socktype = ((type & 0xff) == USOCK_TCP) ? SOCK_STREAM : SOCK_DGRAM;
76
77        if (strlen(host) >= sizeof(sun.sun_path)) {
78                errno = EINVAL;
79                return -1;
80        }
81        strcpy(sun.sun_path, host);
82
83        return usock_connect(type, (struct sockaddr*)&sun, sizeof(sun), AF_UNIX, socktype, server);
84}
85
86static int
87usock_inet_notimeout(int type, struct addrinfo *result, void *addr)
88{
89        struct addrinfo *rp;
90        int socktype = ((type & 0xff) == USOCK_TCP) ? SOCK_STREAM : SOCK_DGRAM;
91        bool server = !!(type & USOCK_SERVER);
92        int sock;
93
94        for (rp = result; rp != NULL; rp = rp->ai_next) {
95                sock = usock_connect(type, rp->ai_addr, rp->ai_addrlen, rp->ai_family, socktype, server);
96                if (sock >= 0) {
97                        if (addr)
98                                memcpy(addr, rp->ai_addr, rp->ai_addrlen);
99                        return sock;
100                }
101        }
102
103        return -1;
104}
105
106static int poll_restart(struct pollfd *fds, int nfds, int timeout)
107{
108        struct timespec ts, cur;
109        int msec = timeout % 1000;
110        int ret;
111
112        clock_gettime(CLOCK_MONOTONIC, &ts);
113
114        ts.tv_nsec += msec * 1000000;
115        if (ts.tv_nsec > 1000000000) {
116                ts.tv_sec++;
117                ts.tv_nsec -= 1000000000;
118        }
119        ts.tv_sec += timeout / 1000;
120
121        while (1) {
122                ret = poll(fds, nfds, timeout);
123                if (ret == EAGAIN)
124                        continue;
125
126                if (ret != EINTR)
127                        return ret;
128
129                clock_gettime(CLOCK_MONOTONIC, &cur);
130                timeout = (ts.tv_sec - cur.tv_sec) * 1000;
131                timeout += (ts.tv_nsec - cur.tv_nsec) / 1000000;
132                if (timeout <= 0)
133                        return 0;
134        }
135}
136
137int usock_inet_timeout(int type, const char *host, const char *service,
138                       void *addr, int timeout)
139{
140        int socktype = ((type & 0xff) == USOCK_TCP) ? SOCK_STREAM : SOCK_DGRAM;
141        bool server = !!(type & USOCK_SERVER);
142        struct addrinfo *result, *rp;
143        struct addrinfo hints = {
144                .ai_family = (type & USOCK_IPV6ONLY) ? AF_INET6 :
145                        (type & USOCK_IPV4ONLY) ? AF_INET : AF_UNSPEC,
146                .ai_socktype = socktype,
147                .ai_flags = AI_ADDRCONFIG
148                        | ((type & USOCK_SERVER) ? AI_PASSIVE : 0)
149                        | ((type & USOCK_NUMERIC) ? AI_NUMERICHOST : 0),
150        };
151        struct addrinfo *rp_v6 = NULL;
152        struct addrinfo *rp_v4 = NULL;
153        struct pollfd pfds[2] = {
154            { .fd = -1, .events = POLLOUT },
155            { .fd = -1, .events = POLLOUT },
156        };
157        int sock = -1;
158        int i;
159
160        if (getaddrinfo(host, service, &hints, &result))
161                return -1;
162
163        if (timeout <= 0 || server) {
164                sock = usock_inet_notimeout(type, result, addr);
165                goto free_addrinfo;
166        }
167
168        for (rp = result; rp != NULL; rp = rp->ai_next) {
169                if (rp->ai_family == AF_INET6 && !rp_v6)
170                        rp_v6 = rp;
171                if (rp->ai_family == AF_INET && !rp_v4)
172                        rp_v4 = rp;
173        }
174
175        if (!rp_v6 && !rp_v4)
176                goto out;
177
178        if (rp_v6) {
179                rp = rp_v6;
180                pfds[0].fd = usock_connect(type | USOCK_NONBLOCK, rp->ai_addr,
181                                           rp->ai_addrlen, rp->ai_family,
182                                           socktype, server);
183                if (pfds[0].fd < 0) {
184                        rp_v6 = NULL;
185                        goto try_v4;
186                }
187
188                if (timeout > 300) {
189                        if (poll_restart(pfds, 1, 300) == 1) {
190                                rp = rp_v6;
191                                sock = pfds[0].fd;
192                                goto out;
193                        }
194                }
195                timeout -= 300;
196        }
197
198try_v4:
199        if (rp_v4) {
200                rp = rp_v4;
201                pfds[1].fd = usock_connect(type | USOCK_NONBLOCK, rp->ai_addr,
202                                                 rp->ai_addrlen, rp->ai_family,
203                                                 socktype, server);
204                if (pfds[1].fd < 0) {
205                        rp_v4 = NULL;
206                        if (!rp_v6)
207                                goto out;
208                        goto wait;
209                }
210        }
211
212wait:
213        poll_restart(pfds + !rp_v6, !!rp_v6 + !!rp_v4, timeout);
214        if (pfds[0].revents & POLLOUT) {
215                rp = rp_v6;
216                sock = pfds[0].fd;
217                goto out;
218        }
219
220        if (pfds[1].revents & POLLOUT) {
221                rp = rp_v4;
222                sock = pfds[1].fd;
223                goto out;
224        }
225
226out:
227        for (i = 0; i < 2; i++) {
228                int fd = pfds[i].fd;
229                if (fd >= 0 && fd != sock)
230                        close(fd);
231        }
232
233        if (!(type & USOCK_NONBLOCK))
234                fcntl(sock, F_SETFL, fcntl(sock, F_GETFL) & ~O_NONBLOCK);
235
236        if (addr && sock >= 0)
237                memcpy(addr, rp->ai_addr, rp->ai_addrlen);
238free_addrinfo:
239        freeaddrinfo(result);
240        return sock;
241}
242
243const char *usock_port(int port)
244{
245        static char buffer[sizeof("65535\0")];
246
247        if (port < 0 || port > 65535)
248                return NULL;
249
250        snprintf(buffer, sizeof(buffer), "%u", port);
251
252        return buffer;
253}
254
255int usock(int type, const char *host, const char *service) {
256        int sock;
257
258        if (type & USOCK_UNIX)
259                sock = usock_unix(type, host);
260        else
261                sock = usock_inet(type, host, service, NULL);
262
263        if (sock < 0)
264                return -1;
265
266        return sock;
267}
268
269int usock_wait_ready(int fd, int msecs) {
270        struct pollfd fds[1];
271        int res;
272
273        fds[0].fd = fd;
274        fds[0].events = POLLOUT;
275
276        res = poll(fds, 1, msecs);
277        if (res < 0) {
278                return errno;
279        } else if (res == 0) {
280                return -ETIMEDOUT;
281        } else {
282                int err = 0;
283                socklen_t optlen = sizeof(err);
284
285                res = getsockopt(fd, SOL_SOCKET, SO_ERROR, &err, &optlen);
286                if (res)
287                        return errno;
288                if (err)
289                        return err;
290        }
291
292        return 0;
293}
Note: See TracBrowser for help on using the repository browser.