use crate::packets::icmp::v6::{Icmpv6, Icmpv6Message, Icmpv6Packet, Icmpv6Type, Icmpv6Types};
use crate::packets::ip::v6::{Ipv6Packet, IPV6_MIN_MTU};
use crate::packets::types::u32be;
use crate::packets::{Internal, Packet};
use crate::SizeOf;
use anyhow::Result;
use std::fmt;
use std::ptr::NonNull;
#[derive(Icmpv6Packet)]
pub struct DestinationUnreachable<E: Ipv6Packet> {
icmp: Icmpv6<E>,
body: NonNull<DestinationUnreachableBody>,
}
impl<E: Ipv6Packet> DestinationUnreachable<E> {
#[inline]
pub fn data(&self) -> &[u8] {
let offset = self.payload_offset() + DestinationUnreachableBody::size_of();
let len = self.payload_len() - DestinationUnreachableBody::size_of();
if let Ok(data) = self.icmp().mbuf().read_data_slice(offset, len) {
unsafe { &*data.as_ptr() }
} else {
&[]
}
}
}
impl<E: Ipv6Packet> fmt::Debug for DestinationUnreachable<E> {
fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
f.debug_struct("DestinationUnreachable")
.field("type", &format!("{}", self.msg_type()))
.field("code", &self.code())
.field("checksum", &format!("0x{:04x}", self.checksum()))
.field("$offset", &self.offset())
.field("$len", &self.len())
.field("$header_len", &self.header_len())
.finish()
}
}
impl<E: Ipv6Packet> Icmpv6Message for DestinationUnreachable<E> {
type Envelope = E;
#[inline]
fn msg_type() -> Icmpv6Type {
Icmpv6Types::DestinationUnreachable
}
#[inline]
fn icmp(&self) -> &Icmpv6<Self::Envelope> {
&self.icmp
}
#[inline]
fn icmp_mut(&mut self) -> &mut Icmpv6<Self::Envelope> {
&mut self.icmp
}
#[inline]
fn into_icmp(self) -> Icmpv6<Self::Envelope> {
self.icmp
}
#[inline]
unsafe fn clone(&self, internal: Internal) -> Self {
DestinationUnreachable {
icmp: self.icmp.clone(internal),
body: self.body,
}
}
#[inline]
fn try_parse(icmp: Icmpv6<Self::Envelope>, _internal: Internal) -> Result<Self> {
let mbuf = icmp.mbuf();
let offset = icmp.payload_offset();
let body = mbuf.read_data(offset)?;
Ok(DestinationUnreachable { icmp, body })
}
#[inline]
fn try_push(mut icmp: Icmpv6<Self::Envelope>, _internal: Internal) -> Result<Self> {
let offset = icmp.payload_offset();
let mbuf = icmp.mbuf_mut();
mbuf.extend(offset, DestinationUnreachableBody::size_of())?;
let body = mbuf.write_data(offset, &DestinationUnreachableBody::default())?;
Ok(DestinationUnreachable { icmp, body })
}
#[inline]
fn reconcile(&mut self) {
let _ = self.envelope_mut().truncate(IPV6_MIN_MTU);
self.icmp_mut().compute_checksum();
}
}
#[derive(Clone, Copy, Debug, Default, SizeOf)]
#[repr(C, packed)]
struct DestinationUnreachableBody {
_unused: u32be,
}
#[cfg(test)]
mod tests {
use super::*;
use crate::packets::ip::v6::Ipv6;
use crate::packets::Ethernet;
use crate::testils::byte_arrays::IPV6_TCP_PACKET;
use crate::Mbuf;
#[test]
fn size_of_destination_unreachable_body() {
assert_eq!(4, DestinationUnreachableBody::size_of());
}
#[capsule::test]
fn push_and_set_destination_unreachable() {
let packet = Mbuf::from_bytes(&IPV6_TCP_PACKET).unwrap();
let ethernet = packet.parse::<Ethernet>().unwrap();
let ipv6 = ethernet.parse::<Ipv6>().unwrap();
let tcp_len = ipv6.payload_len();
let mut unreachable = ipv6.push::<DestinationUnreachable<Ipv6>>().unwrap();
assert_eq!(4, unreachable.header_len());
assert_eq!(
DestinationUnreachableBody::size_of() + tcp_len,
unreachable.payload_len()
);
assert_eq!(Icmpv6Types::DestinationUnreachable, unreachable.msg_type());
assert_eq!(0, unreachable.code());
assert_eq!(tcp_len, unreachable.data().len());
unreachable.set_code(1);
assert_eq!(1, unreachable.code());
unreachable.reconcile_all();
assert!(unreachable.checksum() != 0);
}
#[capsule::test]
fn truncate_to_ipv6_min_mtu() {
let packet = Mbuf::from_bytes(&[42; 1600]).unwrap();
let ethernet = packet.push::<Ethernet>().unwrap();
let ipv6 = ethernet.push::<Ipv6>().unwrap();
let max_len = IPV6_MIN_MTU + 14;
let mut unreachable = ipv6.push::<DestinationUnreachable<Ipv6>>().unwrap();
assert!(unreachable.mbuf().data_len() > max_len);
unreachable.reconcile_all();
assert_eq!(max_len, unreachable.mbuf().data_len());
}
}