Listening to all interfaces

This commit is contained in:
Wiktor Mazur
2019-09-01 19:34:12 +02:00
parent cdac07c8c8
commit 09f0590fb6
+58 -62
View File
@@ -1,5 +1,7 @@
extern crate pnet; extern crate pnet;
use std::sync::{Arc, Mutex};
use std::net::IpAddr; use std::net::IpAddr;
use std::sync::mpsc::Sender; use std::sync::mpsc::Sender;
use std::thread; use std::thread;
@@ -25,75 +27,69 @@ pub struct UdpPacket {
} }
pub fn receive(tx: Sender<UdpPacket>) { pub fn receive(tx: Sender<UdpPacket>) {
let shared_tx = Arc::new(Mutex::new(tx));
use pnet::datalink::Channel::Ethernet; use pnet::datalink::Channel::Ethernet;
let up_interface = datalink::interfaces()
.into_iter()
.filter(|i| !i.is_loopback() && !i.is_up())
.next();
let any_interface = datalink::interfaces() let interfaces = datalink::interfaces()
.into_iter() .into_iter()
.filter(|i| !i.is_loopback()) .filter(|i| !i.is_loopback());
.next();
let interface = if up_interface.is_some() { for interface in interfaces {
up_interface.unwrap() let tx = shared_tx.clone();
} else { let config = pnet::datalink::Config{
any_interface.unwrap() write_buffer_size: 65536,
}; read_buffer_size: 65536,
..Default::default()
};
let config = pnet::datalink::Config{ // Create a channel to receive on
write_buffer_size: 65536, let (_, mut rx) = match datalink::channel(&interface, config) {
read_buffer_size: 65536, Ok(Ethernet(tx, rx)) => (tx, rx),
..Default::default() Ok(_) => panic!("packetdump: unhandled channel type: {}"),
}; Err(e) => panic!("packetdump: unable to create channel: {}", e),
};
// Create a channel to receive on thread::spawn(move || {
let (_, mut rx) = match datalink::channel(&interface, config) { loop {
Ok(Ethernet(tx, rx)) => (tx, rx), let mut buf: [u8; 1600] = [0u8; 1600];
Ok(_) => panic!("packetdump: unhandled channel type: {}"), let mut fake_ethernet_frame = MutableEthernetPacket::new(&mut buf[..]).unwrap();
Err(e) => panic!("packetdump: unable to create channel: {}", e), match rx.next() {
}; Ok(packet) => {
if cfg!(target_os = "macos")
thread::spawn(move || { && interface.is_up()
loop { && !interface.is_broadcast()
let mut buf: [u8; 1600] = [0u8; 1600]; && !interface.is_loopback()
let mut fake_ethernet_frame = MutableEthernetPacket::new(&mut buf[..]).unwrap(); && interface.is_point_to_point()
match rx.next() { {
Ok(packet) => { // Maybe is TUN interface
if cfg!(target_os = "macos") let version = Ipv4Packet::new(&packet).unwrap().get_version();
&& interface.is_up() if version == 4 {
&& !interface.is_broadcast() fake_ethernet_frame.set_destination(MacAddr(0, 0, 0, 0, 0, 0));
&& !interface.is_loopback() fake_ethernet_frame.set_source(MacAddr(0, 0, 0, 0, 0, 0));
&& interface.is_point_to_point() fake_ethernet_frame.set_ethertype(EtherTypes::Ipv4);
{ fake_ethernet_frame.set_payload(&packet);
// Maybe is TUN interface handle_ethernet_frame(&interface, &fake_ethernet_frame.to_immutable(), &tx);
let version = Ipv4Packet::new(&packet).unwrap().get_version(); continue;
if version == 4 { } else if version == 6 {
fake_ethernet_frame.set_destination(MacAddr(0, 0, 0, 0, 0, 0)); fake_ethernet_frame.set_destination(MacAddr(0, 0, 0, 0, 0, 0));
fake_ethernet_frame.set_source(MacAddr(0, 0, 0, 0, 0, 0)); fake_ethernet_frame.set_source(MacAddr(0, 0, 0, 0, 0, 0));
fake_ethernet_frame.set_ethertype(EtherTypes::Ipv4); fake_ethernet_frame.set_ethertype(EtherTypes::Ipv6);
fake_ethernet_frame.set_payload(&packet); fake_ethernet_frame.set_payload(&packet);
handle_ethernet_frame(&interface, &fake_ethernet_frame.to_immutable(), &tx); handle_ethernet_frame(&interface, &fake_ethernet_frame.to_immutable(), &tx);
continue; continue;
} else if version == 6 { }
fake_ethernet_frame.set_destination(MacAddr(0, 0, 0, 0, 0, 0));
fake_ethernet_frame.set_source(MacAddr(0, 0, 0, 0, 0, 0));
fake_ethernet_frame.set_ethertype(EtherTypes::Ipv6);
fake_ethernet_frame.set_payload(&packet);
handle_ethernet_frame(&interface, &fake_ethernet_frame.to_immutable(), &tx);
continue;
} }
handle_ethernet_frame(&interface, &EthernetPacket::new(packet).unwrap(), &tx);
} }
handle_ethernet_frame(&interface, &EthernetPacket::new(packet).unwrap(), &tx); Err(e) => panic!("packetdump: unable to receive packet: {}", e),
} }
Err(e) => panic!("packetdump: unable to receive packet: {}", e),
} }
} });
}); }
} }
fn handle_ethernet_frame(interface: &NetworkInterface, ethernet: &EthernetPacket, tx: &Sender<UdpPacket>) { fn handle_ethernet_frame(interface: &NetworkInterface, ethernet: &EthernetPacket, tx: &Arc<Mutex<Sender<UdpPacket>>>) {
let interface_name = &interface.name[..]; let interface_name = &interface.name[..];
match ethernet.get_ethertype() { match ethernet.get_ethertype() {
EtherTypes::Ipv4 => handle_ipv4_packet(interface_name, ethernet, &tx), EtherTypes::Ipv4 => handle_ipv4_packet(interface_name, ethernet, &tx),
@@ -102,7 +98,7 @@ fn handle_ethernet_frame(interface: &NetworkInterface, ethernet: &EthernetPacket
} }
} }
fn handle_ipv4_packet(interface_name: &str, ethernet: &EthernetPacket, tx: &Sender<UdpPacket>) { fn handle_ipv4_packet(interface_name: &str, ethernet: &EthernetPacket, tx: &Arc<Mutex<Sender<UdpPacket>>>) {
let header = Ipv4Packet::new(ethernet.payload()); let header = Ipv4Packet::new(ethernet.payload());
if let Some(header) = header { if let Some(header) = header {
handle_transport_protocol( handle_transport_protocol(
@@ -116,7 +112,7 @@ fn handle_ipv4_packet(interface_name: &str, ethernet: &EthernetPacket, tx: &Send
} }
} }
fn handle_ipv6_packet(interface_name: &str, ethernet: &EthernetPacket, tx: &Sender<UdpPacket>) { fn handle_ipv6_packet(interface_name: &str, ethernet: &EthernetPacket, tx: &Arc<Mutex<Sender<UdpPacket>>>) {
let header = Ipv6Packet::new(ethernet.payload()); let header = Ipv6Packet::new(ethernet.payload());
if let Some(header) = header { if let Some(header) = header {
handle_transport_protocol( handle_transport_protocol(
@@ -136,7 +132,7 @@ fn handle_transport_protocol(
destination: IpAddr, destination: IpAddr,
protocol: IpNextHeaderProtocol, protocol: IpNextHeaderProtocol,
packet: &[u8], packet: &[u8],
tx: &Sender<UdpPacket> tx: &Arc<Mutex<Sender<UdpPacket>>>
) { ) {
match protocol { match protocol {
IpNextHeaderProtocols::Udp => { IpNextHeaderProtocols::Udp => {
@@ -146,9 +142,9 @@ fn handle_transport_protocol(
} }
} }
fn handle_udp_packet(interface_name: &str, source: IpAddr, destination: IpAddr, packet: &[u8], tx: &Sender<UdpPacket>) { fn handle_udp_packet(interface_name: &str, source: IpAddr, destination: IpAddr, packet: &[u8], tx: &Arc<Mutex<Sender<UdpPacket>>>) {
let udp = udp::UdpPacket::new(packet); let udp = udp::UdpPacket::new(packet);
let tx = tx.lock().unwrap();
if let Some(udp) = udp { if let Some(udp) = udp {
tx.send(UdpPacket{ tx.send(UdpPacket{
interface_name: String::from(interface_name), interface_name: String::from(interface_name),