#include #include #include "checksum.h" #include "packet_helper.h" #include "packet_private.h" #include "packet_dump.h" #include "packet_parser.h" #define PRINT_GREEN(fmt, ...) printf("\033[0;32m" fmt "\033[0m\n", ##__VA_ARGS__) #define PRINT_RED(fmt, ...) printf("\033[0;31m" fmt "\033[0m\n", ##__VA_ARGS__) // https://dox.ipxe.org/tcp_8h_source.html #define TCP_OPTION_TS 8 #define TCP_OPTION_NOP 1 struct tcp_timestamp_option { uint8_t kind; uint8_t length; uint32_t tsval; uint32_t tsecr; } __attribute__((packed)); struct tcp_timestamp_padded_option { uint8_t nop[2]; struct tcp_timestamp_option tsopt; } __attribute__((packed)); struct tcp_timestamp_padded_option ts_pad_opt = { .nop = {TCP_OPTION_NOP, TCP_OPTION_NOP}, .tsopt = { .kind = TCP_OPTION_TS, .length = 10, .tsval = 0x12345678, .tsecr = 0x87654321, }, }; /****************************************************************************** * [Protocols in frame: eth:ethertype:ip:tcp] ****************************************************************************** * * Frame 1: 60 bytes on wire (480 bits), 60 bytes captured (480 bits) * Ethernet II, Src: 52:54:00:94:27:9b (52:54:00:94:27:9b), Dst: 52:54:00:19:8f:63 (52:54:00:19:8f:63) * Destination: 52:54:00:19:8f:63 (52:54:00:19:8f:63) * Source: 52:54:00:94:27:9b (52:54:00:94:27:9b) * Type: IPv4 (0x0800) * Padding: 000000000000 * Internet Protocol Version 4, Src: 192.168.122.202, Dst: 192.168.122.100 * 0100 .... = Version: 4 * .... 0101 = Header Length: 20 bytes (5) * Differentiated Services Field: 0x00 (DSCP: CS0, ECN: Not-ECT) * 0000 00.. = Differentiated Services Codepoint: Default (0) * .... ..00 = Explicit Congestion Notification: Not ECN-Capable Transport (0) * Total Length: 40 * Identification: 0x0c5e (3166) * 010. .... = Flags: 0x2, Don't fragment * 0... .... = Reserved bit: Not set * .1.. .... = Don't fragment: Set * ..0. .... = More fragments: Not set * ...0 0000 0000 0000 = Fragment Offset: 0 * Time to Live: 64 * Protocol: TCP (6) * Header Checksum: 0xb7f2 [correct] * [Header checksum status: Good] * [Calculated Checksum: 0xb7f2] * Source Address: 192.168.122.202 * Destination Address: 192.168.122.100 * Transmission Control Protocol, Src Port: 1080, Dst Port: 62395, Seq: 1457975085, Ack: 1047768425, Len: 0 * Source Port: 1080 * Destination Port: 62395 * [Stream index: 0] * [Conversation completeness: Incomplete (4)] * ..0. .... = RST: Absent * ...0 .... = FIN: Absent * .... 0... = Data: Absent * .... .1.. = ACK: Present * .... ..0. = SYN-ACK: Absent * .... ...0 = SYN: Absent * [Completeness Flags: ···A··] * [TCP Segment Len: 0] * Sequence Number: 1457975085 * [Next Sequence Number: 1457975085] * Acknowledgment Number: 1047768425 * 0101 .... = Header Length: 20 bytes (5) * Flags: 0x010 (ACK) * 000. .... .... = Reserved: Not set * ...0 .... .... = Accurate ECN: Not set * .... 0... .... = Congestion Window Reduced: Not set * .... .0.. .... = ECN-Echo: Not set * .... ..0. .... = Urgent: Not set * .... ...1 .... = Acknowledgment: Set * .... .... 0... = Push: Not set * .... .... .0.. = Reset: Not set * .... .... ..0. = Syn: Not set * .... .... ...0 = Fin: Not set * [TCP Flags: ·······A····] * Window: 457 * [Calculated window size: 457] * [Window size scaling factor: -1 (unknown)] * Checksum: 0x0da7 [correct] * [Calculated Checksum: 0x0da7] * [Checksum Status: Good] * Urgent Pointer: 0 * [Timestamps] * [Time since first frame in this TCP stream: 0.000000000 seconds] * [Time since previous frame in this TCP stream: 0.000000000 seconds] */ unsigned char data1[] = { 0x52, 0x54, 0x00, 0x19, 0x8f, 0x63, 0x52, 0x54, 0x00, 0x94, 0x27, 0x9b, 0x08, 0x00, 0x45, 0x00, 0x00, 0x28, 0x0c, 0x5e, 0x40, 0x00, 0x40, 0x06, 0xb7, 0xf2, 0xc0, 0xa8, 0x7a, 0xca, 0xc0, 0xa8, 0x7a, 0x64, 0x04, 0x38, 0xf3, 0xbb, 0x56, 0xe6, 0xef, 0x2d, 0x3e, 0x73, 0xad, 0x69, 0x50, 0x10, 0x01, 0xc9, 0x0d, 0xa7, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; /* * packet_build_tcp() * -> ETH->IPv4->TCP * -> with TCP options * -> with TCP payload */ #if 1 TEST(PACKET_BUILD_TCP, ETH_IP4_TCP) { struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data1, sizeof(data1)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct packet *new_pkt = packet_build_tcp(&orig_pkt, 1, 2, TH_ACK, (const char *)&ts_pad_opt, sizeof(ts_pad_opt), "Hello", 5); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-ipv4-tcp.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len - 6 == // trim Eth padding: 000000000000 new_pkt_len - 12 - 5); // trim TCP options, TCP payload int count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 57); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0xb7e1); break; } if (layer->proto == LAYER_PROTO_TCP) { const struct tcphdr *tcp = (const struct tcphdr *)layer->hdr.raw; EXPECT_TRUE(tcp_hdr_get_seq(tcp) == 1); EXPECT_TRUE(tcp_hdr_get_ack(tcp) == 2); EXPECT_TRUE(tcp_hdr_get_flags(tcp) == TH_ACK); EXPECT_TRUE(tcp_hdr_get_hdr_len(tcp) == 32); EXPECT_TRUE(tcp_hdr_get_checksum(tcp) == 0xaf73); break; } } for (uint16_t i = 0; i < new_pkt_len - 12 - 5; i++) { if ((16 <= i && i <= 17) || // skip IPv4 total length (24 <= i && i <= 25)) // skip IPv4 checksum { continue; } if ((38 <= i && i <= 41) || // skip TCP seq (42 <= i && i <= 45) || // skip TCP ack i == 46 || // skip TCP data offset i == 47 || // skip TCP flags (50 <= i && i <= 51)) // skip TCP checksum { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif /****************************************************************************** * [Protocols in frame: eth:ethertype:ip:ipv6:tcp] ****************************************************************************** * * Frame 1: 106 bytes on wire (848 bits), 106 bytes captured (848 bits) * Ethernet II, Src: JuniperN_45:88:29 (2c:6b:f5:45:88:29), Dst: JuniperN_2a:a2:00 (5c:5e:ab:2a:a2:00) * Destination: JuniperN_2a:a2:00 (5c:5e:ab:2a:a2:00) * Source: JuniperN_45:88:29 (2c:6b:f5:45:88:29) * Type: IPv4 (0x0800) * Internet Protocol Version 4, Src: 210.77.88.163, Dst: 59.66.4.50 * 0100 .... = Version: 4 * .... 0101 = Header Length: 20 bytes (5) * Differentiated Services Field: 0x00 (DSCP: CS0, ECN: Not-ECT) * Total Length: 92 * Identification: 0x0b4d (2893) * 000. .... = Flags: 0x0 * ...0 0000 0000 0000 = Fragment Offset: 0 * Time to Live: 59 * Protocol: IPv6 (41) * Header Checksum: 0x09c8 [validation disabled] * [Header checksum status: Unverified] * Source Address: 210.77.88.163 * Destination Address: 59.66.4.50 * Internet Protocol Version 6, Src: 2001:da8:200:900e:200:5efe:d24d:58a3, Dst: 2600:140e:6::1702:1058 * 0110 .... = Version: 6 * .... 0000 0000 .... .... .... .... .... = Traffic Class: 0x00 (DSCP: CS0, ECN: Not-ECT) * .... 0000 0000 0000 0000 0000 = Flow Label: 0x00000 * Payload Length: 32 * Next Header: TCP (6) * Hop Limit: 64 * Source Address: 2001:da8:200:900e:200:5efe:d24d:58a3 * Destination Address: 2600:140e:6::1702:1058 * [Source ISATAP IPv4: 210.77.88.163] * Transmission Control Protocol, Src Port: 52556, Dst Port: 80, Seq: 0, Len: 0 * Source Port: 52556 * Destination Port: 80 * [Stream index: 0] * [Conversation completeness: Complete, WITH_DATA (31)] * [TCP Segment Len: 0] * Sequence Number: 0 (relative sequence number) * Sequence Number (raw): 2172673142 * [Next Sequence Number: 1 (relative sequence number)] * Acknowledgment Number: 0 * Acknowledgment number (raw): 0 * 1000 .... = Header Length: 32 bytes (8) * Flags: 0x002 (SYN) * Window: 8192 * [Calculated window size: 8192] * Checksum: 0xf757 [unverified] * [Checksum Status: Unverified] * Urgent Pointer: 0 * Options: (12 bytes), Maximum segment size, No-Operation (NOP), Window scale, No-Operation (NOP), No-Operation (NOP), SACK permitted * [Timestamps] */ unsigned char data2[] = { 0x5c, 0x5e, 0xab, 0x2a, 0xa2, 0x00, 0x2c, 0x6b, 0xf5, 0x45, 0x88, 0x29, 0x08, 0x00, 0x45, 0x00, 0x00, 0x5c, 0x0b, 0x4d, 0x00, 0x00, 0x3b, 0x29, 0x09, 0xc8, 0xd2, 0x4d, 0x58, 0xa3, 0x3b, 0x42, 0x04, 0x32, 0x60, 0x00, 0x00, 0x00, 0x00, 0x20, 0x06, 0x40, 0x20, 0x01, 0x0d, 0xa8, 0x02, 0x00, 0x90, 0x0e, 0x02, 0x00, 0x5e, 0xfe, 0xd2, 0x4d, 0x58, 0xa3, 0x26, 0x00, 0x14, 0x0e, 0x00, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x17, 0x02, 0x10, 0x58, 0xcd, 0x4c, 0x00, 0x50, 0x81, 0x80, 0x5c, 0x76, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20, 0x00, 0xf7, 0x57, 0x00, 0x00, 0x02, 0x04, 0x04, 0xc4, 0x01, 0x03, 0x03, 0x08, 0x01, 0x01, 0x04, 0x02}; /* * packet_build_tcp() * -> ETH->IPv4->IPv6->TCP * -> with TCP payload */ #if 1 TEST(PACKET_BUILD_TCP, ETH_IP4_IP6_TCP) { struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data2, sizeof(data2)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct packet *new_pkt = packet_build_tcp(&orig_pkt, 1234, 2345, TH_ACK, NULL, 0, "Hello", 5); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-ipv4-ipv6-tcp.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len - 12 == // trim TCP options new_pkt_len - 5); // trim TCP payload int count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 85); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0x09cf); break; } if (layer->proto == LAYER_PROTO_IPV6) { const struct ip6_hdr *ip6 = (const struct ip6_hdr *)layer->hdr.raw; EXPECT_TRUE(ip6_hdr_get_payload_len(ip6) == 25); break; } if (layer->proto == LAYER_PROTO_TCP) { const struct tcphdr *tcp = (const struct tcphdr *)layer->hdr.raw; EXPECT_TRUE(tcp_hdr_get_seq(tcp) == 1234); EXPECT_TRUE(tcp_hdr_get_ack(tcp) == 2345); EXPECT_TRUE(tcp_hdr_get_flags(tcp) == TH_ACK); EXPECT_TRUE(tcp_hdr_get_hdr_len(tcp) == 20); EXPECT_TRUE(tcp_hdr_get_checksum(tcp) == 0xe350); break; } } for (uint16_t i = 0; i < new_pkt_len - 5; i++) { if ((16 <= i && i <= 17) || // skip IPv4 total length (24 <= i && i <= 25)) // skip IPv4 checksum { continue; } if (38 <= i && i <= 39) // skip IPv6 payload length { continue; } if ((78 <= i && i <= 81) || // skip TCP seq (82 <= i && i <= 85) || // skip TCP ack i == 86 || // skip TCP data offset i == 87 || // skip TCP flags (90 <= i && i <= 91)) // skip TCP checksum { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif /****************************************************************************** * [Protocols in frame: eth:ethertype:ipv6:udp:gtp:ip:tcp:ja3:tls] ****************************************************************************** * * Frame 1: 1470 bytes on wire (11760 bits), 1470 bytes captured (11760 bits) * Ethernet II, Src: HuaweiTe_62:ee:70 (60:d7:55:62:ee:70), Dst: zte_0e:f5:1c (74:4a:a4:0e:f5:1c) * Destination: zte_0e:f5:1c (74:4a:a4:0e:f5:1c) * Source: HuaweiTe_62:ee:70 (60:d7:55:62:ee:70) * Type: IPv6 (0x86dd) * Internet Protocol Version 6, Src: 2409:8034:4025::50:a31, Dst: 2409:8034:4040:5301::204 * 0110 .... = Version: 6 * .... 0000 0000 .... .... .... .... .... = Traffic Class: 0x00 (DSCP: CS0, ECN: Not-ECT) * .... 0000 0000 0000 0000 0000 = Flow Label: 0x00000 * Payload Length: 1416 * Next Header: UDP (17) * Hop Limit: 252 * Source Address: 2409:8034:4025::50:a31 * Destination Address: 2409:8034:4040:5301::204 * User Datagram Protocol, Src Port: 2152, Dst Port: 2152 * Source Port: 2152 * Destination Port: 2152 * Length: 1416 * Checksum: 0xc8df [unverified] * [Checksum Status: Unverified] * [Stream index: 0] * [Timestamps] * UDP payload (1408 bytes) * GPRS Tunneling Protocol * Flags: 0x30 * Message Type: T-PDU (0xff) * Length: 1400 * TEID: 0x6c2a4753 (1814710099) * Internet Protocol Version 4, Src: 10.49.115.138, Dst: 121.196.250.66 * 0100 .... = Version: 4 * .... 0101 = Header Length: 20 bytes (5) * Differentiated Services Field: 0x00 (DSCP: CS0, ECN: Not-ECT) * Total Length: 1400 * Identification: 0x0003 (3) * 010. .... = Flags: 0x2, Don't fragment * ...0 0000 0000 0000 = Fragment Offset: 0 * Time to Live: 64 * Protocol: TCP (6) * Header Checksum: 0x43bb [validation disabled] * [Header checksum status: Unverified] * Source Address: 10.49.115.138 * Destination Address: 121.196.250.66 * Transmission Control Protocol, Src Port: 50081, Dst Port: 443, Seq: 1, Ack: 1, Len: 1348 * Source Port: 50081 * Destination Port: 443 * [Stream index: 0] * [Conversation completeness: Incomplete (8)] * [TCP Segment Len: 1348] * Sequence Number: 1 (relative sequence number) * Sequence Number (raw): 1522577104 * [Next Sequence Number: 1349 (relative sequence number)] * Acknowledgment Number: 1 (relative ack number) * Acknowledgment number (raw): 3419365570 * 1000 .... = Header Length: 32 bytes (8) * Flags: 0x010 (ACK) * Window: 2038 * [Calculated window size: 2038] * [Window size scaling factor: -1 (unknown)] * Checksum: 0xd3c2 [unverified] * [Checksum Status: Unverified] * Urgent Pointer: 0 * Options: (12 bytes), No-Operation (NOP), No-Operation (NOP), Timestamps * [Timestamps] * [SEQ/ACK analysis] * TCP payload (1348 bytes) * Transport Layer Security */ unsigned char data3[] = { 0x74, 0x4a, 0xa4, 0x0e, 0xf5, 0x1c, 0x60, 0xd7, 0x55, 0x62, 0xee, 0x70, 0x86, 0xdd, 0x60, 0x00, 0x00, 0x00, 0x05, 0x88, 0x11, 0xfc, 0x24, 0x09, 0x80, 0x34, 0x40, 0x25, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x50, 0x0a, 0x31, 0x24, 0x09, 0x80, 0x34, 0x40, 0x40, 0x53, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x04, 0x08, 0x68, 0x08, 0x68, 0x05, 0x88, 0xc8, 0xdf, 0x30, 0xff, 0x05, 0x78, 0x6c, 0x2a, 0x47, 0x53, 0x45, 0x00, 0x05, 0x78, 0x00, 0x03, 0x40, 0x00, 0x40, 0x06, 0x43, 0xbb, 0x0a, 0x31, 0x73, 0x8a, 0x79, 0xc4, 0xfa, 0x42, 0xc3, 0xa1, 0x01, 0xbb, 0x5a, 0xc0, 0xae, 0xd0, 0xcb, 0xcf, 0x60, 0xc2, 0x80, 0x10, 0x07, 0xf6, 0xd3, 0xc2, 0x00, 0x00, 0x01, 0x01, 0x08, 0x0a, 0x85, 0x14, 0x0e, 0xb0, 0xcc, 0x45, 0xf8, 0x5f, 0xef, 0x49, 0x45, 0xa0, 0xbe, 0x21, 0xd6, 0x46, 0x9f, 0xb5, 0x17, 0xb2, 0xfe, 0x61, 0x2d, 0xed, 0x4f, 0x0c, 0x1e, 0xb5, 0xda, 0x91, 0x40, 0x87, 0xab, 0x02, 0x0d, 0x01, 0xc8, 0xf1, 0x24, 0x05, 0x8a, 0x9d, 0x8d, 0xfc, 0xbb, 0x82, 0x24, 0xf5, 0x7d, 0x2d, 0x10, 0x66, 0x30, 0x2a, 0xaa, 0x4a, 0x51, 0x8d, 0xe9, 0x9a, 0x65, 0xcf, 0x89, 0x0c, 0x9e, 0x0d, 0x82, 0xda, 0x5e, 0xd3, 0x98, 0xe3, 0x23, 0xf7, 0x5a, 0xd4, 0x88, 0x94, 0xd2, 0xdf, 0xbe, 0x44, 0x20, 0x2b, 0x21, 0x2d, 0x38, 0xca, 0x29, 0x5e, 0xa3, 0xb7, 0xbb, 0x34, 0x20, 0x42, 0x02, 0x71, 0x04, 0xda, 0xd2, 0xeb, 0xb8, 0x81, 0xa3, 0x48, 0xc8, 0x54, 0xad, 0x42, 0x35, 0xc4, 0x4f, 0x6b, 0x15, 0x50, 0x22, 0x3e, 0x26, 0xb3, 0xfc, 0x30, 0x49, 0x71, 0x6f, 0x41, 0x66, 0xa2, 0x2e, 0xe9, 0xd3, 0x1a, 0x69, 0xa8, 0x87, 0x71, 0x65, 0xa2, 0xc7, 0xc7, 0x2b, 0x25, 0x1d, 0x3f, 0xfb, 0xe6, 0x05, 0xe1, 0x09, 0xb9, 0x76, 0x1d, 0xb9, 0xf9, 0xaf, 0xb4, 0x79, 0xa1, 0x35, 0x05, 0x59, 0x88, 0xa0, 0x07, 0xb5, 0x2d, 0x02, 0x11, 0x0a, 0x89, 0xf1, 0x67, 0xdb, 0xe5, 0x5c, 0x5c, 0xaa, 0x0e, 0x21, 0xa6, 0xa4, 0x1a, 0x9f, 0x9e, 0xc8, 0x2a, 0x36, 0x6f, 0xcc, 0xa3, 0x13, 0x78, 0xf1, 0xbe, 0x34, 0xa0, 0x35, 0xef, 0x1f, 0xf4, 0x79, 0xcb, 0x37, 0x3e, 0x77, 0x14, 0xfb, 0x2e, 0x21, 0x4f, 0x6b, 0xe5, 0xe9, 0x3a, 0x90, 0x76, 0xa8, 0x55, 0x09, 0xb6, 0x68, 0xbf, 0x66, 0xae, 0xf1, 0x55, 0xc0, 0x76, 0x8f, 0x16, 0x86, 0x49, 0x9a, 0x88, 0x01, 0xdb, 0x78, 0x1f, 0xde, 0xc2, 0x33, 0x92, 0xe3, 0x22, 0xc6, 0x8c, 0x20, 0x17, 0xa0, 0xb2, 0x79, 0xf4, 0x60, 0x8e, 0x98, 0x53, 0xcd, 0x8f, 0xb2, 0x8f, 0x80, 0xda, 0x9f, 0xf6, 0x00, 0x0c, 0xf8, 0x6b, 0xdf, 0x7d, 0x93, 0x48, 0x5a, 0x23, 0x35, 0x0e, 0x1b, 0xf7, 0x50, 0x87, 0x93, 0x29, 0xaa, 0xa1, 0xb8, 0x98, 0x9f, 0x89, 0xb2, 0x0a, 0x02, 0x27, 0x95, 0x01, 0x84, 0x5a, 0x09, 0xb8, 0xff, 0x23, 0x02, 0x89, 0xef, 0x1b, 0x64, 0xb2, 0x38, 0x81, 0xc4, 0x36, 0xe3, 0xda, 0xb5, 0x3b, 0x80, 0x45, 0x52, 0x96, 0xab, 0x0e, 0xdb, 0xb6, 0x9c, 0xcb, 0xc4, 0xe5, 0xb9, 0x72, 0x67, 0x57, 0x4b, 0xb9, 0x55, 0xcb, 0x6b, 0xc4, 0xec, 0x46, 0x4d, 0xa3, 0xe0, 0xda, 0xba, 0x70, 0x3d, 0xa6, 0xa7, 0x3f, 0x58, 0xd2, 0x9f, 0xb0, 0x11, 0x66, 0xaf, 0x73, 0x09, 0x60, 0x6e, 0xe0, 0x71, 0xa5, 0x65, 0x41, 0x28, 0x3e, 0x70, 0x1d, 0x25, 0x77, 0x6a, 0x4e, 0xed, 0xb9, 0x27, 0x6c, 0xf0, 0xba, 0x54, 0x8d, 0x77, 0xfb, 0xb6, 0x4e, 0xe2, 0xab, 0x8f, 0xe3, 0xd4, 0x02, 0x65, 0x0a, 0x49, 0xf3, 0xf9, 0xc7, 0x09, 0x76, 0x81, 0xf4, 0xf8, 0x3e, 0x1f, 0x74, 0x30, 0xaf, 0x3b, 0x9e, 0x97, 0x00, 0xde, 0xd8, 0x9a, 0xaf, 0xcc, 0x72, 0xeb, 0x0a, 0xe7, 0xab, 0xc1, 0x53, 0x62, 0x3f, 0x08, 0xba, 0x43, 0x06, 0x13, 0x0a, 0x3b, 0x5c, 0xb4, 0xe0, 0xc8, 0xa6, 0x41, 0x45, 0xaa, 0x1a, 0xc9, 0x88, 0x86, 0x31, 0x25, 0x02, 0x4a, 0x76, 0x66, 0xb6, 0x6d, 0xff, 0x50, 0x1d, 0x3c, 0xf3, 0x2d, 0xfe, 0x7b, 0xb2, 0x75, 0x5d, 0x9a, 0x9a, 0xe5, 0x39, 0x31, 0x4f, 0x7b, 0xa5, 0x6f, 0x94, 0xed, 0x31, 0xd4, 0x61, 0xc7, 0x44, 0x1d, 0x37, 0x19, 0x76, 0x04, 0x0e, 0xbd, 0xc4, 0x9e, 0xe3, 0xdf, 0x94, 0x49, 0x32, 0x65, 0xd0, 0x37, 0x64, 0xb5, 0x2a, 0x61, 0x2d, 0x05, 0xc5, 0xe5, 0x79, 0x3e, 0xcf, 0x5f, 0x77, 0x0a, 0x7c, 0x29, 0x34, 0x1a, 0x45, 0x7e, 0x11, 0x68, 0xb4, 0x3a, 0xf6, 0x5b, 0x23, 0xe4, 0x32, 0xa4, 0x11, 0x1a, 0xba, 0xd6, 0x4a, 0x45, 0x42, 0x29, 0xac, 0xb0, 0x17, 0x05, 0x1b, 0xee, 0xf6, 0x52, 0x6d, 0x8b, 0xb4, 0x3b, 0x63, 0xe2, 0xca, 0xbf, 0x7e, 0xd3, 0xf7, 0x96, 0x75, 0x67, 0x9d, 0x27, 0x15, 0x39, 0xde, 0x5f, 0x66, 0x74, 0x7c, 0x46, 0x01, 0x48, 0xf7, 0x99, 0x33, 0x7d, 0xc6, 0x81, 0xc4, 0x82, 0x09, 0x00, 0x20, 0x3f, 0x5c, 0xe4, 0x51, 0x88, 0x5b, 0xac, 0x31, 0x17, 0x04, 0xa4, 0xac, 0xbf, 0x3d, 0xff, 0xad, 0x51, 0x07, 0x0b, 0xc7, 0x26, 0xa7, 0x9f, 0x83, 0x17, 0xd8, 0x2f, 0x6a, 0x47, 0x96, 0x14, 0x47, 0x68, 0xd4, 0xc0, 0xc0, 0x3b, 0x87, 0x51, 0x30, 0xe9, 0xfa, 0x21, 0x46, 0x80, 0x1a, 0x5a, 0xef, 0x78, 0xd0, 0x3a, 0xac, 0x73, 0x1e, 0x39, 0xba, 0x82, 0x43, 0x5d, 0xef, 0x15, 0x2c, 0x9a, 0xe5, 0xeb, 0x6a, 0xe7, 0x24, 0x12, 0xe6, 0x2a, 0xd2, 0x09, 0xc2, 0x85, 0x69, 0x9d, 0x73, 0x16, 0xb0, 0xad, 0x51, 0xf8, 0x3d, 0x94, 0x6b, 0xb7, 0xb3, 0x7f, 0xb4, 0x9e, 0xc1, 0xdc, 0x31, 0x27, 0xa1, 0x2d, 0xfe, 0x30, 0x15, 0x04, 0x20, 0x82, 0xdc, 0xbd, 0x8b, 0xc5, 0xb4, 0xcf, 0x91, 0x85, 0xae, 0x21, 0x5e, 0x00, 0x10, 0x04, 0x62, 0x8a, 0xe2, 0x66, 0x74, 0xf8, 0x8d, 0x8b, 0x52, 0x17, 0xd9, 0x1a, 0xbd, 0x06, 0x2d, 0x07, 0x6a, 0xf5, 0x8b, 0xdf, 0x85, 0x2e, 0x36, 0xec, 0x15, 0x6f, 0x7e, 0xd2, 0x04, 0x43, 0x6a, 0xd7, 0x60, 0xf5, 0x53, 0x0d, 0x2e, 0x2d, 0xf5, 0x52, 0x4c, 0xcc, 0xe5, 0xf4, 0x47, 0xdd, 0x34, 0xda, 0xc1, 0xfc, 0x60, 0x00, 0xaa, 0x68, 0x01, 0x5c, 0x82, 0x4b, 0xf9, 0x57, 0x54, 0x9d, 0xd5, 0x8b, 0xb6, 0x42, 0x77, 0xd4, 0x47, 0x70, 0x23, 0x4c, 0xad, 0xc5, 0x00, 0x73, 0x9b, 0xbb, 0x65, 0xa7, 0x46, 0x74, 0xcd, 0x2e, 0x61, 0x0f, 0xac, 0xeb, 0x53, 0x5a, 0x87, 0x70, 0xfc, 0x5d, 0x2e, 0xa1, 0xe3, 0x9a, 0x87, 0x01, 0x0f, 0x2e, 0xef, 0x10, 0xe2, 0x82, 0xd8, 0x12, 0xe7, 0xb8, 0x94, 0xa4, 0xdd, 0x5f, 0xea, 0x21, 0x63, 0x26, 0x43, 0xec, 0xc3, 0x54, 0x76, 0xb1, 0xb2, 0x1c, 0x03, 0x4c, 0x5c, 0x22, 0xb5, 0x00, 0x7d, 0x77, 0x3a, 0xb6, 0xbf, 0x50, 0xbd, 0xfd, 0x0a, 0x31, 0x2c, 0xdc, 0xab, 0xe2, 0xc0, 0x0b, 0xb6, 0x66, 0xad, 0x9c, 0xca, 0x94, 0xed, 0xd8, 0x77, 0x1b, 0xf1, 0x94, 0xdd, 0x65, 0x61, 0xda, 0x7b, 0x04, 0x3c, 0x93, 0xcf, 0x96, 0x74, 0x35, 0x8e, 0x41, 0xe1, 0xa4, 0xbc, 0xf2, 0x4f, 0xe9, 0xb8, 0x16, 0x55, 0x05, 0x5a, 0xac, 0x10, 0xd3, 0xdf, 0xea, 0x6a, 0xf8, 0xe0, 0xf3, 0xdf, 0x66, 0x00, 0xab, 0x3d, 0xb9, 0x44, 0x65, 0x34, 0x49, 0x89, 0xf2, 0x1d, 0x09, 0xc9, 0xfc, 0xa5, 0x84, 0xa1, 0x03, 0x5b, 0x7a, 0x5c, 0x7e, 0x21, 0xe9, 0xb4, 0x3a, 0x4c, 0x2b, 0x94, 0x64, 0x1d, 0x9b, 0xa5, 0xbf, 0x7e, 0x1c, 0x97, 0x7e, 0x3d, 0xbe, 0x84, 0xfc, 0xab, 0x6d, 0x2a, 0x50, 0x23, 0x9e, 0x11, 0x3f, 0xe2, 0xa0, 0x68, 0xe7, 0xd5, 0xba, 0x5e, 0x24, 0x8c, 0x4c, 0x46, 0xe6, 0x5b, 0x10, 0xc3, 0x82, 0x32, 0x17, 0x32, 0xdc, 0xec, 0xaa, 0x1e, 0x73, 0xe5, 0x7d, 0xb8, 0x1c, 0x6c, 0x4c, 0x9f, 0x60, 0x7b, 0x66, 0x4c, 0x90, 0x69, 0xc4, 0x23, 0x66, 0x67, 0xce, 0x6d, 0x24, 0x1d, 0xcc, 0x8e, 0x78, 0xa1, 0xa7, 0xde, 0x87, 0x81, 0xac, 0x62, 0x54, 0xbc, 0x47, 0x82, 0x3c, 0xad, 0x92, 0x29, 0xd9, 0xc0, 0xed, 0x0c, 0x11, 0x0e, 0xc5, 0x75, 0xa4, 0xbd, 0xbf, 0xcb, 0x3a, 0xaf, 0x2b, 0x9f, 0xbe, 0xbb, 0xbc, 0x31, 0x07, 0xa7, 0xbe, 0x6c, 0xa9, 0x4e, 0xff, 0x35, 0x80, 0x2f, 0x09, 0x77, 0xe0, 0xc0, 0xdc, 0x9c, 0xc6, 0xa6, 0x63, 0xab, 0x47, 0x74, 0x5f, 0x5c, 0xae, 0x75, 0xbf, 0x42, 0x67, 0x55, 0x89, 0xcf, 0xd3, 0x65, 0x8d, 0x5b, 0x6f, 0x5c, 0xf9, 0xd1, 0x78, 0xa2, 0xfd, 0x4f, 0x54, 0x6a, 0x71, 0x0c, 0x58, 0x13, 0xb0, 0x48, 0x0a, 0x7b, 0xcc, 0x84, 0x61, 0xa7, 0x7d, 0x39, 0xa2, 0xd1, 0xc0, 0xdb, 0x8e, 0x97, 0x20, 0x86, 0x97, 0x20, 0xda, 0xca, 0x56, 0x78, 0x61, 0xc2, 0x2f, 0x36, 0xdb, 0x95, 0xae, 0x7e, 0x8d, 0x97, 0xcb, 0x45, 0x6a, 0x6d, 0x27, 0xaa, 0xab, 0x4e, 0x88, 0x23, 0xb6, 0x6a, 0x8a, 0xca, 0x71, 0xca, 0x39, 0xa2, 0x98, 0x0d, 0x53, 0xa9, 0x38, 0xd5, 0x9c, 0x5d, 0x0e, 0x5e, 0xc9, 0xeb, 0x21, 0xab, 0x00, 0xca, 0xff, 0x92, 0x20, 0x9d, 0x65, 0x9d, 0x8d, 0x49, 0x46, 0xbe, 0x51, 0x97, 0xc1, 0x61, 0x02, 0x9e, 0xa8, 0xb9, 0x2c, 0x27, 0x7d, 0x73, 0xf9, 0x12, 0x16, 0x45, 0x25, 0xbb, 0xb0, 0x51, 0x14, 0x18, 0x07, 0xab, 0xc7, 0x06, 0xc0, 0xe9, 0x1c, 0xf8, 0x6d, 0xe1, 0x80, 0x21, 0x21, 0x68, 0x24, 0xf7, 0x28, 0xb9, 0x07, 0xd4, 0xd7, 0xdf, 0x3e, 0xff, 0xbc, 0xe3, 0xbc, 0x6e, 0x42, 0x76, 0x63, 0xbc, 0x82, 0x0a, 0xf5, 0x99, 0x65, 0x17, 0xd2, 0x38, 0xa9, 0xa8, 0x31, 0xce, 0x1f, 0xf7, 0xef, 0x8d, 0x94, 0xae, 0x99, 0x50, 0x30, 0x12, 0xbd, 0x4b, 0x65, 0x56, 0x59, 0xfb, 0x33, 0x7b, 0x99, 0xc7, 0xe5, 0x80, 0xe6, 0x92, 0x0e, 0x44, 0x1d, 0x17, 0xc2, 0xd0, 0x78, 0x76, 0x9d, 0x5b, 0x7d, 0x3c, 0xb4, 0xf8, 0xcb, 0x2f, 0x83, 0x23, 0x35, 0x49, 0xc0, 0x78, 0x2d, 0x44, 0x05, 0x64, 0x0f, 0xaa, 0x84, 0x9d, 0x3f, 0xac, 0xef, 0x5b, 0x46, 0x44, 0xb8, 0x15, 0xbe, 0x4f, 0xe7, 0x25, 0xb7, 0xa0, 0xc8, 0x0f, 0x70, 0x1a, 0xca, 0x7f, 0xce, 0x79, 0x7b, 0xf5, 0x7e, 0x21, 0x35, 0xc7, 0x0e, 0x99, 0xdc, 0x76, 0xe0, 0x36, 0x09, 0x6e, 0x6d, 0x5f, 0x98, 0x5e, 0xb8, 0xa4, 0x88, 0xea, 0x0b, 0x4b, 0x21, 0xa2, 0x52, 0x86, 0x95, 0x4e, 0x18, 0xac, 0xa2, 0xaf, 0x29, 0x5b, 0xe7, 0x05, 0xa1, 0xc8, 0xe1, 0x80, 0xfa, 0xb6, 0x5a, 0xed, 0x94, 0x32, 0x4f, 0xe9, 0xf5, 0xf0, 0x61, 0x5d, 0x7f, 0xc4, 0xc4, 0xd1, 0x05, 0x54, 0x13, 0xdb}; /* * packet_build_tcp() * -> ETH->IPv6->UDP->GTP->IPv4->TCP * -> with TCP payload */ #if 1 TEST(PACKET_BUILD_TCP, ETH_IP6_UDP_GTP_IP4_TCP) { struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data3, sizeof(data3)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct packet *new_pkt = packet_build_tcp(&orig_pkt, 1, 2, TH_ACK, NULL, 0, "Hello", 5); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-ipv6-udp-gtp-ipv4-tcp.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len - 12 - 1348 == // trim TCP options, TCP payload new_pkt_len - 5); // trim TCP payload int count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV6) { const struct ip6_hdr *ip6 = (const struct ip6_hdr *)layer->hdr.raw; EXPECT_TRUE(ip6_hdr_get_payload_len(ip6) == 61); break; } if (layer->proto == LAYER_PROTO_UDP) { const struct udphdr *udp = (const struct udphdr *)layer->hdr.raw; EXPECT_TRUE(udp_hdr_get_total_len(udp) == 61); EXPECT_TRUE(udp_hdr_get_checksum(udp) == 0xd375); break; } if (layer->proto == LAYER_PROTO_GTP_U) { EXPECT_TRUE(peek_gtp_version(layer->hdr.raw, layer->hdr_len) == 1); const struct gtp1_hdr *gtp1 = (const struct gtp1_hdr *)layer->hdr.raw; EXPECT_TRUE(gtp1_hdr_get_msg_len(gtp1) == 45); break; } if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 45); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0x4906); break; } if (layer->proto == LAYER_PROTO_TCP) { const struct tcphdr *tcp = (const struct tcphdr *)layer->hdr.raw; EXPECT_TRUE(tcp_hdr_get_seq(tcp) == 1); EXPECT_TRUE(tcp_hdr_get_ack(tcp) == 2); EXPECT_TRUE(tcp_hdr_get_flags(tcp) == TH_ACK); EXPECT_TRUE(tcp_hdr_get_hdr_len(tcp) == 20); EXPECT_TRUE(tcp_hdr_get_checksum(tcp) == 0xcce5); break; } } for (uint16_t i = 0; i < new_pkt_len - 5; i++) { if (18 <= i && i <= 19) // skip IPv6 payload length { continue; } if ((58 <= i && i <= 59) || // skip UDP length (60 <= i && i <= 61)) // skip UDP checksum { continue; } if ((64 <= i && i <= 65)) // skip gtp length { continue; } if ((72 <= i && i <= 73) || // skip IPv4 total length (80 <= i && i <= 81)) // skip IPv4 checksum { continue; } if ((94 <= i && i <= 98) || // skip TCP seq (99 <= i && i <= 103) || // skip TCP ack i == 104 || // skip TCP data offset i == 105 || // skip TCP flags (106 <= i && i <= 107)) // skip TCP checksum { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif /****************************************************************************** * [Protocols in frame: eth:ethertype:ip:gre:ipv6:tcp] ****************************************************************************** * * Frame 1: 102 bytes on wire (816 bits), 102 bytes captured (816 bits) * Ethernet II, Src: a0:b1:c2:d3:e4:f5 (a0:b1:c2:d3:e4:f5), Dst: CIMSYS_33:44:55 (00:11:22:33:44:55) * Destination: CIMSYS_33:44:55 (00:11:22:33:44:55) * Address: CIMSYS_33:44:55 (00:11:22:33:44:55) * .... ..0. .... .... .... .... = LG bit: Globally unique address (factory default) * .... ...0 .... .... .... .... = IG bit: Individual address (unicast) * Source: a0:b1:c2:d3:e4:f5 (a0:b1:c2:d3:e4:f5) * Address: a0:b1:c2:d3:e4:f5 (a0:b1:c2:d3:e4:f5) * .... ..0. .... .... .... .... = LG bit: Globally unique address (factory default) * .... ...0 .... .... .... .... = IG bit: Individual address (unicast) * Type: IPv4 (0x0800) * Internet Protocol Version 4, Src: 10.0.0.1, Dst: 192.168.1.1 * 0100 .... = Version: 4 * .... 0101 = Header Length: 20 bytes (5) * Differentiated Services Field: 0x00 (DSCP: CS0, ECN: Not-ECT) * 0000 00.. = Differentiated Services Codepoint: Default (0) * .... ..00 = Explicit Congestion Notification: Not ECN-Capable Transport (0) * Total Length: 88 * Identification: 0x0001 (1) * 000. .... = Flags: 0x0 * 0... .... = Reserved bit: Not set * .0.. .... = Don't fragment: Not set * ..0. .... = More fragments: Not set * ...0 0000 0000 0000 = Fragment Offset: 0 * Time to Live: 64 * Protocol: Generic Routing Encapsulation (47) * Header Checksum: 0xaecc [correct] * [Header checksum status: Good] * [Calculated Checksum: 0xaecc] * Source Address: 10.0.0.1 * Destination Address: 192.168.1.1 * Generic Routing Encapsulation (IPv6) * Flags and Version: 0x8000 * 1... .... .... .... = Checksum Bit: Yes * .0.. .... .... .... = Routing Bit: No * ..0. .... .... .... = Key Bit: No * ...0 .... .... .... = Sequence Number Bit: No * .... 0... .... .... = Strict Source Route Bit: No * .... .000 .... .... = Recursion control: 0 * .... .... 0000 0... = Flags (Reserved): 0 * .... .... .... .000 = Version: GRE (0) * Protocol Type: IPv6 (0x86dd) * Checksum: 0x92e7 [correct] * [Checksum Status: Good] * Offset: 0 * Internet Protocol Version 6, Src: ::, Dst: 2001:db8::1 * 0110 .... = Version: 6 * .... 0000 0000 .... .... .... .... .... = Traffic Class: 0x00 (DSCP: CS0, ECN: Not-ECT) * .... 0000 00.. .... .... .... .... .... = Differentiated Services Codepoint: Default (0) * .... .... ..00 .... .... .... .... .... = Explicit Congestion Notification: Not ECN-Capable Transport (0) * .... 0000 0000 0000 0000 0000 = Flow Label: 0x00000 * Payload Length: 20 * Next Header: TCP (6) * Hop Limit: 64 * Source Address: :: * Destination Address: 2001:db8::1 * Transmission Control Protocol, Src Port: 12345, Dst Port: 80, Seq: 0, Len: 0 * Source Port: 12345 * Destination Port: 80 * [Stream index: 0] * [Conversation completeness: Incomplete, SYN_SENT (1)] * ..0. .... = RST: Absent * ...0 .... = FIN: Absent * .... 0... = Data: Absent * .... .0.. = ACK: Absent * .... ..0. = SYN-ACK: Absent * .... ...1 = SYN: Present * [Completeness Flags: ·····S] * [TCP Segment Len: 0] * Sequence Number: 0 * [Next Sequence Number: 1] * Acknowledgment Number: 0 * Acknowledgment number (raw): 0 * 0101 .... = Header Length: 20 bytes (5) * Flags: 0x002 (SYN) * 000. .... .... = Reserved: Not set * ...0 .... .... = Accurate ECN: Not set * .... 0... .... = Congestion Window Reduced: Not set * .... .0.. .... = ECN-Echo: Not set * .... ..0. .... = Urgent: Not set * .... ...0 .... = Acknowledgment: Not set * .... .... 0... = Push: Not set * .... .... .0.. = Reset: Not set * .... .... ..1. = Syn: Set * [Expert Info (Chat/Sequence): Connection establish request (SYN): server port 80] * [Connection establish request (SYN): server port 80] * [Severity level: Chat] * [Group: Sequence] * .... .... ...0 = Fin: Not set * [TCP Flags: ··········S·] * Window: 8192 * [Calculated window size: 8192] * Checksum: 0x31a0 [correct] * [Calculated Checksum: 0x31a0] * [Checksum Status: Good] * Urgent Pointer: 0 * [Timestamps] * [Time since first frame in this TCP stream: 0.000000000 seconds] * [Time since previous frame in this TCP stream: 0.000000000 seconds] */ unsigned char data4[] = { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0xa0, 0xb1, 0xc2, 0xd3, 0xe4, 0xf5, 0x08, 0x00, 0x45, 0x00, 0x00, 0x58, 0x00, 0x01, 0x00, 0x00, 0x40, 0x2f, 0xae, 0xcc, 0x0a, 0x00, 0x00, 0x01, 0xc0, 0xa8, 0x01, 0x01, 0x80, 0x00, 0x86, 0xdd, 0x92, 0xe7, 0x00, 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x14, 0x06, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x20, 0x01, 0x0d, 0xb8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x30, 0x39, 0x00, 0x50, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x50, 0x02, 0x20, 0x00, 0x31, 0xa0, 0x00, 0x00}; /* * packet_build_tcp() * -> ETH->IPv4->GRE->IPv6->TCP * -> with TCP payload * -> with GRE checksum */ #if 1 TEST(PACKET_BUILD_TCP, ETH_IP4_GRE_IP6_TCP) { struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data4, sizeof(data4)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct packet *new_pkt = packet_build_tcp(&orig_pkt, 1, 2, TH_ACK, NULL, 0, "Hello", 5); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-ipv4-gre-ipv6-tcp.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len == new_pkt_len - 5); // trim TCP payload int count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 93); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0xaec7); break; } if (layer->proto == LAYER_PROTO_GRE) { const struct gre0_hdr *gre = (const struct gre0_hdr *)layer->hdr.raw; EXPECT_TRUE(gre0_hdr_get_version(gre) == 0); EXPECT_TRUE(gre0_hdr_get_checksum(gre) == 0x92e7); break; } if (layer->proto == LAYER_PROTO_IPV6) { const struct ip6_hdr *ip6 = (const struct ip6_hdr *)layer->hdr.raw; EXPECT_TRUE(ip6_hdr_get_payload_len(ip6) == 25); break; } if (layer->proto == LAYER_PROTO_TCP) { const struct tcphdr *tcp = (const struct tcphdr *)layer->hdr.raw; EXPECT_TRUE(tcp_hdr_get_seq(tcp) == 1); EXPECT_TRUE(tcp_hdr_get_ack(tcp) == 2); EXPECT_TRUE(tcp_hdr_get_flags(tcp) == TH_ACK); EXPECT_TRUE(tcp_hdr_get_hdr_len(tcp) == 20); EXPECT_TRUE(tcp_hdr_get_checksum(tcp) == 0x0db8); break; } } for (uint16_t i = 0; i < new_pkt_len - 5; i++) { if ((16 <= i && i <= 17) || // skip IP total length (24 <= i && i <= 25)) // skip IP checksum { continue; } if (38 <= i && i <= 39) // skip GRE checksum { continue; } if (47 <= i && i <= 48) // skip IPv6 payload length { continue; } if ((86 <= i && i <= 89) || // skip TCP seq (90 <= i && i <= 93) || // skip TCP ack i == 95 || // skip TCP flags (98 <= i && i <= 99)) // skip TCP checksum { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif /****************************************************************************** * [Protocols in frame: eth:ethertype:vlan:ethertype:ipv6:ip:gre:ppp:ip:udp:dns] ****************************************************************************** * * Frame 1: 197 bytes on wire (1576 bits), 197 bytes captured (1576 bits) * Ethernet II, Src: JuniperNetwo_f2:61:3d (00:12:1e:f2:61:3d), Dst: c5:00:00:00:82:c4 (c5:00:00:00:82:c4) * Destination: c5:00:00:00:82:c4 (c5:00:00:00:82:c4) * Source: JuniperNetwo_f2:61:3d (00:12:1e:f2:61:3d) * Type: 802.1Q Virtual LAN (0x8100) * 802.1Q Virtual LAN, PRI: 0, DEI: 0, ID: 100 * 000. .... .... .... = Priority: Best Effort (default) (0) * ...0 .... .... .... = DEI: Ineligible * .... 0000 0110 0100 = ID: 100 * Type: IPv6 (0x86dd) * Internet Protocol Version 6, Src: 2402:f000:1:8e01::5555, Dst: 2607:fcd0:100:2300::b108:2a6b * 0110 .... = Version: 6 * .... 0000 0000 .... .... .... .... .... = Traffic Class: 0x00 (DSCP: CS0, ECN: Not-ECT) * .... 0000 00.. .... .... .... .... .... = Differentiated Services Codepoint: Default (0) * .... .... ..00 .... .... .... .... .... = Explicit Congestion Notification: Not ECN-Capable Transport (0) * .... 0000 0000 0000 0000 0000 = Flow Label: 0x00000 * Payload Length: 139 * Next Header: IPIP (4) * Hop Limit: 246 * Source Address: 2402:f000:1:8e01::5555 * Destination Address: 2607:fcd0:100:2300::b108:2a6b * Internet Protocol Version 4, Src: 16.0.0.200, Dst: 192.52.166.154 * 0100 .... = Version: 4 * .... 0101 = Header Length: 20 bytes (5) * Differentiated Services Field: 0x00 (DSCP: CS0, ECN: Not-ECT) * 0000 00.. = Differentiated Services Codepoint: Default (0) * .... ..00 = Explicit Congestion Notification: Not ECN-Capable Transport (0) * Total Length: 139 * Identification: 0x8caf (36015) * 000. .... = Flags: 0x0 * 0... .... = Reserved bit: Not set * .0.. .... = Don't fragment: Not set * ..0. .... = More fragments: Not set * ...0 0000 0000 0000 = Fragment Offset: 0 * Time to Live: 64 * Protocol: Generic Routing Encapsulation (47) * Header Checksum: 0x75fe [correct] * [Header checksum status: Good] * [Calculated Checksum: 0x75fe] * Source Address: 16.0.0.200 * Destination Address: 192.52.166.154 * Generic Routing Encapsulation (PPP) * Flags and Version: 0x3081 * 0... .... .... .... = Checksum Bit: No * .0.. .... .... .... = Routing Bit: No * ..1. .... .... .... = Key Bit: Yes * ...1 .... .... .... = Sequence Number Bit: Yes * .... 0... .... .... = Strict Source Route Bit: No * .... .000 .... .... = Recursion control: 0 * .... .... 1... .... = Acknowledgment: Yes * .... .... .000 0... = Flags (Reserved): 0 * .... .... .... .001 = Version: Enhanced GRE (1) * Protocol Type: PPP (0x880b) * Payload Length: 103 * Call ID: 6016 * Sequence Number: 430001 * Acknowledgment Number: 539254 * Point-to-Point Protocol * Address: 0xff * Control: 0x03 * Protocol: Internet Protocol version 4 (0x0021) * Internet Protocol Version 4, Src: 172.16.44.3, Dst: 8.8.8.8 * 0100 .... = Version: 4 * .... 0101 = Header Length: 20 bytes (5) * Differentiated Services Field: 0x00 (DSCP: CS0, ECN: Not-ECT) * 0000 00.. = Differentiated Services Codepoint: Default (0) * .... ..00 = Explicit Congestion Notification: Not ECN-Capable Transport (0) * Total Length: 99 * Identification: 0x0000 (0) * 010. .... = Flags: 0x2, Don't fragment * 0... .... = Reserved bit: Not set * .1.. .... = Don't fragment: Set * ..0. .... = More fragments: Not set * ...0 0000 0000 0000 = Fragment Offset: 0 * Time to Live: 60 * Protocol: UDP (17) * Header Checksum: 0x5667 [correct] * [Header checksum status: Good] * [Calculated Checksum: 0x5667] * Source Address: 172.16.44.3 * Destination Address: 8.8.8.8 * User Datagram Protocol, Src Port: 40768, Dst Port: 53 * Source Port: 40768 * Destination Port: 53 * Length: 79 * Checksum: 0x2d23 [correct] * [Calculated Checksum: 0x2d23] * [Checksum Status: Good] * [Stream index: 0] * [Timestamps] * [Time since first frame: 0.000000000 seconds] * [Time since previous frame: 0.000000000 seconds] * UDP payload (71 bytes) * Domain Name System (query) * Transaction ID: 0xa62c * Flags: 0x0100 Standard query * 0... .... .... .... = Response: Message is a query * .000 0... .... .... = Opcode: Standard query (0) * .... ..0. .... .... = Truncated: Message is not truncated * .... ...1 .... .... = Recursion desired: Do query recursively * .... .... .0.. .... = Z: reserved (0) * .... .... ...0 .... = Non-authenticated data: Unacceptable * Questions: 1 * Answer RRs: 0 * Authority RRs: 0 * Additional RRs: 0 * Queries * xqt-detect-mode2-97712e88-167a-45b9-93ee-913140e76678: type AAAA, class IN * Name: xqt-detect-mode2-97712e88-167a-45b9-93ee-913140e76678 * [Name Length: 53] * [Label Count: 1] * Type: AAAA (28) (IP6 Address) * Class: IN (0x0001) * [Response In: 2] */ unsigned char data5[] = { 0xc5, 0x00, 0x00, 0x00, 0x82, 0xc4, 0x00, 0x12, 0x1e, 0xf2, 0x61, 0x3d, 0x81, 0x00, 0x00, 0x64, 0x86, 0xdd, 0x60, 0x00, 0x00, 0x00, 0x00, 0x8b, 0x04, 0xf6, 0x24, 0x02, 0xf0, 0x00, 0x00, 0x01, 0x8e, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0x55, 0x26, 0x07, 0xfc, 0xd0, 0x01, 0x00, 0x23, 0x00, 0x00, 0x00, 0x00, 0x00, 0xb1, 0x08, 0x2a, 0x6b, 0x45, 0x00, 0x00, 0x8b, 0x8c, 0xaf, 0x00, 0x00, 0x40, 0x2f, 0x75, 0xfe, 0x10, 0x00, 0x00, 0xc8, 0xc0, 0x34, 0xa6, 0x9a, 0x30, 0x81, 0x88, 0x0b, 0x00, 0x67, 0x17, 0x80, 0x00, 0x06, 0x8f, 0xb1, 0x00, 0x08, 0x3a, 0x76, 0xff, 0x03, 0x00, 0x21, 0x45, 0x00, 0x00, 0x63, 0x00, 0x00, 0x40, 0x00, 0x3c, 0x11, 0x56, 0x67, 0xac, 0x10, 0x2c, 0x03, 0x08, 0x08, 0x08, 0x08, 0x9f, 0x40, 0x00, 0x35, 0x00, 0x4f, 0x2d, 0x23, 0xa6, 0x2c, 0x01, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x35, 0x78, 0x71, 0x74, 0x2d, 0x64, 0x65, 0x74, 0x65, 0x63, 0x74, 0x2d, 0x6d, 0x6f, 0x64, 0x65, 0x32, 0x2d, 0x39, 0x37, 0x37, 0x31, 0x32, 0x65, 0x38, 0x38, 0x2d, 0x31, 0x36, 0x37, 0x61, 0x2d, 0x34, 0x35, 0x62, 0x39, 0x2d, 0x39, 0x33, 0x65, 0x65, 0x2d, 0x39, 0x31, 0x33, 0x31, 0x34, 0x30, 0x65, 0x37, 0x36, 0x36, 0x37, 0x38, 0x00, 0x00, 0x1c, 0x00, 0x01}; /* * packet_build_udp() * -> ETH->VLAN->IPv6->IPv4->GRE->PPP->IPv4->UDP->DNS * -> with UDP payload * -> with GRE payload length */ #if 1 TEST(PACKET_BUILD_UDP, ETH_VLAN_IPv6_IPv4_GRE_PPP_IPv4_UDP_DNS) { struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data5, sizeof(data5)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct packet *new_pkt = packet_build_udp(&orig_pkt, "Hello", 5); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-vlan-ipv6-ipv4-gre-ppp-ipv4-udp-dns.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len - 71 == // trim DNS payload new_pkt_len - 5); // trim UDP payload int flag = 0; int count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV6) { const struct ip6_hdr *ip6 = (const struct ip6_hdr *)layer->hdr.raw; EXPECT_TRUE(ip6_hdr_get_payload_len(ip6) == 73); } if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; if (flag == 0) { EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 73); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0x7640); } else { EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 33); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0x56a9); } flag++; } if (layer->proto == LAYER_PROTO_GRE) { const struct gre1_hdr *gre = (const struct gre1_hdr *)layer->hdr.raw; EXPECT_TRUE(gre1_hdr_get_version(gre) == 1); EXPECT_TRUE(gre1_hdr_get_payload_length(gre) == 37); } if (layer->proto == LAYER_PROTO_UDP) { const struct udphdr *udp = (const struct udphdr *)layer->hdr.raw; EXPECT_TRUE(udp_hdr_get_total_len(udp) == 13); EXPECT_TRUE(udp_hdr_get_checksum(udp) == 0x5469); } } for (uint16_t i = 0; i < new_pkt_len - 5; i++) { if (22 <= i && i <= 23) /// skip IPv6 payload length { continue; } if ((60 <= i && i <= 61) || // skip IPv4 total length (68 <= i && i <= 69)) // skip IPv4 checksum { continue; } if ((82 <= i && i <= 83)) // skip GRE payload length { continue; } if ((100 <= i && i <= 101) || // skip IPv4 total length (108 <= i && i <= 109)) // skip IPv4 checksum { continue; } if ((122 <= i && i <= 123) || // skip UDP total length (124 <= i && i <= 125)) // skip UDP checksum { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif /* * packet_build_l3() * -> ETH->IPv4->ICMP * -> ICMPv4 checkum not include the pseudo-header of IPv4 header */ #if 1 TEST(PACKET_BUILD_L3, ETH_IP4_ICMP) { /* * Internet Control Message Protocol * Type: 8 (Echo (ping) request) * Code: 0 * Checksum: 0xaa4f [correct] * [Checksum Status: Good] * Identifier (BE): 27498 (0x6b6a) * Identifier (LE): 27243 (0x6a6b) * Sequence Number (BE): 0 (0x0000) * Sequence Number (LE): 0 (0x0000) * [Response frame: 31] * Timestamp from icmp data: Aug 2, 2024 10:51:12.214771000 CST * [Timestamp from icmp data (relative): 0.000093000 seconds] * Data (48 bytes) * Data: 08090a0b0c0d0e0f101112131415161718191a1b1c1d1e1f202122232425262728292a2b2c2d2e2f3031323334353637 * [Length: 48] */ unsigned char icmp_resp[] = { 0x08, 0x00, 0xaa, 0x4f, 0x6b, 0x6a, 0x00, 0x00, 0x66, 0xac, 0x49, 0xa0, 0x00, 0x03, 0x46, 0xf3, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f, 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37}; struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data1, sizeof(data1)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct icmphdr *icmp = (struct icmphdr *)icmp_resp; icmp->checksum = 0; icmp->checksum = checksum(icmp, sizeof(icmp_resp)); struct packet *new_pkt = packet_build_l3(&orig_pkt, IPPROTO_ICMP, (const char *)icmp_resp, sizeof(icmp_resp)); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-ipv4-icmpv4.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len - 20 - 6 == // trim Eth padding, trim TCP header new_pkt_len - 64); // trim ICMP int count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 84); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0xb7cb); break; } if (layer->proto == LAYER_PROTO_ICMP) { // TODO break; } } for (uint16_t i = 0; i < new_pkt_len - sizeof(icmp_resp); i++) { if ((16 <= i && i <= 17) || // skip IPv4 total length 23 == i || // skip IPv4 protocol (24 <= i && i <= 25)) // skip IPv4 checksum { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif /* * packet_build_l3() * -> ETH->IPv4->IPv6->ICMPv6 * -> ICMPv6 checkum need include the pseudo-header of IPv6 header */ #if 1 TEST(PACKET_BUILD_L3, ETH_IP6_ICMP) { /* * Internet Control Message Protocol v6 * Type: Echo (ping) request (128) * Code: 0 * Checksum: 0x7e8f [correct] * [Checksum Status: Good] * Identifier: 0x18dc * Sequence: 0 * [Response In: 2] * Data (52 bytes) * Data: 000102030405060708090a0b0c0d0e0f101112131415161718191a1b1c1d1e1f202122232425262728292a2b2c2d2e2f30313233 * [Length: 52] */ unsigned char icmp_resp[] = { 0x80, 0x00, 0x7e, 0x8f, 0x18, 0xdc, 0x00, 0x00, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f, 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d, 0x2e, 0x2f, 0x30, 0x31, 0x32, 0x33}; struct packet orig_pkt; memset(&orig_pkt, 0, sizeof(orig_pkt)); packet_parse(&orig_pkt, (const char *)data2, sizeof(data2)); PRINT_GREEN("origin packet:"); packet_dump_stdio(&orig_pkt); struct icmp6_hdr *icmp = (struct icmp6_hdr *)icmp_resp; icmp->icmp6_cksum = 0; int count = packet_get_layer_count(&orig_pkt); for (int i = count - 1; i >= 0; i--) { const struct layer *layer = packet_get_layer_by_idx(&orig_pkt, i); if (layer->proto == LAYER_PROTO_IPV6) { struct ip6_hdr *ip6 = (struct ip6_hdr *)layer->hdr.raw; icmp->icmp6_cksum = checksum_v6(icmp, sizeof(icmp_resp), IPPROTO_ICMPV6, &ip6->ip6_src, &ip6->ip6_dst); break; } } struct packet *new_pkt = packet_build_l3(&orig_pkt, IPPROTO_ICMPV6, (const char *)icmp_resp, sizeof(icmp_resp)); EXPECT_TRUE(new_pkt != nullptr); PRINT_GREEN("new packet:"); packet_dump_stdio(new_pkt); packet_dump_hex(new_pkt, STDOUT_FILENO); packet_dump_pcap(new_pkt, "craft-eth-ipv4-ipv6-icmpv6.pcap"); const char *orig_pkt_data = packet_get_raw_data(&orig_pkt); uint16_t orig_pkt_len = packet_get_raw_len(&orig_pkt); const char *new_pkt_data = packet_get_raw_data(new_pkt); uint16_t new_pkt_len = packet_get_raw_len(new_pkt); EXPECT_TRUE(orig_pkt_len - 32 == // trim TCP header new_pkt_len - 60); // trim ICMPv6 header count = packet_get_layer_count(new_pkt); for (int i = 0; i < count; i++) { const struct layer *layer = packet_get_layer_by_idx(new_pkt, i); if (layer->proto == LAYER_PROTO_IPV4) { const struct ip *ip = (const struct ip *)layer->hdr.raw; EXPECT_TRUE(ip4_hdr_get_total_len(ip) == 120); EXPECT_TRUE(ip4_hdr_get_checksum(ip) == 0x09ac); break; } if (layer->proto == LAYER_PROTO_IPV6) { const struct ip6_hdr *ip6 = (const struct ip6_hdr *)layer->hdr.raw; EXPECT_TRUE(ip6_hdr_get_payload_len(ip6) == 60); break; } if (layer->proto == LAYER_PROTO_ICMP6) { // TODO break; } } for (uint16_t i = 0; i < new_pkt_len - 60; i++) { if ((16 <= i && i <= 17) || // skip IPv4 total length (24 <= i && i <= 25)) // skip IPv4 checksum { continue; } if (38 <= i && i <= 39) // skip IPv6 payload length { continue; } if (40 == i) // skip IPv6 next header { continue; } // printf(("idx: %d, orig: %02x, new: %02x\n"), i, orig_pkt_data[i], new_pkt_data[i]); EXPECT_TRUE(orig_pkt_data[i] == new_pkt_data[i]); } packet_free(new_pkt); } #endif int main(int argc, char **argv) { ::testing::InitGoogleTest(&argc, argv); return RUN_ALL_TESTS(); }