git.maemo.org Git - busybox4maemo/blob - libbb/xconnect.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * Utility routines.
   4  *
   5  * Connect to host at port using address resolution from getaddrinfo
   6  *
   7  */
   8
   9 #include <netinet/in.h>
  10 #include "libbb.h"
  11
  12 void setsockopt_reuseaddr(int fd)
  13 {
  14         setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &const_int_1, sizeof(const_int_1));
  15 }
  16 int setsockopt_broadcast(int fd)
  17 {
  18         return setsockopt(fd, SOL_SOCKET, SO_BROADCAST, &const_int_1, sizeof(const_int_1));
  19 }
  20
  21 void xconnect(int s, const struct sockaddr *s_addr, socklen_t addrlen)
  22 {
  23         if (connect(s, s_addr, addrlen) < 0) {
  24                 if (ENABLE_FEATURE_CLEAN_UP)
  25                         close(s);
  26                 if (s_addr->sa_family == AF_INET)
  27                         bb_perror_msg_and_die("%s (%s)",
  28                                 "cannot connect to remote host",
  29                                 inet_ntoa(((struct sockaddr_in *)s_addr)->sin_addr));
  30                 bb_perror_msg_and_die("cannot connect to remote host");
  31         }
  32 }
  33
  34 /* Return port number for a service.
  35  * If "port" is a number use it as the port.
  36  * If "port" is a name it is looked up in /etc/services, if it isnt found return
  37  * default_port */
  38 unsigned bb_lookup_port(const char *port, const char *protocol, unsigned default_port)
  39 {
  40         unsigned port_nr = default_port;
  41         if (port) {
  42                 int old_errno;
  43
  44                 /* Since this is a lib function, we're not allowed to reset errno to 0.
  45                  * Doing so could break an app that is deferring checking of errno. */
  46                 old_errno = errno;
  47                 port_nr = bb_strtou(port, NULL, 10);
  48                 if (errno || port_nr > 65535) {
  49                         struct servent *tserv = getservbyname(port, protocol);
  50                         port_nr = default_port;
  51                         if (tserv)
  52                                 port_nr = ntohs(tserv->s_port);
  53                 }
  54                 errno = old_errno;
  55         }
  56         return (uint16_t)port_nr;
  57 }
  58
  59
  60 /* "Old" networking API - only IPv4 */
  61
  62 /*
  63 void bb_lookup_host(struct sockaddr_in *s_in, const char *host)
  64 {
  65         struct hostent *he;
  66
  67         memset(s_in, 0, sizeof(struct sockaddr_in));
  68         s_in->sin_family = AF_INET;
  69         he = xgethostbyname(host);
  70         memcpy(&(s_in->sin_addr), he->h_addr_list[0], he->h_length);
  71 }
  72
  73
  74 int xconnect_tcp_v4(struct sockaddr_in *s_addr)
  75 {
  76         int s = xsocket(AF_INET, SOCK_STREAM, 0);
  77         xconnect(s, (struct sockaddr*) s_addr, sizeof(*s_addr));
  78         return s;
  79 }
  80 */
  81
  82 /* "New" networking API */
  83
  84
  85 int get_nport(const struct sockaddr *sa)
  86 {
  87 #if ENABLE_FEATURE_IPV6
  88         if (sa->sa_family == AF_INET6) {
  89                 return ((struct sockaddr_in6*)sa)->sin6_port;
  90         }
  91 #endif
  92         if (sa->sa_family == AF_INET) {
  93                 return ((struct sockaddr_in*)sa)->sin_port;
  94         }
  95         /* What? UNIX socket? IPX?? :) */
  96         return -1;
  97 }
  98
  99 void set_nport(len_and_sockaddr *lsa, unsigned port)
 100 {
 101 #if ENABLE_FEATURE_IPV6
 102         if (lsa->u.sa.sa_family == AF_INET6) {
 103                 lsa->u.sin6.sin6_port = port;
 104                 return;
 105         }
 106 #endif
 107         if (lsa->u.sa.sa_family == AF_INET) {
 108                 lsa->u.sin.sin_port = port;
 109                 return;
 110         }
 111         /* What? UNIX socket? IPX?? :) */
 112 }
 113
 114 /* We hijack this constant to mean something else */
 115 /* It doesn't hurt because we will remove this bit anyway */
 116 #define DIE_ON_ERROR AI_CANONNAME
 117
 118 /* host: "1.2.3.4[:port]", "www.google.com[:port]"
 119  * port: if neither of above specifies port # */
 120 static len_and_sockaddr* str2sockaddr(
 121                 const char *host, int port,
 122 USE_FEATURE_IPV6(sa_family_t af,)
 123                 int ai_flags)
 124 {
 125         int rc;
 126         len_and_sockaddr *r = NULL;
 127         struct addrinfo *result = NULL;
 128         struct addrinfo *used_res;
 129         const char *org_host = host; /* only for error msg */
 130         const char *cp;
 131         struct addrinfo hint;
 132
 133         /* Ugly parsing of host:addr */
 134         if (ENABLE_FEATURE_IPV6 && host[0] == '[') {
 135                 /* Even uglier parsing of [xx]:nn */
 136                 host++;
 137                 cp = strchr(host, ']');
 138                 if (!cp || cp[1] != ':') { /* Malformed: must have [xx]:nn */
 139                         bb_error_msg("bad address '%s'", org_host);
 140                         if (ai_flags & DIE_ON_ERROR)
 141                                 xfunc_die();
 142                         return NULL;
 143                 }
 144         } else {
 145                 cp = strrchr(host, ':');
 146                 if (ENABLE_FEATURE_IPV6 && cp && strchr(host, ':') != cp) {
 147                         /* There is more than one ':' (e.g. "::1") */
 148                         cp = NULL; /* it's not a port spec */
 149                 }
 150         }
 151         if (cp) { /* points to ":" or "]:" */
 152                 int sz = cp - host + 1;
 153                 host = safe_strncpy(alloca(sz), host, sz);
 154                 if (ENABLE_FEATURE_IPV6 && *cp != ':')
 155                         cp++; /* skip ']' */
 156                 cp++; /* skip ':' */
 157                 port = bb_strtou(cp, NULL, 10);
 158                 if (errno || (unsigned)port > 0xffff) {
 159                         bb_error_msg("bad port spec '%s'", org_host);
 160                         if (ai_flags & DIE_ON_ERROR)
 161                                 xfunc_die();
 162                         return NULL;
 163                 }
 164         }
 165
 166         memset(&hint, 0 , sizeof(hint));
 167 #if !ENABLE_FEATURE_IPV6
 168         hint.ai_family = AF_INET; /* do not try to find IPv6 */
 169 #else
 170         hint.ai_family = af;
 171 #endif
 172         /* Needed. Or else we will get each address thrice (or more)
 173          * for each possible socket type (tcp,udp,raw...): */
 174         hint.ai_socktype = SOCK_STREAM;
 175         hint.ai_flags = ai_flags & ~DIE_ON_ERROR;
 176         rc = getaddrinfo(host, NULL, &hint, &result);
 177         if (rc || !result) {
 178                 bb_error_msg("bad address '%s'", org_host);
 179                 if (ai_flags & DIE_ON_ERROR)
 180                         xfunc_die();
 181                 goto ret;
 182         }
 183         used_res = result;
 184 #if ENABLE_FEATURE_PREFER_IPV4_ADDRESS
 185         while (1) {
 186                 if (used_res->ai_family == AF_INET)
 187                         break;
 188                 used_res = used_res->ai_next;
 189                 if (!used_res) {
 190                         used_res = result;
 191                         break;
 192                 }
 193         }
 194 #endif
 195         r = xmalloc(offsetof(len_and_sockaddr, u.sa) + used_res->ai_addrlen);
 196         r->len = used_res->ai_addrlen;
 197         memcpy(&r->u.sa, used_res->ai_addr, used_res->ai_addrlen);
 198         set_nport(r, htons(port));
 199  ret:
 200         freeaddrinfo(result);
 201         return r;
 202 }
 203 #if !ENABLE_FEATURE_IPV6
 204 #define str2sockaddr(host, port, af, ai_flags) str2sockaddr(host, port, ai_flags)
 205 #endif
 206
 207 #if ENABLE_FEATURE_IPV6
 208 len_and_sockaddr* host_and_af2sockaddr(const char *host, int port, sa_family_t af)
 209 {
 210         return str2sockaddr(host, port, af, 0);
 211 }
 212
 213 len_and_sockaddr* xhost_and_af2sockaddr(const char *host, int port, sa_family_t af)
 214 {
 215         return str2sockaddr(host, port, af, DIE_ON_ERROR);
 216 }
 217 #endif
 218
 219 len_and_sockaddr* host2sockaddr(const char *host, int port)
 220 {
 221         return str2sockaddr(host, port, AF_UNSPEC, 0);
 222 }
 223
 224 len_and_sockaddr* xhost2sockaddr(const char *host, int port)
 225 {
 226         return str2sockaddr(host, port, AF_UNSPEC, DIE_ON_ERROR);
 227 }
 228
 229 len_and_sockaddr* xdotted2sockaddr(const char *host, int port)
 230 {
 231         return str2sockaddr(host, port, AF_UNSPEC, AI_NUMERICHOST | DIE_ON_ERROR);
 232 }
 233
 234 #undef xsocket_type
 235 int xsocket_type(len_and_sockaddr **lsap, USE_FEATURE_IPV6(int family,) int sock_type)
 236 {
 237         SKIP_FEATURE_IPV6(enum { family = AF_INET };)
 238         len_and_sockaddr *lsa;
 239         int fd;
 240         int len;
 241
 242 #if ENABLE_FEATURE_IPV6
 243         if (family == AF_UNSPEC) {
 244                 fd = socket(AF_INET6, sock_type, 0);
 245                 if (fd >= 0) {
 246                         family = AF_INET6;
 247                         goto done;
 248                 }
 249                 family = AF_INET;
 250         }
 251 #endif
 252         fd = xsocket(family, sock_type, 0);
 253         len = sizeof(struct sockaddr_in);
 254 #if ENABLE_FEATURE_IPV6
 255         if (family == AF_INET6) {
 256  done:
 257                 len = sizeof(struct sockaddr_in6);
 258         }
 259 #endif
 260         lsa = xzalloc(offsetof(len_and_sockaddr, u.sa) + len);
 261         lsa->len = len;
 262         lsa->u.sa.sa_family = family;
 263         *lsap = lsa;
 264         return fd;
 265 }
 266
 267 int xsocket_stream(len_and_sockaddr **lsap)
 268 {
 269         return xsocket_type(lsap, USE_FEATURE_IPV6(AF_UNSPEC,) SOCK_STREAM);
 270 }
 271
 272 static int create_and_bind_or_die(const char *bindaddr, int port, int sock_type)
 273 {
 274         int fd;
 275         len_and_sockaddr *lsa;
 276
 277         if (bindaddr && bindaddr[0]) {
 278                 lsa = xdotted2sockaddr(bindaddr, port);
 279                 /* user specified bind addr dictates family */
 280                 fd = xsocket(lsa->u.sa.sa_family, sock_type, 0);
 281         } else {
 282                 fd = xsocket_type(&lsa, USE_FEATURE_IPV6(AF_UNSPEC,) sock_type);
 283                 set_nport(lsa, htons(port));
 284         }
 285         setsockopt_reuseaddr(fd);
 286         xbind(fd, &lsa->u.sa, lsa->len);
 287         free(lsa);
 288         return fd;
 289 }
 290
 291 int create_and_bind_stream_or_die(const char *bindaddr, int port)
 292 {
 293         return create_and_bind_or_die(bindaddr, port, SOCK_STREAM);
 294 }
 295
 296 int create_and_bind_dgram_or_die(const char *bindaddr, int port)
 297 {
 298         return create_and_bind_or_die(bindaddr, port, SOCK_DGRAM);
 299 }
 300
 301
 302 int create_and_connect_stream_or_die(const char *peer, int port)
 303 {
 304         int fd;
 305         len_and_sockaddr *lsa;
 306
 307         lsa = xhost2sockaddr(peer, port);
 308         fd = xsocket(lsa->u.sa.sa_family, SOCK_STREAM, 0);
 309         setsockopt_reuseaddr(fd);
 310         xconnect(fd, &lsa->u.sa, lsa->len);
 311         free(lsa);
 312         return fd;
 313 }
 314
 315 int xconnect_stream(const len_and_sockaddr *lsa)
 316 {
 317         int fd = xsocket(lsa->u.sa.sa_family, SOCK_STREAM, 0);
 318         xconnect(fd, &lsa->u.sa, lsa->len);
 319         return fd;
 320 }
 321
 322 /* We hijack this constant to mean something else */
 323 /* It doesn't hurt because we will add this bit anyway */
 324 #define IGNORE_PORT NI_NUMERICSERV
 325 static char* sockaddr2str(const struct sockaddr *sa, int flags)
 326 {
 327         char host[128];
 328         char serv[16];
 329         int rc;
 330         socklen_t salen;
 331
 332         salen = LSA_SIZEOF_SA;
 333 #if ENABLE_FEATURE_IPV6
 334         if (sa->sa_family == AF_INET)
 335                 salen = sizeof(struct sockaddr_in);
 336         if (sa->sa_family == AF_INET6)
 337                 salen = sizeof(struct sockaddr_in6);
 338 #endif
 339         rc = getnameinfo(sa, salen,
 340                         host, sizeof(host),
 341         /* can do ((flags & IGNORE_PORT) ? NULL : serv) but why bother? */
 342                         serv, sizeof(serv),
 343                         /* do not resolve port# into service _name_ */
 344                         flags | NI_NUMERICSERV
 345         );
 346         if (rc)
 347                 return NULL;
 348         if (flags & IGNORE_PORT)
 349                 return xstrdup(host);
 350 #if ENABLE_FEATURE_IPV6
 351         if (sa->sa_family == AF_INET6) {
 352                 if (strchr(host, ':')) /* heh, it's not a resolved hostname */
 353                         return xasprintf("[%s]:%s", host, serv);
 354                 /*return xasprintf("%s:%s", host, serv);*/
 355                 /* - fall through instead */
 356         }
 357 #endif
 358         /* For now we don't support anything else, so it has to be INET */
 359         /*if (sa->sa_family == AF_INET)*/
 360                 return xasprintf("%s:%s", host, serv);
 361         /*return xstrdup(host);*/
 362 }
 363
 364 char* xmalloc_sockaddr2host(const struct sockaddr *sa)
 365 {
 366         return sockaddr2str(sa, 0);
 367 }
 368
 369 char* xmalloc_sockaddr2host_noport(const struct sockaddr *sa)
 370 {
 371         return sockaddr2str(sa, IGNORE_PORT);
 372 }
 373
 374 char* xmalloc_sockaddr2hostonly_noport(const struct sockaddr *sa)
 375 {
 376         return sockaddr2str(sa, NI_NAMEREQD | IGNORE_PORT);
 377 }
 378 char* xmalloc_sockaddr2dotted(const struct sockaddr *sa)
 379 {
 380         return sockaddr2str(sa, NI_NUMERICHOST);
 381 }
 382
 383 char* xmalloc_sockaddr2dotted_noport(const struct sockaddr *sa)
 384 {
 385         return sockaddr2str(sa, NI_NUMERICHOST | IGNORE_PORT);
 386 }