2016-12-23 15:59:38 +08:00
|
|
|
#[macro_use]
|
|
|
|
extern crate log;
|
|
|
|
extern crate env_logger;
|
2016-12-31 09:04:39 +08:00
|
|
|
extern crate getopts;
|
2016-12-12 15:19:53 +08:00
|
|
|
extern crate smoltcp;
|
|
|
|
|
2016-12-31 09:04:39 +08:00
|
|
|
use std::str::{self, FromStr};
|
2016-12-12 15:19:53 +08:00
|
|
|
use std::env;
|
2016-12-31 09:04:39 +08:00
|
|
|
use std::time::{Instant, SystemTime, UNIX_EPOCH};
|
2016-12-23 15:59:38 +08:00
|
|
|
use log::{LogLevelFilter, LogRecord};
|
|
|
|
use env_logger::{LogBuilder};
|
|
|
|
|
2016-12-17 13:12:45 +08:00
|
|
|
use smoltcp::Error;
|
2016-12-31 09:04:39 +08:00
|
|
|
use smoltcp::phy::{Tracer, FaultInjector, TapInterface};
|
2016-12-20 21:54:11 +08:00
|
|
|
use smoltcp::wire::{EthernetFrame, EthernetAddress, IpAddress, IpEndpoint};
|
2016-12-26 23:46:36 +08:00
|
|
|
use smoltcp::wire::PrettyPrinter;
|
2017-01-10 19:37:12 +08:00
|
|
|
use smoltcp::iface::{ArpCache, SliceArpCache, EthernetInterface};
|
2016-12-23 15:30:57 +08:00
|
|
|
use smoltcp::socket::AsSocket;
|
|
|
|
use smoltcp::socket::{UdpSocket, UdpSocketBuffer, UdpPacketBuffer};
|
|
|
|
use smoltcp::socket::{TcpSocket, TcpSocketBuffer};
|
2016-12-12 15:19:53 +08:00
|
|
|
|
|
|
|
fn main() {
|
2016-12-31 09:04:39 +08:00
|
|
|
let mut opts = getopts::Options::new();
|
|
|
|
opts.optopt("", "drop-chance", "Chance of dropping a packet (%)", "CHANCE");
|
|
|
|
opts.optopt("", "corrupt-chance", "Chance of corrupting a packet (%)", "CHANCE");
|
|
|
|
opts.optflag("h", "help", "print this help menu");
|
|
|
|
|
|
|
|
let matches = opts.parse(env::args().skip(1)).unwrap();
|
|
|
|
if matches.opt_present("h") || matches.free.len() != 1 {
|
|
|
|
let brief = format!("Usage: {} FILE [options]", env::args().nth(0).unwrap());
|
|
|
|
print!("{}", opts.usage(&brief));
|
|
|
|
return
|
|
|
|
}
|
|
|
|
let drop_chance = u8::from_str(&matches.opt_str("drop-chance")
|
|
|
|
.unwrap_or("0".to_string())).unwrap();
|
|
|
|
let corrupt_chance = u8::from_str(&matches.opt_str("corrupt-chance")
|
|
|
|
.unwrap_or("0".to_string())).unwrap();
|
|
|
|
|
|
|
|
let seed = SystemTime::now().duration_since(UNIX_EPOCH).unwrap().subsec_nanos();
|
|
|
|
|
2016-12-23 15:59:38 +08:00
|
|
|
let startup_time = Instant::now();
|
|
|
|
LogBuilder::new()
|
|
|
|
.format(move |record: &LogRecord| {
|
|
|
|
let elapsed = Instant::now().duration_since(startup_time);
|
2016-12-26 23:46:36 +08:00
|
|
|
if record.target().starts_with("smoltcp::") {
|
2016-12-31 16:35:07 +08:00
|
|
|
format!("\x1b[0m[{:6}.{:03}s] ({}): {}\x1b[0m",
|
2016-12-26 23:46:36 +08:00
|
|
|
elapsed.as_secs(), elapsed.subsec_nanos() / 1000000,
|
|
|
|
record.target().replace("smoltcp::", ""), record.args())
|
|
|
|
} else {
|
2016-12-31 16:35:07 +08:00
|
|
|
format!("\x1b[32m[{:6}.{:03}s] ({}): {}\x1b[0m",
|
2016-12-26 23:46:36 +08:00
|
|
|
elapsed.as_secs(), elapsed.subsec_nanos() / 1000000,
|
|
|
|
record.target(), record.args())
|
|
|
|
}
|
2016-12-23 15:59:38 +08:00
|
|
|
})
|
|
|
|
.filter(None, LogLevelFilter::Trace)
|
|
|
|
.init()
|
|
|
|
.unwrap();
|
|
|
|
|
2016-12-26 23:46:36 +08:00
|
|
|
fn trace_writer(printer: PrettyPrinter<EthernetFrame<&[u8]>>) {
|
|
|
|
print!("\x1b[37m{}\x1b[0m", printer)
|
|
|
|
}
|
|
|
|
|
2016-12-31 09:04:39 +08:00
|
|
|
let device = TapInterface::new(&matches.free[0]).unwrap();
|
|
|
|
let mut device = FaultInjector::new(device, seed);
|
|
|
|
device.set_drop_chance(drop_chance);
|
|
|
|
device.set_corrupt_chance(corrupt_chance);
|
2016-12-26 23:46:36 +08:00
|
|
|
let device = Tracer::<_, EthernetFrame<&[u8]>>::new(device, trace_writer);
|
2016-12-31 09:04:39 +08:00
|
|
|
|
2016-12-15 13:15:00 +08:00
|
|
|
let arp_cache = SliceArpCache::new(vec![Default::default(); 8]);
|
|
|
|
|
2016-12-21 03:51:52 +08:00
|
|
|
let endpoint = IpEndpoint::new(IpAddress::default(), 6969);
|
|
|
|
|
2016-12-27 00:29:33 +08:00
|
|
|
let udp_rx_buffer = UdpSocketBuffer::new(vec![UdpPacketBuffer::new(vec![0; 64])]);
|
2016-12-27 21:34:48 +08:00
|
|
|
let udp_tx_buffer = UdpSocketBuffer::new(vec![UdpPacketBuffer::new(vec![0; 128])]);
|
2016-12-17 13:12:45 +08:00
|
|
|
let udp_socket = UdpSocket::new(endpoint, udp_rx_buffer, udp_tx_buffer);
|
2016-12-12 15:19:53 +08:00
|
|
|
|
2016-12-28 13:33:12 +08:00
|
|
|
let tcp1_rx_buffer = TcpSocketBuffer::new(vec![0; 64]);
|
|
|
|
let tcp1_tx_buffer = TcpSocketBuffer::new(vec![0; 128]);
|
|
|
|
let tcp1_socket = TcpSocket::new(tcp1_rx_buffer, tcp1_tx_buffer);
|
|
|
|
|
|
|
|
let tcp2_rx_buffer = TcpSocketBuffer::new(vec![0; 64]);
|
|
|
|
let tcp2_tx_buffer = TcpSocketBuffer::new(vec![0; 128]);
|
|
|
|
let tcp2_socket = TcpSocket::new(tcp2_rx_buffer, tcp2_tx_buffer);
|
2016-12-21 03:51:52 +08:00
|
|
|
|
2017-01-01 16:18:25 +08:00
|
|
|
let hardware_addr = EthernetAddress([0x02, 0x00, 0x00, 0x00, 0x00, 0x01]);
|
2016-12-21 03:18:35 +08:00
|
|
|
let protocol_addrs = [IpAddress::v4(192, 168, 69, 1)];
|
2017-01-01 16:18:25 +08:00
|
|
|
let sockets = vec![udp_socket, tcp1_socket, tcp2_socket];
|
2017-01-10 19:37:12 +08:00
|
|
|
let mut iface = EthernetInterface::new(
|
|
|
|
Box::new(device), hardware_addr, protocol_addrs,
|
|
|
|
Box::new(arp_cache) as Box<ArpCache>, sockets);
|
2016-12-17 12:15:12 +08:00
|
|
|
|
2016-12-28 02:54:45 +08:00
|
|
|
let mut tcp_6969_connected = false;
|
2016-12-12 15:19:53 +08:00
|
|
|
loop {
|
2016-12-28 13:33:12 +08:00
|
|
|
// udp:6969: respond "yo dawg"
|
2016-12-21 03:51:52 +08:00
|
|
|
{
|
2016-12-26 22:50:12 +08:00
|
|
|
let socket: &mut UdpSocket = iface.sockets()[0].as_socket();
|
|
|
|
let client = match socket.recv() {
|
2016-12-21 03:51:52 +08:00
|
|
|
Ok((endpoint, data)) => {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("udp:6969 recv data: {:?} from {}",
|
2016-12-27 00:29:33 +08:00
|
|
|
str::from_utf8(data.as_ref()).unwrap(), endpoint);
|
2016-12-21 03:51:52 +08:00
|
|
|
Some(endpoint)
|
|
|
|
}
|
|
|
|
Err(Error::Exhausted) => {
|
|
|
|
None
|
|
|
|
}
|
|
|
|
Err(e) => {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("udp:6969 recv error: {}", e);
|
2016-12-21 03:51:52 +08:00
|
|
|
None
|
|
|
|
}
|
|
|
|
};
|
2016-12-26 22:50:12 +08:00
|
|
|
if let Some(endpoint) = client {
|
2016-12-28 13:33:12 +08:00
|
|
|
let data = b"yo dawg\n";
|
|
|
|
debug!("udp:6969 send data: {:?}",
|
2016-12-27 00:29:33 +08:00
|
|
|
str::from_utf8(data.as_ref()).unwrap());
|
2016-12-26 23:46:36 +08:00
|
|
|
socket.send_slice(endpoint, data).unwrap()
|
2016-12-17 13:12:45 +08:00
|
|
|
}
|
2016-12-21 03:51:52 +08:00
|
|
|
}
|
|
|
|
|
2016-12-28 13:33:12 +08:00
|
|
|
// tcp:6969: respond "yo dawg"
|
2016-12-26 22:50:12 +08:00
|
|
|
{
|
|
|
|
let socket: &mut TcpSocket = iface.sockets()[1].as_socket();
|
2016-12-28 04:17:35 +08:00
|
|
|
if !socket.is_open() {
|
2016-12-28 13:33:12 +08:00
|
|
|
socket.listen(6969).unwrap();
|
|
|
|
}
|
|
|
|
|
|
|
|
if socket.can_send() {
|
|
|
|
let data = b"yo dawg\n";
|
|
|
|
debug!("tcp:6969 send data: {:?}",
|
|
|
|
str::from_utf8(data.as_ref()).unwrap());
|
|
|
|
socket.send_slice(data).unwrap();
|
|
|
|
debug!("tcp:6969 close");
|
|
|
|
socket.close();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// tcp:6970: echo with reverse
|
|
|
|
{
|
|
|
|
let socket: &mut TcpSocket = iface.sockets()[2].as_socket();
|
|
|
|
if !socket.is_open() {
|
|
|
|
socket.listen(6970).unwrap()
|
2016-12-28 04:17:35 +08:00
|
|
|
}
|
|
|
|
|
2016-12-28 02:54:45 +08:00
|
|
|
if socket.is_connected() && !tcp_6969_connected {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("tcp:6970 connected");
|
2016-12-28 02:54:45 +08:00
|
|
|
} else if !socket.is_connected() && tcp_6969_connected {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("tcp:6970 disconnected");
|
2016-12-28 02:54:45 +08:00
|
|
|
}
|
|
|
|
tcp_6969_connected = socket.is_connected();
|
|
|
|
|
2016-12-28 02:04:02 +08:00
|
|
|
if socket.can_recv() {
|
|
|
|
let data = {
|
|
|
|
let mut data = socket.recv(128).unwrap().to_owned();
|
|
|
|
if data.len() > 0 {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("tcp:6970 recv data: {:?}",
|
2016-12-28 02:04:02 +08:00
|
|
|
str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)"));
|
|
|
|
data = data.split(|&b| b == b'\n').collect::<Vec<_>>().concat();
|
|
|
|
data.reverse();
|
|
|
|
data.extend(b"\n");
|
|
|
|
}
|
|
|
|
data
|
|
|
|
};
|
|
|
|
if socket.can_send() && data.len() > 0 {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("tcp:6970 send data: {:?}",
|
2016-12-28 02:04:02 +08:00
|
|
|
str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)"));
|
|
|
|
socket.send_slice(&data[..]).unwrap();
|
2016-12-26 22:50:12 +08:00
|
|
|
}
|
2016-12-28 06:43:16 +08:00
|
|
|
} else if socket.can_send() {
|
2016-12-28 13:33:12 +08:00
|
|
|
debug!("tcp:6970 close");
|
2016-12-28 07:27:33 +08:00
|
|
|
socket.close();
|
2016-12-26 23:46:36 +08:00
|
|
|
}
|
2016-12-26 22:50:12 +08:00
|
|
|
}
|
2016-12-28 04:17:35 +08:00
|
|
|
|
2016-12-31 16:35:07 +08:00
|
|
|
let timestamp = Instant::now().duration_since(startup_time);
|
|
|
|
let timestamp_ms = (timestamp.as_secs() * 1000) +
|
|
|
|
(timestamp.subsec_nanos() / 1000000) as u64;
|
|
|
|
match iface.poll(timestamp_ms) {
|
2016-12-28 04:17:35 +08:00
|
|
|
Ok(()) => (),
|
|
|
|
Err(e) => debug!("poll error: {}", e)
|
|
|
|
}
|
2016-12-12 15:19:53 +08:00
|
|
|
}
|
|
|
|
}
|