28 #include <netlink-local.h>
29 #include <netlink/netlink.h>
30 #include <netlink/utils.h>
31 #include <netlink/addr.h>
32 #include <linux/socket.h>
36 static inline uint16_t dn_ntohs(uint16_t addr)
45 return ((uint16_t) u.byte[0]) | (((uint16_t) u.byte[1]) << 8);
48 static inline int do_digit(
char *str, uint16_t *addr, uint16_t scale,
49 size_t *pos,
size_t len,
int *started)
51 uint16_t tmp = *addr / scale;
56 if (((tmp) > 0) || *started || (scale == 1)) {
60 *addr -= (tmp * scale);
66 static const char *dnet_ntop(
char *addrbuf,
size_t addrlen,
char *str,
69 uint16_t addr = dn_ntohs(*(uint16_t *)addrbuf);
70 uint16_t area = addr >> 10;
82 if (do_digit(str + pos, &area, 10, &pos, len, &started))
85 if (do_digit(str + pos, &area, 1, &pos, len, &started))
95 if (do_digit(str + pos, &addr, 1000, &pos, len, &started))
98 if (do_digit(str + pos, &addr, 100, &pos, len, &started))
101 if (do_digit(str + pos, &addr, 10, &pos, len, &started))
104 if (do_digit(str + pos, &addr, 1, &pos, len, &started))
115 static int dnet_num(
const char *src, uint16_t * dst)
121 while ((tmp = *src++) != 0) {
123 if ((tmp < 0) || (tmp > 9))
134 static inline int dnet_pton(
const char *src,
char *addrbuf)
140 pos = dnet_num(src, &area);
141 if ((pos == 0) || (area > 63) ||
142 ((*(src + pos) !=
'.') && (*(src + pos) !=
',')))
145 pos = dnet_num(src + pos + 1, &node);
146 if ((pos == 0) || (node > 1023))
149 *(uint16_t *)addrbuf = dn_ntohs((area << 10) | node);
154 static void addr_destroy(
struct nl_addr *addr)
159 if (addr->a_refcnt != 1)
177 struct nl_addr *addr;
179 addr = calloc(1,
sizeof(*addr) + maxsize);
184 addr->a_maxsize = maxsize;
198 struct nl_addr *addr;
204 addr->a_family = family;
206 addr->a_prefixlen = size*8;
209 memcpy(addr->a_addr, buf, size);
258 int err, copy = 0, len = 0, family = AF_UNSPEC;
259 char *str, *prefix, buf[32];
260 struct nl_addr *addr = NULL;
262 str = strdup(addrstr);
268 prefix = strchr(str,
'/');
272 if (!strcasecmp(str,
"none")) {
277 if (!strcasecmp(str,
"default") ||
278 !strcasecmp(str,
"all") ||
279 !strcasecmp(str,
"any")) {
302 err = -NLE_AF_NOSUPPORT;
309 if (hint == AF_INET || hint == AF_UNSPEC) {
310 if (inet_pton(AF_INET, str, buf) > 0) {
315 if (hint == AF_INET) {
321 if (hint == AF_INET6 || hint == AF_UNSPEC) {
322 if (inet_pton(AF_INET6, str, buf) > 0) {
327 if (hint == AF_INET6) {
333 if ((hint == AF_LLC || hint == AF_UNSPEC) && strchr(str,
':')) {
334 unsigned int a, b, c, d, e, f;
336 if (sscanf(str,
"%02x:%02x:%02x:%02x:%02x:%02x",
337 &a, &b, &c, &d, &e, &f) == 6) {
340 buf[0] = (
unsigned char) a;
341 buf[1] = (
unsigned char) b;
342 buf[2] = (
unsigned char) c;
343 buf[3] = (
unsigned char) d;
344 buf[4] = (
unsigned char) e;
345 buf[5] = (
unsigned char) f;
349 if (hint == AF_LLC) {
355 if ((hint == AF_DECnet || hint == AF_UNSPEC) &&
356 (strchr(str,
'.') || strchr(str,
','))) {
357 if (dnet_pton(str, buf) > 0) {
362 if (hint == AF_DECnet) {
368 if (hint == AF_UNSPEC && strchr(str,
':')) {
372 long l = strtol(s, &p, 16);
374 if (s == p || l > 0xff || i >=
sizeof(buf)) {
379 buf[i++] = (
unsigned char) l;
400 nl_addr_set_family(addr, family);
407 long pl = strtol(++prefix, &p, 0);
413 nl_addr_set_prefixlen(addr, pl);
415 nl_addr_set_prefixlen(addr, len * 8);
435 new =
nl_addr_build(addr->a_family, addr->a_addr, addr->a_len);
437 new->a_prefixlen = addr->a_prefixlen;
449 struct nl_addr *nl_addr_get(
struct nl_addr *addr)
456 void nl_addr_put(
struct nl_addr *addr)
461 if (addr->a_refcnt == 1)
474 return addr->a_refcnt > 1;
494 int d = a->a_family - b->a_family;
497 d = a->a_len - b->a_len;
499 if (a->a_len && d == 0)
500 d = memcmp(a->a_addr, b->a_addr, a->a_len);
503 return (a->a_prefixlen - b->a_prefixlen);
519 int d = a->a_family - b->a_family;
522 int len = min(a->a_prefixlen, b->a_prefixlen);
525 d = memcmp(a->a_addr, b->a_addr, bytes);
527 int mask = (1UL << (len % 8)) - 1UL;
529 d = (a->a_addr[bytes] & mask) -
530 (b->a_addr[bytes] & mask);
545 for (i = 0; i < addr->a_len; i++)
568 ret = inet_pton(family, addr, buf);
574 ret = dnet_pton(addr, buf);
580 if (sscanf(addr,
"%*02x:%*02x:%*02x:%*02x:%*02x:%*02x") != 6)
595 switch (addr->a_len) {
623 switch (addr->a_family) {
625 struct sockaddr_in *sai = (
struct sockaddr_in *) sa;
627 if (*salen <
sizeof(*sai))
630 sai->sin_family = addr->a_family;
631 memcpy(&sai->sin_addr, addr->a_addr, 4);
632 *salen =
sizeof(*sai);
637 struct sockaddr_in6 *sa6 = (
struct sockaddr_in6 *) sa;
639 if (*salen <
sizeof(*sa6))
642 sa6->sin6_family = addr->a_family;
643 memcpy(&sa6->sin6_addr, addr->a_addr, 16);
644 *salen =
sizeof(*sa6);
679 char buf[INET6_ADDRSTRLEN+5];
680 struct addrinfo hint = {
681 .ai_flags = AI_NUMERICHOST,
682 .ai_family = addr->a_family,
687 err = getaddrinfo(buf, NULL, &hint, result);
690 case EAI_ADDRFAMILY:
return -NLE_AF_NOSUPPORT;
691 case EAI_AGAIN:
return -NLE_AGAIN;
692 case EAI_BADFLAGS:
return -NLE_INVAL;
693 case EAI_FAIL:
return -NLE_NOADDR;
694 case EAI_FAMILY:
return -NLE_AF_NOSUPPORT;
695 case EAI_MEMORY:
return -NLE_NOMEM;
696 case EAI_NODATA:
return -NLE_NOADDR;
697 case EAI_NONAME:
return -NLE_OBJ_NOTFOUND;
698 case EAI_SERVICE:
return -NLE_OPNOTSUPP;
699 case EAI_SOCKTYPE:
return -NLE_BAD_SOCK;
700 default:
return -NLE_FAILURE;
723 struct sockaddr_in6 buf;
724 socklen_t salen =
sizeof(buf);
730 err = getnameinfo((
struct sockaddr *) &buf, salen, host, hostlen,
731 NULL, 0, NI_NAMEREQD);
733 return nl_syserr2nlerr(err);
745 void nl_addr_set_family(
struct nl_addr *addr,
int family)
747 addr->a_family = family;
750 int nl_addr_get_family(
struct nl_addr *addr)
752 return addr->a_family;
763 if (len > addr->a_maxsize)
767 memcpy(addr->a_addr, buf, len);
790 void nl_addr_set_prefixlen(
struct nl_addr *addr,
int prefixlen)
792 addr->a_prefixlen = prefixlen;
801 return addr->a_prefixlen;
827 if (!addr || !addr->a_len) {
828 snprintf(buf, size,
"none");
835 switch (addr->a_family) {
837 inet_ntop(AF_INET, addr->a_addr, buf, size);
841 inet_ntop(AF_INET6, addr->a_addr, buf, size);
845 dnet_ntop(addr->a_addr, addr->a_len, buf, size);
850 snprintf(buf, size,
"%02x",
851 (
unsigned char) addr->a_addr[0]);
852 for (i = 1; i < addr->a_len; i++) {
853 snprintf(tmp,
sizeof(tmp),
":%02x",
854 (
unsigned char) addr->a_addr[i]);
855 strncat(buf, tmp, size - strlen(buf) - 1);
861 if (addr->a_prefixlen != (8 * addr->a_len)) {
862 snprintf(tmp,
sizeof(tmp),
"/%u", addr->a_prefixlen);
863 strncat(buf, tmp, size - strlen(buf) - 1);
876 static const struct trans_tbl afs[] = {
877 __ADD(AF_UNSPEC,unspec)
879 __ADD(AF_LOCAL,local)
883 __ADD(AF_APPLETALK,appletalk)
884 __ADD(AF_NETROM,netrom)
885 __ADD(AF_BRIDGE,bridge)
886 __ADD(AF_ATMPVC,atmpvc)
888 __ADD(AF_INET6,inet6)
890 __ADD(AF_DECnet,decnet)
891 __ADD(AF_NETBEUI,netbeui)
892 __ADD(AF_SECURITY,security)
894 __ADD(AF_NETLINK,netlink)
895 __ADD(AF_ROUTE,route)
896 __ADD(AF_PACKET,packet)
898 __ADD(AF_ECONET,econet)
899 __ADD(AF_ATMSVC,atmsvc)
902 __ADD(AF_PPPOX,pppox)
903 __ADD(AF_WANPIPE,wanpipe)
905 __ADD(AF_BLUETOOTH,bluetooth)
908 char *nl_af2str(
int family,
char *buf,
size_t size)
910 return __type2str(family, buf, size, afs, ARRAY_SIZE(afs));
913 int nl_str2af(
const char *name)
915 int fam = __str2type(name, afs, ARRAY_SIZE(afs));
916 return fam >= 0 ? fam : -EINVAL;