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)
246 if (ioam6h->type.bit7) {
247 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
252 if (ioam6h->type.bit8) {
253 raw64 = __be64_to_cpu(*((__u64 *)*p));
254 if (cnf.hlim != (raw64 >> 56) ||
255 cnf.wide != (raw64 & 0xffffffffffffff))
260 if (ioam6h->type.bit9) {
261 if (__be32_to_cpu(*((__u32 *)*p)) != cnf.ingr_wide)
265 if (__be32_to_cpu(*((__u32 *)*p)) != cnf.egr_wide)
270 if (ioam6h->type.bit10) {
271 if (__be64_to_cpu(*((__u64 *)*p)) != cnf.ns_wide)
276 if (ioam6h->type.bit11) {
277 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
282 if (ioam6h->type.bit12) {
283 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
288 if (ioam6h->type.bit13) {
289 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
294 if (ioam6h->type.bit14) {
295 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
300 if (ioam6h->type.bit15) {
301 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
306 if (ioam6h->type.bit16) {
307 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
312 if (ioam6h->type.bit17) {
313 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
318 if (ioam6h->type.bit18) {
319 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
324 if (ioam6h->type.bit19) {
325 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
330 if (ioam6h->type.bit20) {
331 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
336 if (ioam6h->type.bit21) {
337 if (__be32_to_cpu(*((__u32 *)*p)) != 0xffffffff)
342 if (ioam6h->type.bit22) {
343 len = cnf.sc_data ? strlen(cnf.sc_data) : 0;
344 aligned = cnf.sc_data ? __ALIGN_KERNEL(len, 4) : 0;
346 raw32 = __be32_to_cpu(*((__u32 *)*p));
347 if (aligned != (raw32 >> 24) * 4 ||
348 cnf.sc_id != (raw32 & 0xffffff))
353 if (strncmp((char *)*p, cnf.sc_data, len))
370 static int check_ioam_header_and_data(int tid, struct ioam6_trace_hdr *ioam6h,
371 __u32 trace_type, __u16 ioam_ns)
375 if (check_ioam_header(tid, ioam6h, trace_type, ioam_ns))
378 p = ioam6h->data + ioam6h->remlen * 4;
394 case TEST_OUT_FULL_SUPP_TRACE:
395 return check_ioam6_data(&p, ioam6h, node1);
410 case TEST_IN_FULL_SUPP_TRACE:
412 __u32 tmp32 = node2.egr_wide;
413 __u16 tmp16 = node2.egr_id;
416 node2.egr_id = 0xffff;
417 node2.egr_wide = 0xffffffff;
419 res = check_ioam6_data(&p, ioam6h, node2);
421 node2.egr_id = tmp16;
422 node2.egr_wide = tmp32;
427 case TEST_FWD_FULL_SUPP_TRACE:
428 if (check_ioam6_data(&p, ioam6h, node3))
430 if (check_ioam6_data(&p, ioam6h, node2))
432 return check_ioam6_data(&p, ioam6h, node1);
441 static int str2id(const char *tname)
443 if (!strcmp("out_undef_ns", tname))
444 return TEST_OUT_UNDEF_NS;
445 if (!strcmp("out_no_room", tname))
446 return TEST_OUT_NO_ROOM;
447 if (!strcmp("out_bit0", tname))
448 return TEST_OUT_BIT0;
449 if (!strcmp("out_bit1", tname))
450 return TEST_OUT_BIT1;
451 if (!strcmp("out_bit2", tname))
452 return TEST_OUT_BIT2;
453 if (!strcmp("out_bit3", tname))
454 return TEST_OUT_BIT3;
455 if (!strcmp("out_bit4", tname))
456 return TEST_OUT_BIT4;
457 if (!strcmp("out_bit5", tname))
458 return TEST_OUT_BIT5;
459 if (!strcmp("out_bit6", tname))
460 return TEST_OUT_BIT6;
461 if (!strcmp("out_bit7", tname))
462 return TEST_OUT_BIT7;
463 if (!strcmp("out_bit8", tname))
464 return TEST_OUT_BIT8;
465 if (!strcmp("out_bit9", tname))
466 return TEST_OUT_BIT9;
467 if (!strcmp("out_bit10", tname))
468 return TEST_OUT_BIT10;
469 if (!strcmp("out_bit11", tname))
470 return TEST_OUT_BIT11;
471 if (!strcmp("out_bit22", tname))
472 return TEST_OUT_BIT22;
473 if (!strcmp("out_full_supp_trace", tname))
474 return TEST_OUT_FULL_SUPP_TRACE;
475 if (!strcmp("in_undef_ns", tname))
476 return TEST_IN_UNDEF_NS;
477 if (!strcmp("in_no_room", tname))
478 return TEST_IN_NO_ROOM;
479 if (!strcmp("in_oflag", tname))
480 return TEST_IN_OFLAG;
481 if (!strcmp("in_bit0", tname))
483 if (!strcmp("in_bit1", tname))
485 if (!strcmp("in_bit2", tname))
487 if (!strcmp("in_bit3", tname))
489 if (!strcmp("in_bit4", tname))
491 if (!strcmp("in_bit5", tname))
493 if (!strcmp("in_bit6", tname))
495 if (!strcmp("in_bit7", tname))
497 if (!strcmp("in_bit8", tname))
499 if (!strcmp("in_bit9", tname))
501 if (!strcmp("in_bit10", tname))
502 return TEST_IN_BIT10;
503 if (!strcmp("in_bit11", tname))
504 return TEST_IN_BIT11;
505 if (!strcmp("in_bit22", tname))
506 return TEST_IN_BIT22;
507 if (!strcmp("in_full_supp_trace", tname))
508 return TEST_IN_FULL_SUPP_TRACE;
509 if (!strcmp("fwd_full_supp_trace", tname))
510 return TEST_FWD_FULL_SUPP_TRACE;
515 static int ipv6_addr_equal(const struct in6_addr *a1, const struct in6_addr *a2)
517 return ((a1->s6_addr32[0] ^ a2->s6_addr32[0]) |
518 (a1->s6_addr32[1] ^ a2->s6_addr32[1]) |
519 (a1->s6_addr32[2] ^ a2->s6_addr32[2]) |
520 (a1->s6_addr32[3] ^ a2->s6_addr32[3])) == 0;
523 static int get_u32(__u32 *val, const char *arg, int base)
530 res = strtoul(arg, &ptr, base);
532 if (!ptr || ptr == arg || *ptr)
535 if (res == ULONG_MAX && errno == ERANGE)
538 if (res > 0xFFFFFFFFUL)
545 static int get_u16(__u16 *val, const char *arg, int base)
552 res = strtoul(arg, &ptr, base);
554 if (!ptr || ptr == arg || *ptr)
557 if (res == ULONG_MAX && errno == ERANGE)
567 static int (*func[__TEST_MAX])(int, struct ioam6_trace_hdr *, __u32, __u16) = {
568 [TEST_OUT_UNDEF_NS] = check_ioam_header,
569 [TEST_OUT_NO_ROOM] = check_ioam_header,
570 [TEST_OUT_BIT0] = check_ioam_header_and_data,
571 [TEST_OUT_BIT1] = check_ioam_header_and_data,
572 [TEST_OUT_BIT2] = check_ioam_header_and_data,
573 [TEST_OUT_BIT3] = check_ioam_header_and_data,
574 [TEST_OUT_BIT4] = check_ioam_header_and_data,
575 [TEST_OUT_BIT5] = check_ioam_header_and_data,
576 [TEST_OUT_BIT6] = check_ioam_header_and_data,
577 [TEST_OUT_BIT7] = check_ioam_header_and_data,
578 [TEST_OUT_BIT8] = check_ioam_header_and_data,
579 [TEST_OUT_BIT9] = check_ioam_header_and_data,
580 [TEST_OUT_BIT10] = check_ioam_header_and_data,
581 [TEST_OUT_BIT11] = check_ioam_header_and_data,
582 [TEST_OUT_BIT22] = check_ioam_header_and_data,
583 [TEST_OUT_FULL_SUPP_TRACE] = check_ioam_header_and_data,
584 [TEST_IN_UNDEF_NS] = check_ioam_header,
585 [TEST_IN_NO_ROOM] = check_ioam_header,
586 [TEST_IN_OFLAG] = check_ioam_header,
587 [TEST_IN_BIT0] = check_ioam_header_and_data,
588 [TEST_IN_BIT1] = check_ioam_header_and_data,
589 [TEST_IN_BIT2] = check_ioam_header_and_data,
590 [TEST_IN_BIT3] = check_ioam_header_and_data,
591 [TEST_IN_BIT4] = check_ioam_header_and_data,
592 [TEST_IN_BIT5] = check_ioam_header_and_data,
593 [TEST_IN_BIT6] = check_ioam_header_and_data,
594 [TEST_IN_BIT7] = check_ioam_header_and_data,
595 [TEST_IN_BIT8] = check_ioam_header_and_data,
596 [TEST_IN_BIT9] = check_ioam_header_and_data,
597 [TEST_IN_BIT10] = check_ioam_header_and_data,
598 [TEST_IN_BIT11] = check_ioam_header_and_data,
599 [TEST_IN_BIT22] = check_ioam_header_and_data,
600 [TEST_IN_FULL_SUPP_TRACE] = check_ioam_header_and_data,
601 [TEST_FWD_FULL_SUPP_TRACE] = check_ioam_header_and_data,
604 int main(int argc, char **argv)
606 int fd, size, hoplen, tid, ret = 1;
607 struct in6_addr src, dst;
608 struct ioam6_hdr *opt;
609 struct ipv6hdr *ip6h;
610 __u8 buffer[400], *p;
617 tid = str2id(argv[2]);
618 if (tid < 0 || !func[tid])
621 if (inet_pton(AF_INET6, argv[3], &src) != 1 ||
622 inet_pton(AF_INET6, argv[4], &dst) != 1)
625 if (get_u32(&tr_type, argv[5], 16) ||
626 get_u16(&ioam_ns, argv[6], 0))
629 fd = socket(AF_PACKET, SOCK_DGRAM, __cpu_to_be16(ETH_P_IPV6));
633 if (setsockopt(fd, SOL_SOCKET, SO_BINDTODEVICE,
634 argv[1], strlen(argv[1])))
638 size = recv(fd, buffer, sizeof(buffer), 0);
642 ip6h = (struct ipv6hdr *)buffer;
644 if (!ipv6_addr_equal(&ip6h->saddr, &src) ||
645 !ipv6_addr_equal(&ip6h->daddr, &dst))
648 if (ip6h->nexthdr != IPPROTO_HOPOPTS)
651 p = buffer + sizeof(*ip6h);
652 hoplen = (p[1] + 1) << 3;
653 p += sizeof(struct ipv6_hopopt_hdr);
656 opt = (struct ioam6_hdr *)p;
658 if (opt->opt_type == IPV6_TLV_IOAM &&
659 opt->type == IOAM6_TYPE_PREALLOC) {
661 ret = func[tid](tid, (struct ioam6_trace_hdr *)p,
666 p += opt->opt_len + 2;
667 hoplen -= opt->opt_len + 2;