xenet_packet_builder/
ndp.rs

1use std::net::Ipv6Addr;
2use xenet_core::mac::MacAddr;
3use xenet_packet::ethernet::MAC_ADDR_LEN;
4use xenet_packet::icmpv6::ndp::{
5    MutableNdpOptionPacket, MutableNeighborSolicitPacket, NdpOptionTypes,
6};
7use xenet_packet::icmpv6::ndp::{NDP_OPT_PACKET_LEN, NDP_SOL_PACKET_LEN};
8use xenet_packet::icmpv6::{self, Icmpv6Type, MutableIcmpv6Packet};
9//use xenet_packet::Packet;
10
11/// Length in octets (8bytes)
12fn octets_len(len: usize) -> u8 {
13    // 3 = log2(8)
14    (len.next_power_of_two() >> 3).try_into().unwrap()
15}
16
17/// NDP Packet Builder.
18#[derive(Clone, Debug)]
19pub struct NdpPacketBuilder {
20    /// Source MAC address.
21    pub src_mac: MacAddr,
22    /// Destination MAC address.
23    pub dst_mac: MacAddr,
24    /// Source IPv6 address.
25    pub src_ip: Ipv6Addr,
26    /// Destination IPv6 address.
27    pub dst_ip: Ipv6Addr,
28}
29
30impl NdpPacketBuilder {
31    /// Constructs a new NdpPacketBuilder.
32    pub fn new(src_mac: MacAddr, src_ip: Ipv6Addr, dst_ip: Ipv6Addr) -> NdpPacketBuilder {
33        NdpPacketBuilder {
34            src_mac: src_mac,
35            dst_mac: MacAddr::broadcast(),
36            src_ip: src_ip,
37            dst_ip: dst_ip,
38        }
39    }
40    /// Build ICMPv6 packet and return bytes.
41    pub fn build(&self) -> Vec<u8> {
42        let mut buffer = [0u8; NDP_SOL_PACKET_LEN + NDP_OPT_PACKET_LEN + MAC_ADDR_LEN];
43        // Build the NDP packet
44        let mut ndp_packet = MutableNeighborSolicitPacket::new(&mut buffer).unwrap();
45        ndp_packet.set_target_addr(self.dst_ip);
46        ndp_packet.set_icmpv6_type(Icmpv6Type::NeighborSolicitation);
47        ndp_packet.set_checksum(0x3131);
48
49        let mut opt_packet = MutableNdpOptionPacket::new(ndp_packet.get_options_raw_mut()).unwrap();
50        opt_packet.set_option_type(NdpOptionTypes::SourceLLAddr);
51        opt_packet.set_length(octets_len(MAC_ADDR_LEN));
52        opt_packet.set_data(&self.src_mac.octets());
53
54        // Set the checksum (part of the NDP packet)
55        let mut icmpv6_packet = MutableIcmpv6Packet::new(&mut buffer).unwrap();
56        icmpv6_packet.set_checksum(icmpv6::checksum(
57            &icmpv6_packet.to_immutable(),
58            &self.src_ip,
59            &self.dst_ip,
60        ));
61        buffer.to_vec()
62    }
63}