1 // SPDX-License-Identifier: GPL-2.0+
3 * Author: Justin Iurman (justin.iurman@uliege.be)
5 * IOAM tester for IPv6, see ioam6.sh for details on each test case.
10 #include <linux/const.h>
11 #include <linux/if_ether.h>
12 #include <linux/ioam6.h>
13 #include <linux/ipv6.h>
33 * Be careful if you modify structs below - everything MUST be kept synchronized
34 * with configurations inside ioam6.sh and always reflect the same.
37 static struct ioam_config node1 = {
40 .ingr_id = 0xffff, /* default value */
42 .ingr_wide = 0xffffffff, /* default value */
44 .ns_data = 0xdeadbee0,
45 .ns_wide = 0xcafec0caf00dc0de,
47 .sc_data = "something that will be 4n-aligned",
51 static struct ioam_config node2 = {
58 .ns_data = 0xdeadbee1,
59 .ns_wide = 0xcafec0caf11dc0de,
61 .sc_data = "Hello there -Obi",
65 static struct ioam_config node3 = {
69 .egr_id = 0xffff, /* default value */
71 .egr_wide = 0xffffffff, /* default value */
72 .ns_data = 0xdeadbee2,
73 .ns_wide = 0xcafec0caf22dc0de,
74 .sc_id = 0xffffff, /* default value */
98 TEST_OUT_FULL_SUPP_TRACE,
119 TEST_IN_FULL_SUPP_TRACE,
124 TEST_FWD_FULL_SUPP_TRACE,
129 static int check_ioam_header(int tid, struct ioam6_trace_hdr *ioam6h,
130 __u32 trace_type, __u16 ioam_ns)
132 if (__be16_to_cpu(ioam6h->namespace_id) != ioam_ns ||
133 __be32_to_cpu(ioam6h->type_be32) != (trace_type << 8))
137 case TEST_OUT_UNDEF_NS:
138 case TEST_IN_UNDEF_NS:
139 return ioam6h->overflow ||
140 ioam6h->nodelen != 1 ||
143 case TEST_OUT_NO_ROOM:
144 case TEST_IN_NO_ROOM:
146 return !ioam6h->overflow ||
147 ioam6h->nodelen != 2 ||
168 return ioam6h->overflow ||
169 ioam6h->nodelen != 1 ||
178 return ioam6h->overflow ||
179 ioam6h->nodelen != 2 ||
184 return ioam6h->overflow ||
188 case TEST_OUT_FULL_SUPP_TRACE:
189 case TEST_IN_FULL_SUPP_TRACE:
190 case TEST_FWD_FULL_SUPP_TRACE:
191 return ioam6h->overflow ||
192 ioam6h->nodelen != 15 ||
202 static int check_ioam6_data(__u8 **p, struct ioam6_trace_hdr *ioam6h,
203 const struct ioam_config cnf)
210 if (ioam6h->type.bit0) {
211 raw32 = __be32_to_cpu(*((__u32 *)*p));
212 if (cnf.hlim != (raw32 >> 24) || cnf.id != (raw32 & 0xffffff))
217 if (ioam6h->type.bit1) {
218 raw32 = __be32_to_cpu(*((__u32 *)*p));
219 if (cnf.ingr_id != (raw32 >> 16) ||
220 cnf.egr_id != (raw32 & 0xffff))
225 if (ioam6h->type.bit2)
228 if (ioam6h->type.bit3)
231 if (ioam6h->type.bit4) {
232 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
237 if (ioam6h->type.bit5) {
238 if (__be32_to_cpu(*((__u32 *)*p)) != cnf.ns_data)
243 if (ioam6h->type.bit6) {
244 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
249 if (ioam6h->type.bit7) {
250 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
255 if (ioam6h->type.bit8) {
256 raw64 = __be64_to_cpu(*((__u64 *)*p));
257 if (cnf.hlim != (raw64 >> 56) ||
258 cnf.wide != (raw64 & 0xffffffffffffff))
263 if (ioam6h->type.bit9) {
264 if (__be32_to_cpu(*((__u32 *)*p)) != cnf.ingr_wide)
268 if (__be32_to_cpu(*((__u32 *)*p)) != cnf.egr_wide)
273 if (ioam6h->type.bit10) {
274 if (__be64_to_cpu(*((__u64 *)*p)) != cnf.ns_wide)
279 if (ioam6h->type.bit11) {
280 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
285 if (ioam6h->type.bit12) {
286 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
291 if (ioam6h->type.bit13) {
292 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
297 if (ioam6h->type.bit14) {
298 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
303 if (ioam6h->type.bit15) {
304 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
309 if (ioam6h->type.bit16) {
310 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
315 if (ioam6h->type.bit17) {
316 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
321 if (ioam6h->type.bit18) {
322 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
327 if (ioam6h->type.bit19) {
328 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
333 if (ioam6h->type.bit20) {
334 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
339 if (ioam6h->type.bit21) {
340 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
345 if (ioam6h->type.bit22) {
346 len = cnf.sc_data ? strlen(cnf.sc_data) : 0;
347 aligned = cnf.sc_data ? __ALIGN_KERNEL(len, 4) : 0;
349 raw32 = __be32_to_cpu(*((__u32 *)*p));
350 if (aligned != (raw32 >> 24) * 4 ||
351 cnf.sc_id != (raw32 & 0xffffff))
356 if (strncmp((char *)*p, cnf.sc_data, len))
373 static int check_ioam_header_and_data(int tid, struct ioam6_trace_hdr *ioam6h,
374 __u32 trace_type, __u16 ioam_ns)
378 if (check_ioam_header(tid, ioam6h, trace_type, ioam_ns))
381 p = ioam6h->data + ioam6h->remlen * 4;
397 case TEST_OUT_FULL_SUPP_TRACE:
398 return check_ioam6_data(&p, ioam6h, node1);
413 case TEST_IN_FULL_SUPP_TRACE:
415 __u32 tmp32 = node2.egr_wide;
416 __u16 tmp16 = node2.egr_id;
419 node2.egr_id = 0xffff;
420 node2.egr_wide = 0xffffffff;
422 res = check_ioam6_data(&p, ioam6h, node2);
424 node2.egr_id = tmp16;
425 node2.egr_wide = tmp32;
430 case TEST_FWD_FULL_SUPP_TRACE:
431 if (check_ioam6_data(&p, ioam6h, node3))
433 if (check_ioam6_data(&p, ioam6h, node2))
435 return check_ioam6_data(&p, ioam6h, node1);
444 static int str2id(const char *tname)
446 if (!strcmp("out_undef_ns", tname))
447 return TEST_OUT_UNDEF_NS;
448 if (!strcmp("out_no_room", tname))
449 return TEST_OUT_NO_ROOM;
450 if (!strcmp("out_bit0", tname))
451 return TEST_OUT_BIT0;
452 if (!strcmp("out_bit1", tname))
453 return TEST_OUT_BIT1;
454 if (!strcmp("out_bit2", tname))
455 return TEST_OUT_BIT2;
456 if (!strcmp("out_bit3", tname))
457 return TEST_OUT_BIT3;
458 if (!strcmp("out_bit4", tname))
459 return TEST_OUT_BIT4;
460 if (!strcmp("out_bit5", tname))
461 return TEST_OUT_BIT5;
462 if (!strcmp("out_bit6", tname))
463 return TEST_OUT_BIT6;
464 if (!strcmp("out_bit7", tname))
465 return TEST_OUT_BIT7;
466 if (!strcmp("out_bit8", tname))
467 return TEST_OUT_BIT8;
468 if (!strcmp("out_bit9", tname))
469 return TEST_OUT_BIT9;
470 if (!strcmp("out_bit10", tname))
471 return TEST_OUT_BIT10;
472 if (!strcmp("out_bit11", tname))
473 return TEST_OUT_BIT11;
474 if (!strcmp("out_bit22", tname))
475 return TEST_OUT_BIT22;
476 if (!strcmp("out_full_supp_trace", tname))
477 return TEST_OUT_FULL_SUPP_TRACE;
478 if (!strcmp("in_undef_ns", tname))
479 return TEST_IN_UNDEF_NS;
480 if (!strcmp("in_no_room", tname))
481 return TEST_IN_NO_ROOM;
482 if (!strcmp("in_oflag", tname))
483 return TEST_IN_OFLAG;
484 if (!strcmp("in_bit0", tname))
486 if (!strcmp("in_bit1", tname))
488 if (!strcmp("in_bit2", tname))
490 if (!strcmp("in_bit3", tname))
492 if (!strcmp("in_bit4", tname))
494 if (!strcmp("in_bit5", tname))
496 if (!strcmp("in_bit6", tname))
498 if (!strcmp("in_bit7", tname))
500 if (!strcmp("in_bit8", tname))
502 if (!strcmp("in_bit9", tname))
504 if (!strcmp("in_bit10", tname))
505 return TEST_IN_BIT10;
506 if (!strcmp("in_bit11", tname))
507 return TEST_IN_BIT11;
508 if (!strcmp("in_bit22", tname))
509 return TEST_IN_BIT22;
510 if (!strcmp("in_full_supp_trace", tname))
511 return TEST_IN_FULL_SUPP_TRACE;
512 if (!strcmp("fwd_full_supp_trace", tname))
513 return TEST_FWD_FULL_SUPP_TRACE;
518 static int ipv6_addr_equal(const struct in6_addr *a1, const struct in6_addr *a2)
520 return ((a1->s6_addr32[0] ^ a2->s6_addr32[0]) |
521 (a1->s6_addr32[1] ^ a2->s6_addr32[1]) |
522 (a1->s6_addr32[2] ^ a2->s6_addr32[2]) |
523 (a1->s6_addr32[3] ^ a2->s6_addr32[3])) == 0;
526 static int get_u32(__u32 *val, const char *arg, int base)
533 res = strtoul(arg, &ptr, base);
535 if (!ptr || ptr == arg || *ptr)
538 if (res == ULONG_MAX && errno == ERANGE)
541 if (res > 0xFFFFFFFFUL)
548 static int get_u16(__u16 *val, const char *arg, int base)
555 res = strtoul(arg, &ptr, base);
557 if (!ptr || ptr == arg || *ptr)
560 if (res == ULONG_MAX && errno == ERANGE)
570 static int (*func[__TEST_MAX])(int, struct ioam6_trace_hdr *, __u32, __u16) = {
571 [TEST_OUT_UNDEF_NS] = check_ioam_header,
572 [TEST_OUT_NO_ROOM] = check_ioam_header,
573 [TEST_OUT_BIT0] = check_ioam_header_and_data,
574 [TEST_OUT_BIT1] = check_ioam_header_and_data,
575 [TEST_OUT_BIT2] = check_ioam_header_and_data,
576 [TEST_OUT_BIT3] = check_ioam_header_and_data,
577 [TEST_OUT_BIT4] = check_ioam_header_and_data,
578 [TEST_OUT_BIT5] = check_ioam_header_and_data,
579 [TEST_OUT_BIT6] = check_ioam_header_and_data,
580 [TEST_OUT_BIT7] = check_ioam_header_and_data,
581 [TEST_OUT_BIT8] = check_ioam_header_and_data,
582 [TEST_OUT_BIT9] = check_ioam_header_and_data,
583 [TEST_OUT_BIT10] = check_ioam_header_and_data,
584 [TEST_OUT_BIT11] = check_ioam_header_and_data,
585 [TEST_OUT_BIT22] = check_ioam_header_and_data,
586 [TEST_OUT_FULL_SUPP_TRACE] = check_ioam_header_and_data,
587 [TEST_IN_UNDEF_NS] = check_ioam_header,
588 [TEST_IN_NO_ROOM] = check_ioam_header,
589 [TEST_IN_OFLAG] = check_ioam_header,
590 [TEST_IN_BIT0] = check_ioam_header_and_data,
591 [TEST_IN_BIT1] = check_ioam_header_and_data,
592 [TEST_IN_BIT2] = check_ioam_header_and_data,
593 [TEST_IN_BIT3] = check_ioam_header_and_data,
594 [TEST_IN_BIT4] = check_ioam_header_and_data,
595 [TEST_IN_BIT5] = check_ioam_header_and_data,
596 [TEST_IN_BIT6] = check_ioam_header_and_data,
597 [TEST_IN_BIT7] = check_ioam_header_and_data,
598 [TEST_IN_BIT8] = check_ioam_header_and_data,
599 [TEST_IN_BIT9] = check_ioam_header_and_data,
600 [TEST_IN_BIT10] = check_ioam_header_and_data,
601 [TEST_IN_BIT11] = check_ioam_header_and_data,
602 [TEST_IN_BIT22] = check_ioam_header_and_data,
603 [TEST_IN_FULL_SUPP_TRACE] = check_ioam_header_and_data,
604 [TEST_FWD_FULL_SUPP_TRACE] = check_ioam_header_and_data,
607 int main(int argc, char **argv)
609 int fd, size, hoplen, tid, ret = 1;
610 struct in6_addr src, dst;
611 struct ioam6_hdr *opt;
612 struct ipv6hdr *ip6h;
613 __u8 buffer[400], *p;
620 tid = str2id(argv[2]);
621 if (tid < 0 || !func[tid])
624 if (inet_pton(AF_INET6, argv[3], &src) != 1 ||
625 inet_pton(AF_INET6, argv[4], &dst) != 1)
628 if (get_u32(&tr_type, argv[5], 16) ||
629 get_u16(&ioam_ns, argv[6], 0))
632 fd = socket(AF_PACKET, SOCK_DGRAM, __cpu_to_be16(ETH_P_IPV6));
636 if (setsockopt(fd, SOL_SOCKET, SO_BINDTODEVICE,
637 argv[1], strlen(argv[1])))
641 size = recv(fd, buffer, sizeof(buffer), 0);
645 ip6h = (struct ipv6hdr *)buffer;
647 if (!ipv6_addr_equal(&ip6h->saddr, &src) ||
648 !ipv6_addr_equal(&ip6h->daddr, &dst))
651 if (ip6h->nexthdr != IPPROTO_HOPOPTS)
654 p = buffer + sizeof(*ip6h);
655 hoplen = (p[1] + 1) << 3;
656 p += sizeof(struct ipv6_hopopt_hdr);
659 opt = (struct ioam6_hdr *)p;
661 if (opt->opt_type == IPV6_TLV_IOAM &&
662 opt->type == IOAM6_TYPE_PREALLOC) {
664 ret = func[tid](tid, (struct ioam6_trace_hdr *)p,
669 p += opt->opt_len + 2;
670 hoplen -= opt->opt_len + 2;