4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
20 #include <sys/socket.h>
21 #include <netinet/in.h>
25 #include <arpa/inet.h>
26 #include <asm/types.h>
27 #include <linux/pkt_sched.h>
28 #include <linux/param.h>
29 #include <linux/if_arp.h>
30 #include <linux/mpls.h>
37 #include "namespace.h"
43 if (c
>= 'A' && c
<= 'F')
45 if (c
>= 'a' && c
<= 'f')
47 if (c
>= '0' && c
<= '9')
53 int get_integer(int *val
, const char *arg
, int base
)
61 res
= strtol(arg
, &ptr
, base
);
63 /* If there were no digits at all, strtol() stores
64 * the original value of nptr in *endptr (and returns 0).
65 * In particular, if *nptr is not '\0' but **endptr is '\0' on return,
66 * the entire string is valid.
68 if (!ptr
|| ptr
== arg
|| *ptr
)
71 /* If an underflow occurs, strtol() returns LONG_MIN.
72 * If an overflow occurs, strtol() returns LONG_MAX.
73 * In both cases, errno is set to ERANGE.
75 if ((res
== LONG_MAX
|| res
== LONG_MIN
) && errno
== ERANGE
)
78 /* Outside range of int */
79 if (res
< INT_MIN
|| res
> INT_MAX
)
86 int mask2bits(__u32 netmask
)
88 unsigned int bits
= 0;
89 __u32 mask
= ntohl(netmask
);
92 /* a valid netmask must be 2^n - 1 */
93 if ((host
& (host
+ 1)) != 0)
96 for (; mask
; mask
<<= 1)
101 static int get_netmask(unsigned int *val
, const char *arg
, int base
)
105 if (!get_unsigned(val
, arg
, base
))
108 /* try coverting dotted quad to CIDR */
109 if (!get_addr_1(&addr
, arg
, AF_INET
) && addr
.family
== AF_INET
) {
110 int b
= mask2bits(addr
.data
[0]);
121 int get_unsigned(unsigned int *val
, const char *arg
, int base
)
129 res
= strtoul(arg
, &ptr
, base
);
131 /* empty string or trailing non-digits */
132 if (!ptr
|| ptr
== arg
|| *ptr
)
136 if (res
== ULONG_MAX
&& errno
== ERANGE
)
139 /* out side range of unsigned */
148 * get_time_rtt is "translated" from a similar routine "get_time" in
149 * tc_util.c. We don't use the exact same routine because tc passes
150 * microseconds to the kernel and the callers of get_time_rtt want to
151 * pass milliseconds (standard unit for rtt values since 2.6.27), and
152 * have a different assumption for the units of a "raw" number.
154 int get_time_rtt(unsigned int *val
, const char *arg
, int *raw
)
160 if (strchr(arg
, '.') != NULL
) {
170 if ((t
== HUGE_VALF
|| t
== HUGE_VALL
) && errno
== ERANGE
)
173 res
= strtoul(arg
, &p
, 0);
180 if (res
== ULONG_MAX
&& errno
== ERANGE
)
192 if (strcasecmp(p
, "s") == 0 ||
193 strcasecmp(p
, "sec") == 0 ||
194 strcasecmp(p
, "secs") == 0)
196 else if (strcasecmp(p
, "ms") == 0 ||
197 strcasecmp(p
, "msec") == 0 ||
198 strcasecmp(p
, "msecs") == 0)
199 t
*= 1.0; /* allow suffix, do nothing */
204 /* emulate ceil() without having to bring-in -lm and always be >= 1 */
213 int get_u64(__u64
*val
, const char *arg
, int base
)
215 unsigned long long res
;
221 res
= strtoull(arg
, &ptr
, base
);
223 /* empty string or trailing non-digits */
224 if (!ptr
|| ptr
== arg
|| *ptr
)
228 if (res
== ULLONG_MAX
&& errno
== ERANGE
)
231 /* in case ULL is 128 bits */
232 if (res
> 0xFFFFFFFFFFFFFFFFULL
)
239 int get_u32(__u32
*val
, const char *arg
, int base
)
246 res
= strtoul(arg
, &ptr
, base
);
248 /* empty string or trailing non-digits */
249 if (!ptr
|| ptr
== arg
|| *ptr
)
253 if (res
== ULONG_MAX
&& errno
== ERANGE
)
256 /* in case UL > 32 bits */
257 if (res
> 0xFFFFFFFFUL
)
264 int get_u16(__u16
*val
, const char *arg
, int base
)
271 res
= strtoul(arg
, &ptr
, base
);
273 /* empty string or trailing non-digits */
274 if (!ptr
|| ptr
== arg
|| *ptr
)
278 if (res
== ULONG_MAX
&& errno
== ERANGE
)
288 int get_u8(__u8
*val
, const char *arg
, int base
)
296 res
= strtoul(arg
, &ptr
, base
);
297 /* empty string or trailing non-digits */
298 if (!ptr
|| ptr
== arg
|| *ptr
)
302 if (res
== ULONG_MAX
&& errno
== ERANGE
)
312 int get_s32(__s32
*val
, const char *arg
, int base
)
321 res
= strtol(arg
, &ptr
, base
);
322 if (!ptr
|| ptr
== arg
|| *ptr
)
324 if ((res
== LONG_MIN
|| res
== LONG_MAX
) && errno
== ERANGE
)
326 if (res
> INT32_MAX
|| res
< INT32_MIN
)
333 int get_s16(__s16
*val
, const char *arg
, int base
)
340 res
= strtol(arg
, &ptr
, base
);
341 if (!ptr
|| ptr
== arg
|| *ptr
)
343 if ((res
== LONG_MIN
|| res
== LONG_MAX
) && errno
== ERANGE
)
345 if (res
> 0x7FFF || res
< -0x8000)
352 int get_s8(__s8
*val
, const char *arg
, int base
)
359 res
= strtol(arg
, &ptr
, base
);
360 if (!ptr
|| ptr
== arg
|| *ptr
)
362 if ((res
== LONG_MIN
|| res
== LONG_MAX
) && errno
== ERANGE
)
364 if (res
> 0x7F || res
< -0x80)
370 int get_be64(__be64
*val
, const char *arg
, int base
)
373 int ret
= get_u64(&v
, arg
, base
);
381 int get_be32(__be32
*val
, const char *arg
, int base
)
384 int ret
= get_u32(&v
, arg
, base
);
392 int get_be16(__be16
*val
, const char *arg
, int base
)
395 int ret
= get_u16(&v
, arg
, base
);
403 /* This uses a non-standard parsing (ie not inet_aton, or inet_pton)
404 * because of legacy choice to parse 10.8 as 10.8.0.0 not 10.0.0.8
406 static int get_addr_ipv4(__u8
*ap
, const char *cp
)
410 for (i
= 0; i
< 4; i
++) {
414 n
= strtoul(cp
, &endp
, 0);
416 return -1; /* bogus network value */
418 if (endp
== cp
) /* no digits */
426 if (i
== 3 || *endp
!= '.')
427 return -1; /* extra characters */
434 int get_addr64(__u64
*ap
, const char *cp
)
443 for (i
= 0; i
< 4; i
++) {
447 n
= strtoul(cp
, &endp
, 16);
449 return -1; /* bogus network value */
451 if (endp
== cp
) /* no digits */
454 val
.v16
[i
] = htons(n
);
459 if (i
== 3 || *endp
!= ':')
460 return -1; /* extra characters */
469 int get_addr_1(inet_prefix
*addr
, const char *name
, int family
)
471 memset(addr
, 0, sizeof(*addr
));
473 if (strcmp(name
, "default") == 0 ||
474 strcmp(name
, "all") == 0 ||
475 strcmp(name
, "any") == 0) {
476 if ((family
== AF_DECnet
) || (family
== AF_MPLS
))
478 addr
->family
= family
;
479 addr
->bytelen
= (family
== AF_INET6
? 16 : 4);
484 if (family
== AF_PACKET
) {
487 len
= ll_addr_a2n((char *) &addr
->data
, sizeof(addr
->data
),
492 addr
->family
= AF_PACKET
;
494 addr
->bitlen
= len
* 8;
498 if (strchr(name
, ':')) {
499 addr
->family
= AF_INET6
;
500 if (family
!= AF_UNSPEC
&& family
!= AF_INET6
)
502 if (inet_pton(AF_INET6
, name
, addr
->data
) <= 0)
509 if (family
== AF_DECnet
) {
512 addr
->family
= AF_DECnet
;
513 if (dnet_pton(AF_DECnet
, name
, &dna
) <= 0)
515 memcpy(addr
->data
, dna
.a_addr
, 2);
521 if (family
== AF_MPLS
) {
522 unsigned int maxlabels
;
525 addr
->family
= AF_MPLS
;
526 if (mpls_pton(AF_MPLS
, name
, addr
->data
,
527 sizeof(addr
->data
)) <= 0)
531 /* How many bytes do I need? */
532 maxlabels
= sizeof(addr
->data
) / sizeof(struct mpls_label
);
533 for (i
= 0; i
< maxlabels
; i
++) {
534 if (ntohl(addr
->data
[i
]) & MPLS_LS_S_MASK
) {
535 addr
->bytelen
= (i
+ 1)*4;
542 addr
->family
= AF_INET
;
543 if (family
!= AF_UNSPEC
&& family
!= AF_INET
)
546 if (get_addr_ipv4((__u8
*)addr
->data
, name
) <= 0)
554 int af_bit_len(int af
)
572 int af_byte_len(int af
)
574 return af_bit_len(af
) / 8;
577 int get_prefix_1(inet_prefix
*dst
, char *arg
, int family
)
583 memset(dst
, 0, sizeof(*dst
));
585 if (strcmp(arg
, "default") == 0 ||
586 strcmp(arg
, "any") == 0 ||
587 strcmp(arg
, "all") == 0) {
588 if ((family
== AF_DECnet
) || (family
== AF_MPLS
))
590 dst
->family
= family
;
596 slash
= strchr(arg
, '/');
600 err
= get_addr_1(dst
, arg
, family
);
602 dst
->bitlen
= af_bit_len(dst
->family
);
605 if (get_netmask(&plen
, slash
+1, 0)
606 || plen
> dst
->bitlen
) {
610 dst
->flags
|= PREFIXLEN_SPECIFIED
;
620 static const char *family_name_verbose(int family
)
622 if (family
== AF_UNSPEC
)
624 return family_name(family
);
627 int get_addr(inet_prefix
*dst
, const char *arg
, int family
)
629 if (get_addr_1(dst
, arg
, family
)) {
631 "Error: %s address is expected rather than \"%s\".\n",
632 family_name_verbose(family
), arg
);
638 int get_prefix(inet_prefix
*dst
, char *arg
, int family
)
640 if (family
== AF_PACKET
) {
642 "Error: \"%s\" may be inet prefix, but it is not allowed in this context.\n",
647 if (get_prefix_1(dst
, arg
, family
)) {
649 "Error: %s prefix is expected rather than \"%s\".\n",
650 family_name_verbose(family
), arg
);
656 __u32
get_addr32(const char *name
)
660 if (get_addr_1(&addr
, name
, AF_INET
)) {
662 "Error: an IP address is expected rather than \"%s\"\n",
669 void incomplete_command(void)
671 fprintf(stderr
, "Command line is not complete. Try option \"help\"\n");
675 void missarg(const char *key
)
677 fprintf(stderr
, "Error: argument \"%s\" is required\n", key
);
681 void invarg(const char *msg
, const char *arg
)
683 fprintf(stderr
, "Error: argument \"%s\" is wrong: %s\n", arg
, msg
);
687 void duparg(const char *key
, const char *arg
)
690 "Error: duplicate \"%s\": \"%s\" is the second value.\n",
695 void duparg2(const char *key
, const char *arg
)
698 "Error: either \"%s\" is duplicate, or \"%s\" is a garbage.\n",
703 int check_ifname(const char *name
)
705 /* These checks mimic kernel checks in dev_valid_name */
708 if (strlen(name
) >= IFNAMSIZ
)
712 if (*name
== '/' || isspace(*name
))
719 /* buf is assumed to be IFNAMSIZ */
720 int get_ifname(char *buf
, const char *name
)
724 ret
= check_ifname(name
);
726 strncpy(buf
, name
, IFNAMSIZ
);
731 int matches(const char *cmd
, const char *pattern
)
733 int len
= strlen(cmd
);
735 if (len
> strlen(pattern
))
737 return memcmp(pattern
, cmd
, len
);
740 int inet_addr_match(const inet_prefix
*a
, const inet_prefix
*b
, int bits
)
742 const __u32
*a1
= a
->data
;
743 const __u32
*a2
= b
->data
;
744 int words
= bits
>> 0x05;
749 if (memcmp(a1
, a2
, words
<< 2))
759 mask
= htonl((0xffffffff) << (0x20 - bits
));
761 if ((w1
^ w2
) & mask
)
768 int __iproute2_hz_internal
;
777 return atoi(getenv("HZ")) ? : HZ
;
779 if (getenv("PROC_NET_PSCHED"))
780 snprintf(name
, sizeof(name
)-1,
781 "%s", getenv("PROC_NET_PSCHED"));
782 else if (getenv("PROC_ROOT"))
783 snprintf(name
, sizeof(name
)-1,
784 "%s/net/psched", getenv("PROC_ROOT"));
786 strcpy(name
, "/proc/net/psched");
788 fp
= fopen(name
, "r");
791 unsigned int nom
, denom
;
793 if (fscanf(fp
, "%*08x%*08x%08x%08x", &nom
, &denom
) == 2)
803 int __iproute2_user_hz_internal
;
805 int __get_user_hz(void)
807 return sysconf(_SC_CLK_TCK
);
810 const char *rt_addr_n2a_r(int af
, int len
,
811 const void *addr
, char *buf
, int buflen
)
816 return inet_ntop(af
, addr
, buf
, buflen
);
818 return mpls_ntop(af
, addr
, buf
, buflen
);
820 return ipx_ntop(af
, addr
, buf
, buflen
);
823 struct dn_naddr dna
= { 2, { 0, 0, } };
825 memcpy(dna
.a_addr
, addr
, 2);
826 return dnet_ntop(af
, &dna
, buf
, buflen
);
829 return ll_addr_n2a(addr
, len
, ARPHRD_VOID
, buf
, buflen
);
835 const char *rt_addr_n2a(int af
, int len
, const void *addr
)
837 static char buf
[256];
839 return rt_addr_n2a_r(af
, len
, addr
, buf
, 256);
842 int read_family(const char *name
)
844 int family
= AF_UNSPEC
;
846 if (strcmp(name
, "inet") == 0)
848 else if (strcmp(name
, "inet6") == 0)
850 else if (strcmp(name
, "dnet") == 0)
852 else if (strcmp(name
, "link") == 0)
854 else if (strcmp(name
, "ipx") == 0)
856 else if (strcmp(name
, "mpls") == 0)
858 else if (strcmp(name
, "bridge") == 0)
863 const char *family_name(int family
)
865 if (family
== AF_INET
)
867 if (family
== AF_INET6
)
869 if (family
== AF_DECnet
)
871 if (family
== AF_PACKET
)
873 if (family
== AF_IPX
)
875 if (family
== AF_MPLS
)
877 if (family
== AF_BRIDGE
)
882 #ifdef RESOLVE_HOSTNAMES
884 struct namerec
*next
;
890 static struct namerec
*nht
[NHASH
];
892 static const char *resolve_address(const void *addr
, int len
, int af
)
895 struct hostent
*h_ent
;
900 if (af
== AF_INET6
&& ((__u32
*)addr
)[0] == 0 &&
901 ((__u32
*)addr
)[1] == 0 && ((__u32
*)addr
)[2] == htonl(0xffff)) {
907 hash
= *(__u32
*)(addr
+ len
- 4) % NHASH
;
909 for (n
= nht
[hash
]; n
; n
= n
->next
) {
910 if (n
->addr
.family
== af
&&
911 n
->addr
.bytelen
== len
&&
912 memcmp(n
->addr
.data
, addr
, len
) == 0)
915 n
= malloc(sizeof(*n
));
919 n
->addr
.bytelen
= len
;
921 memcpy(n
->addr
.data
, addr
, len
);
928 h_ent
= gethostbyaddr(addr
, len
, af
);
930 n
->name
= strdup(h_ent
->h_name
);
932 /* Even if we fail, "negative" entry is remembered. */
937 const char *format_host_r(int af
, int len
, const void *addr
,
938 char *buf
, int buflen
)
940 #ifdef RESOLVE_HOSTNAMES
944 len
= len
<= 0 ? af_byte_len(af
) : len
;
947 (n
= resolve_address(addr
, len
, af
)) != NULL
)
951 return rt_addr_n2a_r(af
, len
, addr
, buf
, buflen
);
954 const char *format_host(int af
, int len
, const void *addr
)
956 static char buf
[256];
958 return format_host_r(af
, len
, addr
, buf
, 256);
962 char *hexstring_n2a(const __u8
*str
, int len
, char *buf
, int blen
)
967 for (i
= 0; i
< len
; i
++) {
970 sprintf(ptr
, "%02x", str
[i
]);
977 __u8
*hexstring_a2n(const char *str
, __u8
*buf
, int blen
, unsigned int *len
)
979 unsigned int cnt
= 0;
984 while (cnt
< blen
&& strlen(str
) > 1) {
988 strncpy(tmpstr
, str
, 2);
991 tmp
= strtoul(tmpstr
, &endptr
, 16);
992 if (errno
!= 0 || tmp
> 0xFF || *endptr
!= '\0')
1004 int hex2mem(const char *buf
, uint8_t *mem
, int count
)
1009 for (i
= 0, j
= 0; i
< count
; i
++, j
+= 2) {
1010 c
= get_hex(buf
[j
]);
1016 c
= get_hex(buf
[j
+ 1]);
1026 int addr64_n2a(__u64 addr
, char *buff
, size_t len
)
1028 __u16
*words
= (__u16
*)&addr
;
1034 for (i
= 0; i
< 4; i
++) {
1035 v
= ntohs(words
[i
]);
1040 ret
= snprintf(&buff
[written
], len
- written
, "%x%s", v
, sep
);
1050 int print_timestamp(FILE *fp
)
1055 gettimeofday(&tv
, NULL
);
1056 tm
= localtime(&tv
.tv_sec
);
1058 if (timestamp_short
) {
1061 strftime(tshort
, sizeof(tshort
), "%Y-%m-%dT%H:%M:%S", tm
);
1062 fprintf(fp
, "[%s.%06ld] ", tshort
, tv
.tv_usec
);
1064 char *tstr
= asctime(tm
);
1066 tstr
[strlen(tstr
)-1] = 0;
1067 fprintf(fp
, "Timestamp: %s %ld usec\n",
1076 /* Like glibc getline but handle continuation lines and comments */
1077 ssize_t
getcmdline(char **linep
, size_t *lenp
, FILE *in
)
1082 cc
= getline(linep
, lenp
, in
);
1084 return cc
; /* eof or error */
1087 cp
= strchr(*linep
, '#');
1091 while ((cp
= strstr(*linep
, "\\\n")) != NULL
) {
1096 cc1
= getline(&line1
, &len1
, in
);
1098 fprintf(stderr
, "Missing continuation line\n");
1105 cp
= strchr(line1
, '#');
1109 *lenp
= strlen(*linep
) + strlen(line1
) + 1;
1110 *linep
= realloc(*linep
, *lenp
);
1112 fprintf(stderr
, "Out of memory\n");
1117 strcat(*linep
, line1
);
1123 /* split command line into argument vector */
1124 int makeargs(char *line
, char *argv
[], int maxargs
)
1126 static const char ws
[] = " \t\r\n";
1130 for (cp
= line
+ strspn(line
, ws
); *cp
; cp
+= strspn(cp
, ws
)) {
1131 if (argc
>= (maxargs
- 1)) {
1132 fprintf(stderr
, "Too many arguments to command\n");
1136 /* word begins with quote */
1137 if (*cp
== '\'' || *cp
== '"') {
1141 /* find ending quote */
1142 cp
= strchr(cp
, quote
);
1144 fprintf(stderr
, "Unterminated quoted string\n");
1152 /* find end of word */
1153 cp
+= strcspn(cp
, ws
);
1161 int inet_get_addr(const char *src
, __u32
*dst
, struct in6_addr
*dst6
)
1163 if (strchr(src
, ':'))
1164 return inet_pton(AF_INET6
, src
, dst6
);
1166 return inet_pton(AF_INET
, src
, dst
);
1169 void print_nlmsg_timestamp(FILE *fp
, const struct nlmsghdr
*n
)
1172 time_t secs
= ((__u32
*)NLMSG_DATA(n
))[0];
1173 long usecs
= ((__u32
*)NLMSG_DATA(n
))[1];
1175 tstr
= asctime(localtime(&secs
));
1176 tstr
[strlen(tstr
)-1] = 0;
1177 fprintf(fp
, "Timestamp: %s %lu us\n", tstr
, usecs
);
1180 static int on_netns(char *nsname
, void *arg
)
1182 struct netns_func
*f
= arg
;
1184 if (netns_switch(nsname
))
1187 return f
->func(nsname
, f
->arg
);
1190 static int on_netns_label(char *nsname
, void *arg
)
1192 printf("\nnetns: %s\n", nsname
);
1193 return on_netns(nsname
, arg
);
1196 int do_each_netns(int (*func
)(char *nsname
, void *arg
), void *arg
,
1199 struct netns_func nsf
= { .func
= func
, .arg
= arg
};
1202 return netns_foreach(on_netns_label
, &nsf
);
1204 return netns_foreach(on_netns
, &nsf
);
1207 char *int_to_str(int val
, char *buf
)
1209 sprintf(buf
, "%d", val
);
1213 int get_guid(__u64
*guid
, const char *arg
)
1215 unsigned long int tmp
;
1219 #define GUID_STR_LEN 23
1220 /* Verify strict format: format string must be
1221 * xx:xx:xx:xx:xx:xx:xx:xx where xx can be an arbitrary
1225 if (strlen(arg
) != GUID_STR_LEN
)
1228 /* make sure columns are in place */
1229 for (i
= 0; i
< 7; i
++)
1230 if (arg
[2 + i
* 3] != ':')
1234 for (i
= 0; i
< 8; i
++) {
1235 tmp
= strtoul(arg
+ i
* 3, &endptr
, 16);
1236 if (endptr
!= arg
+ i
* 3 + 2)
1242 *guid
|= tmp
<< (56 - 8 * i
);
1248 /* This is a necessary workaround for multicast route dumps */
1249 int get_real_family(int rtm_type
, int rtm_family
)
1251 if (rtm_type
!= RTN_MULTICAST
)
1254 if (rtm_family
== RTNL_FAMILY_IPMR
)
1257 if (rtm_family
== RTNL_FAMILY_IP6MR
)
1264 size_t strlcpy(char *dst
, const char *src
, size_t size
)
1266 size_t srclen
= strlen(src
);
1269 size_t minlen
= min(srclen
, size
- 1);
1271 memcpy(dst
, src
, minlen
);
1277 size_t strlcat(char *dst
, const char *src
, size_t size
)
1279 size_t dlen
= strlen(dst
);
1282 return dlen
+ strlen(src
);
1284 return dlen
+ strlcpy(dst
+ dlen
, src
, size
- dlen
);