#include <sys/param.h>
#include <sys/systm.h>
#include <sys/socket.h>
#include <netinet/in.h>
#define IN6ADDRSZ 16
#define INT16SZ 2
static const char *inet_ntop4(const u_char *src, char *dst, size_t size);
#ifdef INET6
static const char *inet_ntop6(const u_char *src, char *dst, size_t size);
#endif
const char *
inet_ntop(int af, const void *src, char *dst, socklen_t size)
{
switch (af) {
case AF_INET:
return (inet_ntop4(src, dst, (size_t)size));
#ifdef INET6
case AF_INET6:
return (inet_ntop6(src, dst, (size_t)size));
#endif
default:
return (NULL);
}
}
const char *
sockaddr_ntop(struct sockaddr *sa, char *dst, size_t size)
{
u_int8_t l;
size_t n;
if (sa->sa_len < 2)
return "bad sa";
switch (sa->sa_family) {
case AF_INET:
return inet_ntop4((u_char *)&satosin(sa)->sin_addr, dst, size);
#ifdef INET6
case AF_INET6:
return inet_ntop6((u_char *)&satosin6(sa)->sin6_addr, dst, size);
#endif
default:
n = snprintf(dst, size, "%d ", sa->sa_family);
for (l = 0; l < sa->sa_len - offsetof(struct sockaddr, sa_data); l++) {
int r = snprintf(dst + n, size - n, "%02x", sa->sa_data[l]);
if (r == -1)
return "bad sa";
n += r;
if (n > size)
n = size;
}
return (dst);
}
}
static const char *
inet_ntop4(const u_char *src, char *dst, size_t size)
{
char tmp[sizeof "255.255.255.255"];
int l;
l = snprintf(tmp, sizeof(tmp), "%u.%u.%u.%u",
src[0], src[1], src[2], src[3]);
if (l <= 0 || l >= size) {
return (NULL);
}
strlcpy(dst, tmp, size);
return (dst);
}
#ifdef INET6
static const char *
inet_ntop6(const u_char *src, char *dst, size_t size)
{
char tmp[sizeof "ffff:ffff:ffff:ffff:ffff:ffff:255.255.255.255"];
char *tp, *ep;
struct { int base, len; } best, cur;
u_int words[IN6ADDRSZ / INT16SZ];
int i;
int advance;
memset(words, '\0', sizeof words);
for (i = 0; i < IN6ADDRSZ; i++)
words[i / 2] |= (src[i] << ((1 - (i % 2)) << 3));
best.base = -1;
cur.base = -1;
for (i = 0; i < (IN6ADDRSZ / INT16SZ); i++) {
if (words[i] == 0) {
if (cur.base == -1)
cur.base = i, cur.len = 1;
else
cur.len++;
} else {
if (cur.base != -1) {
if (best.base == -1 || cur.len > best.len)
best = cur;
cur.base = -1;
}
}
}
if (cur.base != -1) {
if (best.base == -1 || cur.len > best.len)
best = cur;
}
if (best.base != -1 && best.len < 2)
best.base = -1;
tp = tmp;
ep = tmp + sizeof(tmp);
for (i = 0; i < (IN6ADDRSZ / INT16SZ) && tp < ep; i++) {
if (best.base != -1 && i >= best.base &&
i < (best.base + best.len)) {
if (i == best.base) {
if (tp + 1 >= ep)
return (NULL);
*tp++ = ':';
}
continue;
}
if (i != 0) {
if (tp + 1 >= ep)
return (NULL);
*tp++ = ':';
}
if (i == 6 && best.base == 0 &&
(best.len == 6 || (best.len == 5 && words[5] == 0xffff))) {
if (!inet_ntop4(src+12, tp, (size_t)(ep - tp)))
return (NULL);
tp += strlen(tp);
break;
}
advance = snprintf(tp, ep - tp, "%x", words[i]);
if (advance <= 0 || advance >= ep - tp)
return (NULL);
tp += advance;
}
if (best.base != -1 && (best.base + best.len) == (IN6ADDRSZ / INT16SZ)) {
if (tp + 1 >= ep)
return (NULL);
*tp++ = ':';
}
if (tp + 1 >= ep)
return (NULL);
*tp++ = '\0';
if ((size_t)(tp - tmp) > size) {
return (NULL);
}
strlcpy(dst, tmp, size);
return (dst);
}
#endif