use pnet::packet::Packet;
use pnet::packet::icmpv6;
use pnet::packet::icmpv6::Icmpv6Code;
use pnet::packet::icmpv6::Icmpv6Packet;
use pnet::packet::icmpv6::Icmpv6Types;
use pnet::packet::icmpv6::MutableIcmpv6Packet;
use pnet::packet::icmpv6::echo_request::MutableEchoRequestPacket;
use pnet::packet::ip::IpNextHeaderProtocols;
use pnet::packet::ipv6::Ipv6Packet;
use pnet::packet::ipv6::MutableIpv6Packet;
use std::net::Ipv6Addr;
use std::panic::Location;
use std::time::Duration;
use crate::error::PistolError;
use crate::layer::ICMPV6_ER_HEADER_SIZE;
use crate::layer::IPV6_HEADER_SIZE;
use crate::layer::Layer3Match;
use crate::layer::Layer4MatchIcmpv6;
use crate::layer::LayerMatch;
use crate::layer::PayloadMatch;
use crate::layer::PayloadMatchIcmpv6;
use crate::layer::PayloadMatchIp;
use crate::layer::layer3_ipv6_send;
use crate::trace::HopStatus;
pub fn send_icmpv6_trace_packet(
dst_ipv6: Ipv6Addr,
src_ipv6: Ipv6Addr,
hop_limit: u8,
icmpv6_id: u16,
seq: u16,
timeout: Option<Duration>,
) -> Result<(HopStatus, Duration), PistolError> {
const ICMPV6_DATA_SIZE: usize = 32;
let mut ipv6_buff = [0u8; IPV6_HEADER_SIZE + ICMPV6_ER_HEADER_SIZE + ICMPV6_DATA_SIZE];
let mut ipv6_header = match MutableIpv6Packet::new(&mut ipv6_buff) {
Some(p) => p,
None => {
return Err(PistolError::BuildPacketError {
location: format!("{}", Location::caller()),
});
}
};
ipv6_header.set_version(6);
ipv6_header.set_flow_label(0x12345);
let payload_length = ICMPV6_ER_HEADER_SIZE + ICMPV6_DATA_SIZE;
ipv6_header.set_payload_length(payload_length as u16);
ipv6_header.set_next_header(IpNextHeaderProtocols::Icmpv6);
ipv6_header.set_hop_limit(hop_limit);
ipv6_header.set_source(src_ipv6);
ipv6_header.set_destination(dst_ipv6);
let mut icmpv6_header = match MutableEchoRequestPacket::new(&mut ipv6_buff[IPV6_HEADER_SIZE..])
{
Some(p) => p,
None => {
return Err(PistolError::BuildPacketError {
location: format!("{}", Location::caller()),
});
}
};
icmpv6_header.set_icmpv6_type(Icmpv6Types::EchoRequest);
icmpv6_header.set_icmpv6_code(Icmpv6Code(0));
icmpv6_header.set_identifier(icmpv6_id);
icmpv6_header.set_sequence_number(seq);
let icmpv6_payload = "HIJKLMNOPQRSTUVWXYZ[\\]^_`abcdefg";
assert_eq!(icmpv6_payload.len(), ICMPV6_DATA_SIZE);
icmpv6_header.set_payload(&icmpv6_payload.as_bytes());
let mut icmp_header = match MutableIcmpv6Packet::new(&mut ipv6_buff[IPV6_HEADER_SIZE..]) {
Some(p) => p,
None => {
return Err(PistolError::BuildPacketError {
location: format!("{}", Location::caller()),
});
}
};
let checksum = icmpv6::checksum(&icmp_header.to_immutable(), &src_ipv6, &dst_ipv6);
icmp_header.set_checksum(checksum);
let layer3 = Layer3Match {
name: "icmpv6 trace time exceeded layer3",
layer2: None,
src_addr: None, dst_addr: Some(src_ipv6.into()),
};
let payload_ip = PayloadMatchIp {
src_addr: Some(src_ipv6.into()),
dst_addr: Some(dst_ipv6.into()),
};
let payload_icmp = PayloadMatchIcmpv6 {
layer3: Some(payload_ip),
icmpv6_type: Some(Icmpv6Types::EchoRequest),
icmpv6_code: None,
};
let payload = PayloadMatch::PayloadMatchIcmpv6(payload_icmp);
let layer4_icmp = Layer4MatchIcmpv6 {
name: "icmpv6 trace time exceeded icmpv6",
layer3: Some(layer3),
icmpv6_type: Some(Icmpv6Types::TimeExceeded),
icmpv6_code: None,
payload: Some(payload),
};
let layer_match_icmp_time_exceeded = LayerMatch::Layer4MatchIcmpv6(layer4_icmp);
let layer3 = Layer3Match {
name: "icmpv6 trace reply layer3",
layer2: None,
src_addr: Some(dst_ipv6.into()),
dst_addr: Some(src_ipv6.into()),
};
let layer4_icmpv6 = Layer4MatchIcmpv6 {
name: "icmpv6 trace reply icmpv6",
layer3: Some(layer3),
icmpv6_type: None,
icmpv6_code: None,
payload: None,
};
let layer_match_icmp_reply = LayerMatch::Layer4MatchIcmpv6(layer4_icmpv6);
let (ret, rtt) = layer3_ipv6_send(
dst_ipv6,
src_ipv6,
&ipv6_buff,
vec![layer_match_icmp_time_exceeded, layer_match_icmp_reply],
timeout,
true,
)?;
match Ipv6Packet::new(&ret) {
Some(ipv6_packet) => match ipv6_packet.get_next_header() {
IpNextHeaderProtocols::Icmpv6 => match Icmpv6Packet::new(ipv6_packet.payload()) {
Some(icmpv6_packet) => {
let icmp_type = icmpv6_packet.get_icmpv6_type();
let ret_ip = ipv6_packet.get_source();
if icmp_type == Icmpv6Types::TimeExceeded {
return Ok((HopStatus::TimeExceeded(ret_ip.into()), rtt));
} else if icmp_type == Icmpv6Types::EchoReply {
return Ok((HopStatus::RecvReply(ret_ip.into()), rtt));
}
}
None => (),
},
_ => (),
},
None => (),
}
Ok((HopStatus::NoResponse, rtt))
}