use std::net::{IpAddr, Ipv4Addr, Ipv6Addr, SocketAddr};
use std::{
convert::{Into, TryFrom, TryInto},
time::Duration,
};
use socket2::{Domain, Protocol, SockAddr, Socket, Type};
use crate::packet::{Icmpv4Packet, Icmpv6Packet};
fn ip_to_socket(ip: &IpAddr) -> SocketAddr {
SocketAddr::new(*ip, 0)
}
pub trait IcmpSocket {
type AddrType;
type PacketType;
fn set_timeout(&mut self, timeout: Option<Duration>);
fn set_max_hops(&mut self, hops: u32);
fn bind<A: Into<Self::AddrType>>(&mut self, addr: A) -> std::io::Result<()>;
fn send_to(&mut self, dest: Self::AddrType, packet: Self::PacketType) -> std::io::Result<()>;
fn rcv_from(&mut self) -> std::io::Result<(Self::PacketType, SockAddr)>;
#[cfg(any(target_os = "android", target_os = "fuchsia", target_os = "linux"))]
fn bind_device(&mut self, interface_name: &str) -> std::io::Result<()>;
}
struct Opts {
hops: u32,
timeout: Option<Duration>,
}
pub struct IcmpSocket4 {
bound_to: Option<Ipv4Addr>,
buf: Vec<u8>,
inner: Socket,
opts: Opts,
}
impl IcmpSocket4 {
pub fn new() -> std::io::Result<Self> {
let socket = Socket::new(Domain::IPV4, Type::RAW, Some(Protocol::ICMPV4))?;
Self::new_from_socket(socket)
}
fn new_from_socket(socket: Socket) -> std::io::Result<Self> {
socket.set_recv_buffer_size(512)?;
Ok(Self {
bound_to: None,
inner: socket,
buf: Vec::with_capacity(512),
opts: Opts {
hops: 50,
timeout: None,
},
})
}
pub fn new_dgram_socket() -> std::io::Result<Self> {
let socket = Socket::new(Domain::IPV4, Type::DGRAM, Some(Protocol::ICMPV4))?;
Self::new_from_socket(socket)
}
}
impl IcmpSocket for IcmpSocket4 {
type AddrType = Ipv4Addr;
type PacketType = Icmpv4Packet;
fn set_max_hops(&mut self, hops: u32) {
self.opts.hops = hops;
}
fn bind<A: Into<Self::AddrType>>(&mut self, addr: A) -> std::io::Result<()> {
let addr = addr.into();
self.bound_to = Some(addr.clone());
let sock = ip_to_socket(&IpAddr::V4(addr));
self.inner.bind(&(sock.into()))?;
Ok(())
}
fn send_to(&mut self, dest: Self::AddrType, packet: Self::PacketType) -> std::io::Result<()> {
let dest = ip_to_socket(&IpAddr::V4(dest));
self.inner.set_ttl_v4(self.opts.hops)?;
self.inner
.send_to(&packet.with_checksum().get_bytes(true), &(dest.into()))?;
Ok(())
}
fn rcv_from(&mut self) -> std::io::Result<(Self::PacketType, SockAddr)> {
self.inner.set_read_timeout(self.opts.timeout)?;
self.buf.clear();
let (read_count, addr) = self.inner.recv_from(self.buf.spare_capacity_mut())?;
unsafe {
self.buf.set_len(read_count);
}
Ok((self.buf[..].try_into()?, addr))
}
fn set_timeout(&mut self, timeout: Option<Duration>) {
self.opts.timeout = timeout;
}
#[cfg(any(target_os = "android", target_os = "fuchsia", target_os = "linux"))]
fn bind_device(&mut self, interface_name: &str) -> std::io::Result<()> {
self.inner.bind_device(Some(interface_name.as_bytes()))
}
}
pub struct IcmpSocket6 {
bound_to: Option<Ipv6Addr>,
inner: Socket,
buf: Vec<u8>,
opts: Opts,
}
impl IcmpSocket6 {
pub fn new() -> std::io::Result<Self> {
let socket = Socket::new(Domain::IPV6, Type::RAW, Some(Protocol::ICMPV6))?;
Self::new_from_socket(socket)
}
fn new_from_socket(socket: Socket) -> std::io::Result<Self> {
socket.set_recv_buffer_size(512)?;
Ok(Self {
bound_to: None,
inner: socket,
buf: Vec::with_capacity(512),
opts: Opts {
hops: 50,
timeout: None,
},
})
}
pub fn new_dgram_socket() -> std::io::Result<Self> {
let socket = Socket::new(Domain::IPV6, Type::DGRAM, Some(Protocol::ICMPV6))?;
Self::new_from_socket(socket)
}
}
impl IcmpSocket for IcmpSocket6 {
type AddrType = Ipv6Addr;
type PacketType = Icmpv6Packet;
fn set_max_hops(&mut self, hops: u32) {
self.opts.hops = hops;
}
fn bind<A: Into<Self::AddrType>>(&mut self, addr: A) -> std::io::Result<()> {
let addr = addr.into();
self.bound_to = Some(addr.clone());
let sock = ip_to_socket(&IpAddr::V6(addr));
self.inner.bind(&(sock.into()))?;
Ok(())
}
fn send_to(
&mut self,
dest: Self::AddrType,
mut packet: Self::PacketType,
) -> std::io::Result<()> {
let source = match self.bound_to {
Some(ref addr) => addr,
None => {
return Err(std::io::Error::new(
std::io::ErrorKind::Other,
"Socket not bound to an address",
));
}
};
packet = packet.with_checksum(source, &dest);
let dest = ip_to_socket(&IpAddr::V6(dest));
self.inner.set_unicast_hops_v6(self.opts.hops)?;
let pkt = packet.get_bytes(true);
self.inner.send_to(&pkt, &(dest.into()))?;
Ok(())
}
fn rcv_from(&mut self) -> std::io::Result<(Self::PacketType, SockAddr)> {
self.inner.set_read_timeout(self.opts.timeout)?;
self.buf.clear();
let (read_count, addr) = self.inner.recv_from(self.buf.spare_capacity_mut())?;
unsafe {
self.buf.set_len(read_count);
}
Ok((self.buf[..].try_into()?, addr))
}
fn set_timeout(&mut self, timeout: Option<Duration>) {
self.opts.timeout = timeout;
}
#[cfg(any(target_os = "android", target_os = "fuchsia", target_os = "linux"))]
fn bind_device(&mut self, interface_name: &str) -> std::io::Result<()> {
self.inner.bind_device(Some(interface_name.as_bytes()))
}
}
impl TryFrom<Ipv4Addr> for IcmpSocket4 {
type Error = std::io::Error;
fn try_from(addr: Ipv4Addr) -> Result<Self, Self::Error> {
let mut sock = IcmpSocket4::new()?;
sock.bind(addr)?;
Ok(sock)
}
}
impl TryFrom<Ipv6Addr> for IcmpSocket6 {
type Error = std::io::Error;
fn try_from(addr: Ipv6Addr) -> Result<Self, Self::Error> {
let mut sock = IcmpSocket6::new()?;
sock.bind(addr)?;
Ok(sock)
}
}