30 #include <netlink-private/netlink.h>
31 #include <netlink/netlink.h>
32 #include <netlink/utils.h>
33 #include <netlink/addr.h>
34 #include <linux/socket.h>
38 static inline uint16_t dn_ntohs(uint16_t addr)
47 return ((uint16_t) u.byte[0]) | (((uint16_t) u.byte[1]) << 8);
50 static inline int do_digit(
char *str, uint16_t *addr, uint16_t scale,
51 size_t *pos,
size_t len,
int *started)
53 uint16_t tmp = *addr / scale;
58 if (((tmp) > 0) || *started || (scale == 1)) {
62 *addr -= (tmp * scale);
68 static const char *dnet_ntop(
char *addrbuf,
size_t addrlen,
char *str,
71 uint16_t addr = dn_ntohs(*(uint16_t *)addrbuf);
72 uint16_t area = addr >> 10;
84 if (do_digit(str + pos, &area, 10, &pos, len, &started))
87 if (do_digit(str + pos, &area, 1, &pos, len, &started))
97 if (do_digit(str + pos, &addr, 1000, &pos, len, &started))
100 if (do_digit(str + pos, &addr, 100, &pos, len, &started))
103 if (do_digit(str + pos, &addr, 10, &pos, len, &started))
106 if (do_digit(str + pos, &addr, 1, &pos, len, &started))
117 static int dnet_num(
const char *src, uint16_t * dst)
123 while ((tmp = *src++) != 0) {
125 if ((tmp < 0) || (tmp > 9))
136 static inline int dnet_pton(
const char *src,
char *addrbuf)
142 pos = dnet_num(src, &area);
143 if ((pos == 0) || (area > 63) ||
144 ((*(src + pos) !=
'.') && (*(src + pos) !=
',')))
147 pos = dnet_num(src + pos + 1, &node);
148 if ((pos == 0) || (node > 1023))
151 *(uint16_t *)addrbuf = dn_ntohs((area << 10) | node);
156 static void addr_destroy(
struct nl_addr *addr)
161 if (addr->a_refcnt != 1)
187 struct nl_addr *addr;
189 addr = calloc(1,
sizeof(*addr) + maxsize);
194 addr->a_maxsize = maxsize;
218 struct nl_addr *addr;
224 addr->a_family = family;
226 addr->a_prefixlen = size*8;
229 memcpy(addr->a_addr, buf, size);
293 int err, copy = 0, len = 0, family = AF_UNSPEC;
294 char *str, *prefix, buf[32];
295 struct nl_addr *addr = NULL;
297 str = strdup(addrstr);
303 prefix = strchr(str,
'/');
307 if (!strcasecmp(str,
"none")) {
312 if (!strcasecmp(str,
"default") ||
313 !strcasecmp(str,
"all") ||
314 !strcasecmp(str,
"any")) {
336 err = -NLE_AF_NOSUPPORT;
343 if (hint == AF_INET || hint == AF_UNSPEC) {
344 if (inet_pton(AF_INET, str, buf) > 0) {
349 if (hint == AF_INET) {
355 if (hint == AF_INET6 || hint == AF_UNSPEC) {
356 if (inet_pton(AF_INET6, str, buf) > 0) {
361 if (hint == AF_INET6) {
367 if ((hint == AF_LLC || hint == AF_UNSPEC) && strchr(str,
':')) {
368 unsigned int a, b, c, d, e, f;
370 if (sscanf(str,
"%02x:%02x:%02x:%02x:%02x:%02x",
371 &a, &b, &c, &d, &e, &f) == 6) {
374 buf[0] = (
unsigned char) a;
375 buf[1] = (
unsigned char) b;
376 buf[2] = (
unsigned char) c;
377 buf[3] = (
unsigned char) d;
378 buf[4] = (
unsigned char) e;
379 buf[5] = (
unsigned char) f;
383 if (hint == AF_LLC) {
389 if ((hint == AF_DECnet || hint == AF_UNSPEC) &&
390 (strchr(str,
'.') || strchr(str,
','))) {
391 if (dnet_pton(str, buf) > 0) {
396 if (hint == AF_DECnet) {
402 if (hint == AF_UNSPEC && strchr(str,
':')) {
406 long l = strtol(s, &p, 16);
408 if (s == p || l > 0xff || i >=
sizeof(buf)) {
413 buf[i++] = (
unsigned char) l;
441 long pl = strtol(++prefix, &p, 0);
475 new =
nl_addr_build(addr->a_family, addr->a_addr, addr->a_len);
477 new->a_prefixlen = addr->a_prefixlen;
522 if (addr->a_refcnt == 1)
536 return addr->a_refcnt > 1;
565 int d = a->a_family - b->a_family;
568 d = a->a_len - b->a_len;
570 if (a->a_len && d == 0) {
571 d = memcmp(a->a_addr, b->a_addr, a->a_len);
574 return (a->a_prefixlen - b->a_prefixlen);
596 int d = a->a_family - b->a_family;
599 int len = min(a->a_prefixlen, b->a_prefixlen);
602 d = memcmp(a->a_addr, b->a_addr, bytes);
603 if (d == 0 && (len % 8) != 0) {
604 int mask = (0xFF00 >> (len % 8)) & 0xFF;
606 d = (a->a_addr[bytes] & mask) -
607 (b->a_addr[bytes] & mask);
624 for (i = 0; i < addr->a_len; i++)
647 ret = inet_pton(family, addr, buf);
653 ret = dnet_pton(addr, buf);
659 if (sscanf(addr,
"%*02x:%*02x:%*02x:%*02x:%*02x:%*02x") != 6)
675 switch (addr->a_len) {
703 switch (addr->a_family) {
705 struct sockaddr_in *sai = (
struct sockaddr_in *) sa;
707 if (*salen <
sizeof(*sai))
710 sai->sin_family = addr->a_family;
711 memcpy(&sai->sin_addr, addr->a_addr, 4);
712 *salen =
sizeof(*sai);
717 struct sockaddr_in6 *sa6 = (
struct sockaddr_in6 *) sa;
719 if (*salen <
sizeof(*sa6))
722 sa6->sin6_family = addr->a_family;
723 memcpy(&sa6->sin6_addr, addr->a_addr, 16);
724 *salen =
sizeof(*sa6);
759 char buf[INET6_ADDRSTRLEN+5];
760 struct addrinfo hint = {
761 .ai_flags = AI_NUMERICHOST,
762 .ai_family = addr->a_family,
767 err = getaddrinfo(buf, NULL, &hint, result);
770 case EAI_ADDRFAMILY:
return -NLE_AF_NOSUPPORT;
771 case EAI_AGAIN:
return -NLE_AGAIN;
772 case EAI_BADFLAGS:
return -NLE_INVAL;
773 case EAI_FAIL:
return -NLE_NOADDR;
774 case EAI_FAMILY:
return -NLE_AF_NOSUPPORT;
775 case EAI_MEMORY:
return -NLE_NOMEM;
776 case EAI_NODATA:
return -NLE_NOADDR;
777 case EAI_NONAME:
return -NLE_OBJ_NOTFOUND;
778 case EAI_SERVICE:
return -NLE_OPNOTSUPP;
779 case EAI_SOCKTYPE:
return -NLE_BAD_SOCK;
780 default:
return -NLE_FAILURE;
803 struct sockaddr_in6 buf;
804 socklen_t salen =
sizeof(buf);
810 err = getnameinfo((
struct sockaddr *) &buf, salen, host, hostlen,
811 NULL, 0, NI_NAMEREQD);
813 return nl_syserr2nlerr(err);
834 addr->a_family = family;
847 return addr->a_family;
872 if (len > addr->a_maxsize)
876 memset(addr->a_addr, 0, addr->a_maxsize);
879 memcpy(addr->a_addr, buf, len);
919 addr->a_prefixlen = prefixlen;
930 return addr->a_prefixlen;
956 if (!addr || !addr->a_len) {
957 snprintf(buf, size,
"none");
964 switch (addr->a_family) {
966 inet_ntop(AF_INET, addr->a_addr, buf, size);
970 inet_ntop(AF_INET6, addr->a_addr, buf, size);
974 dnet_ntop(addr->a_addr, addr->a_len, buf, size);
979 snprintf(buf, size,
"%02x",
980 (
unsigned char) addr->a_addr[0]);
981 for (i = 1; i < addr->a_len; i++) {
982 snprintf(tmp,
sizeof(tmp),
":%02x",
983 (
unsigned char) addr->a_addr[i]);
984 strncat(buf, tmp, size - strlen(buf) - 1);
990 if (addr->a_prefixlen != (8 * addr->a_len)) {
991 snprintf(tmp,
sizeof(tmp),
"/%u", addr->a_prefixlen);
992 strncat(buf, tmp, size - strlen(buf) - 1);
1005 static const struct trans_tbl afs[] = {
1006 __ADD(AF_UNSPEC,unspec)
1011 __ADD(AF_APPLETALK,appletalk)
1012 __ADD(AF_NETROM,netrom)
1013 __ADD(AF_BRIDGE,bridge)
1014 __ADD(AF_ATMPVC,atmpvc)
1016 __ADD(AF_INET6,inet6)
1018 __ADD(AF_DECnet,decnet)
1019 __ADD(AF_NETBEUI,netbeui)
1020 __ADD(AF_SECURITY,security)
1022 __ADD(AF_NETLINK,netlink)
1023 __ADD(AF_PACKET,packet)
1025 __ADD(AF_ECONET,econet)
1026 __ADD(AF_ATMSVC,atmsvc)
1032 __ADD(AF_PPPOX,pppox)
1033 __ADD(AF_WANPIPE,wanpipe)
1041 __ADD(AF_BLUETOOTH,bluetooth)
1046 __ADD(AF_RXRPC,rxrpc)
1052 __ADD(AF_PHONET,phonet)
1054 #ifdef AF_IEEE802154
1055 __ADD(AF_IEEE802154,ieee802154)
1068 char *nl_af2str(
int family,
char *buf,
size_t size)
1070 return __type2str(family, buf, size, afs, ARRAY_SIZE(afs));
1073 int nl_str2af(
const char *name)
1075 int fam = __str2type(name, afs, ARRAY_SIZE(afs));
1076 return fam >= 0 ? fam : -EINVAL;