2 * Copyright (C) 2006-2008 Stig Venaas <venaas@uninett.no>
4 * Permission to use, copy, modify, and distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
9 #include <sys/socket.h>
10 #include <netinet/in.h>
18 #include <sys/select.h>
23 char *stringcopy(const char *s, int len) {
31 debug(DBG_ERR, "stringcopy: malloc failed");
37 void printfchars(char *prefixfmt, char *prefix, char *charfmt, char *chars, int len) {
39 unsigned char *s = (unsigned char *)chars;
41 printf(prefixfmt ? prefixfmt : "%s: ", prefix);
42 for (i = 0; i < len; i++)
43 printf(charfmt ? charfmt : "%c", s[i]);
47 void port_set(struct sockaddr *sa, uint16_t port) {
48 switch (sa->sa_family) {
50 ((struct sockaddr_in *)sa)->sin_port = htons(port);
53 ((struct sockaddr_in6 *)sa)->sin6_port = htons(port);
58 struct sockaddr *addr_copy(struct sockaddr *in) {
59 struct sockaddr *out = NULL;
61 switch (in->sa_family) {
63 out = malloc(sizeof(struct sockaddr_in));
65 memset(out, 0, sizeof(struct sockaddr_in));
66 ((struct sockaddr_in *)out)->sin_addr = ((struct sockaddr_in *)in)->sin_addr;
70 out = malloc(sizeof(struct sockaddr_in6));
72 memset(out, 0, sizeof(struct sockaddr_in6));
73 ((struct sockaddr_in6 *)out)->sin6_addr = ((struct sockaddr_in6 *)in)->sin6_addr;
77 out->sa_family = in->sa_family;
81 char *addr2string(struct sockaddr *addr) {
82 struct sockaddr_in6 *sa6;
83 struct sockaddr_in sa4;
84 static char addr_buf[2][INET6_ADDRSTRLEN];
87 if (addr->sa_family == AF_INET6) {
88 sa6 = (struct sockaddr_in6 *)addr;
89 if (IN6_IS_ADDR_V4MAPPED(&sa6->sin6_addr)) {
90 memset(&sa4, 0, sizeof(sa4));
91 sa4.sin_family = AF_INET;
92 sa4.sin_port = sa6->sin6_port;
93 memcpy(&sa4.sin_addr, &sa6->sin6_addr.s6_addr[12], 4);
94 addr = (struct sockaddr *)&sa4;
97 if (getnameinfo(addr, SOCKADDRP_SIZE(addr), addr_buf[i], sizeof(addr_buf[i]),
98 NULL, 0, NI_NUMERICHOST)) {
99 debug(DBG_WARN, "getnameinfo failed");
100 return "getnameinfo_failed";
107 int connectport(int type, char *host, char *port) {
108 struct addrinfo hints, *res0, *res;
111 memset(&hints, 0, sizeof(hints));
112 hints.ai_socktype = type;
113 hints.ai_family = AF_UNSPEC;
115 if (getaddrinfo(host, port, &hints, &res0) != 0) {
116 debug(DBG_ERR, "connectport: can't resolve host %s port %s", host, port);
120 for (res = res0; res; res = res->ai_next) {
121 s = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
123 debug(DBG_WARN, "connectport: socket failed");
126 if (connect(s, res->ai_addr, res->ai_addrlen) == 0)
128 debug(DBG_WARN, "connectport: connect failed");
137 int bindtoaddr(struct addrinfo *addrinfo, int family, int reuse, int v6only) {
139 struct addrinfo *res;
141 for (res = addrinfo; res; res = res->ai_next) {
142 if (family != AF_UNSPEC && family != res->ai_family)
144 s = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
146 debug(DBG_WARN, "bindtoaddr: socket failed");
150 setsockopt(s, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
153 setsockopt(s, IPPROTO_IPV6, IPV6_V6ONLY, &on, sizeof(on));
155 if (!bind(s, res->ai_addr, res->ai_addrlen))
157 debug(DBG_WARN, "bindtoaddr: bind failed");
163 int connectnonblocking(int s, const struct sockaddr *addr, socklen_t addrlen, struct timeval *timeout) {
164 int origflags, error = 0, r = -1;
168 origflags = fcntl(s, F_GETFL, 0);
169 fcntl(s, F_SETFL, origflags | O_NONBLOCK);
170 if (!connect(s, addr, addrlen)) {
174 if (errno != EINPROGRESS)
178 FD_SET(s, &writefds);
179 if (select(s + 1, NULL, &writefds, NULL, timeout) < 1)
183 if (!getsockopt(s, SOL_SOCKET, SO_ERROR, (char*)&error, &len) && !error)
187 fcntl(s, F_SETFL, origflags);
191 int connecttcp(struct addrinfo *addrinfo, struct addrinfo *src, uint16_t timeout) {
193 struct addrinfo *res;
198 if (addrinfo && addrinfo->ai_next && timeout > 5)
204 for (res = addrinfo; res; res = res->ai_next) {
205 s = bindtoaddr(src, res->ai_family, 1, 1);
207 debug(DBG_WARN, "connecttoserver: socket failed");
211 ? connectnonblocking(s, res->ai_addr, res->ai_addrlen, &to)
212 : connect(s, res->ai_addr, res->ai_addrlen)) == 0)
214 debug(DBG_WARN, "connecttoserver: connect failed");