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>
21 void errx(char *format, ...) {
26 vfprintf(stderr, format, ap);
29 fprintf(stderr, ": ");
31 fprintf(stderr, "errno=%d\n", errno);
33 fprintf(stderr, "\n");
37 void err(char *format, ...) {
42 vfprintf(stderr, format, ap);
45 fprintf(stderr, ": ");
47 fprintf(stderr, "errno=%d\n", errno);
49 fprintf(stderr, "\n");
53 char *stringcopy(const char *s, int len) {
59 debug(DBG_ERR, "stringcopy: malloc failed");
65 void printfchars(char *prefixfmt, char *prefix, char *charfmt, char *chars, int len) {
67 unsigned char *s = (unsigned char *)chars;
69 printf(prefixfmt ? prefixfmt : "%s: ", prefix);
70 for (i = 0; i < len; i++)
71 printf(charfmt ? charfmt : "%c", s[i]);
75 uint16_t port_get(struct sockaddr *sa) {
76 switch (sa->sa_family) {
78 return ntohs(((struct sockaddr_in *)sa)->sin_port);
80 return ntohs(((struct sockaddr_in6 *)sa)->sin6_port);
85 void port_set(struct sockaddr *sa, uint16_t port) {
86 switch (sa->sa_family) {
88 ((struct sockaddr_in *)sa)->sin_port = htons(port);
91 ((struct sockaddr_in6 *)sa)->sin6_port = htons(port);
96 int addr_equal(struct sockaddr *a, struct sockaddr *b) {
97 switch (a->sa_family) {
99 return !memcmp(&((struct sockaddr_in*)a)->sin_addr,
100 &((struct sockaddr_in*)b)->sin_addr,
101 sizeof(struct in_addr));
103 return IN6_ARE_ADDR_EQUAL(&((struct sockaddr_in6*)a)->sin6_addr,
104 &((struct sockaddr_in6*)b)->sin6_addr);
111 struct sockaddr *addr_copy(struct sockaddr *in) {
112 struct sockaddr *out = NULL;
114 switch (in->sa_family) {
116 out = malloc(sizeof(struct sockaddr_in));
118 memset(out, 0, sizeof(struct sockaddr_in));
119 ((struct sockaddr_in *)out)->sin_addr = ((struct sockaddr_in *)in)->sin_addr;
123 out = malloc(sizeof(struct sockaddr_in6));
125 memset(out, 0, sizeof(struct sockaddr_in6));
126 ((struct sockaddr_in6 *)out)->sin6_addr = ((struct sockaddr_in6 *)in)->sin6_addr;
133 char *addr2string(struct sockaddr *addr, socklen_t len) {
134 struct sockaddr_in6 *sa6;
135 struct sockaddr_in sa4;
136 static char addr_buf[2][INET6_ADDRSTRLEN];
139 if (addr->sa_family == AF_INET6) {
140 sa6 = (struct sockaddr_in6 *)addr;
141 if (IN6_IS_ADDR_V4MAPPED(&sa6->sin6_addr)) {
142 memset(&sa4, 0, sizeof(sa4));
143 sa4.sin_family = AF_INET;
144 sa4.sin_port = sa6->sin6_port;
145 memcpy(&sa4.sin_addr, &sa6->sin6_addr.s6_addr[12], 4);
146 addr = (struct sockaddr *)&sa4;
149 len = addr->sa_family == AF_INET ? sizeof(struct sockaddr_in) : sizeof(struct sockaddr_in6);
151 if (getnameinfo(addr, len, addr_buf[i], sizeof(addr_buf[i]),
152 NULL, 0, NI_NUMERICHOST)) {
153 debug(DBG_WARN, "getnameinfo failed");
154 return "getnameinfo_failed";
159 int connectport(int type, char *host, char *port) {
160 struct addrinfo hints, *res0, *res;
163 memset(&hints, 0, sizeof(hints));
164 hints.ai_socktype = type;
165 hints.ai_family = AF_UNSPEC;
167 if (getaddrinfo(host, port, &hints, &res0) != 0) {
168 debug(DBG_ERR, "connectport: can't resolve host %s port %s", host, port);
172 for (res = res0; res; res = res->ai_next) {
173 s = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
175 debug(DBG_WARN, "connectport: socket failed");
178 if (connect(s, res->ai_addr, res->ai_addrlen) == 0)
180 debug(DBG_WARN, "connectport: connect failed");