123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218 |
- mod utils;
- use log::debug;
- use std::collections::BTreeMap;
- use std::fmt::Write;
- use std::os::unix::io::AsRawFd;
- use std::str;
- use smoltcp::iface::{InterfaceBuilder, NeighborCache};
- use smoltcp::phy::{wait as phy_wait, Device, Medium};
- use smoltcp::socket::SocketSet;
- use smoltcp::socket::{TcpSocket, TcpSocketBuffer};
- use smoltcp::socket::{UdpPacketMetadata, UdpSocket, UdpSocketBuffer};
- use smoltcp::time::{Duration, Instant};
- use smoltcp::wire::{EthernetAddress, IpAddress, IpCidr};
- fn main() {
- utils::setup_logging("");
- let (mut opts, mut free) = utils::create_options();
- utils::add_tuntap_options(&mut opts, &mut free);
- utils::add_middleware_options(&mut opts, &mut free);
- let mut matches = utils::parse_options(&opts, free);
- let device = utils::parse_tuntap_options(&mut matches);
- let fd = device.as_raw_fd();
- let device = utils::parse_middleware_options(&mut matches, device, /*loopback=*/ false);
- let neighbor_cache = NeighborCache::new(BTreeMap::new());
- let udp_rx_buffer = UdpSocketBuffer::new(vec![UdpPacketMetadata::EMPTY], vec![0; 64]);
- let udp_tx_buffer = UdpSocketBuffer::new(vec![UdpPacketMetadata::EMPTY], vec![0; 128]);
- let udp_socket = UdpSocket::new(udp_rx_buffer, udp_tx_buffer);
- 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);
- let tcp3_rx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
- let tcp3_tx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
- let tcp3_socket = TcpSocket::new(tcp3_rx_buffer, tcp3_tx_buffer);
- let tcp4_rx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
- let tcp4_tx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
- let tcp4_socket = TcpSocket::new(tcp4_rx_buffer, tcp4_tx_buffer);
- let ethernet_addr = EthernetAddress([0x02, 0x00, 0x00, 0x00, 0x00, 0x01]);
- let ip_addrs = [
- IpCidr::new(IpAddress::v4(192, 168, 69, 1), 24),
- IpCidr::new(IpAddress::v6(0xfdaa, 0, 0, 0, 0, 0, 0, 1), 64),
- IpCidr::new(IpAddress::v6(0xfe80, 0, 0, 0, 0, 0, 0, 1), 64),
- ];
- let medium = device.capabilities().medium;
- let mut builder = InterfaceBuilder::new(device).ip_addrs(ip_addrs);
- if medium == Medium::Ethernet {
- builder = builder
- .ethernet_addr(ethernet_addr)
- .neighbor_cache(neighbor_cache);
- }
- let mut iface = builder.finalize();
- let mut sockets = SocketSet::new(vec![]);
- let udp_handle = sockets.add(udp_socket);
- let tcp1_handle = sockets.add(tcp1_socket);
- let tcp2_handle = sockets.add(tcp2_socket);
- let tcp3_handle = sockets.add(tcp3_socket);
- let tcp4_handle = sockets.add(tcp4_socket);
- let mut tcp_6970_active = false;
- loop {
- let timestamp = Instant::now();
- match iface.poll(&mut sockets, timestamp) {
- Ok(_) => {}
- Err(e) => {
- debug!("poll error: {}", e);
- }
- }
- // udp:6969: respond "hello"
- {
- let mut socket = sockets.get::<UdpSocket>(udp_handle);
- if !socket.is_open() {
- socket.bind(6969).unwrap()
- }
- let client = match socket.recv() {
- Ok((data, endpoint)) => {
- debug!(
- "udp:6969 recv data: {:?} from {}",
- str::from_utf8(data).unwrap(),
- endpoint
- );
- Some(endpoint)
- }
- Err(_) => None,
- };
- if let Some(endpoint) = client {
- let data = b"hello\n";
- debug!(
- "udp:6969 send data: {:?}",
- str::from_utf8(data.as_ref()).unwrap()
- );
- socket.send_slice(data, endpoint).unwrap();
- }
- }
- // tcp:6969: respond "hello"
- {
- let mut socket = sockets.get::<TcpSocket>(tcp1_handle);
- if !socket.is_open() {
- socket.listen(6969).unwrap();
- }
- if socket.can_send() {
- debug!("tcp:6969 send greeting");
- writeln!(socket, "hello").unwrap();
- debug!("tcp:6969 close");
- socket.close();
- }
- }
- // tcp:6970: echo with reverse
- {
- let mut socket = sockets.get::<TcpSocket>(tcp2_handle);
- if !socket.is_open() {
- socket.listen(6970).unwrap()
- }
- if socket.is_active() && !tcp_6970_active {
- debug!("tcp:6970 connected");
- } else if !socket.is_active() && tcp_6970_active {
- debug!("tcp:6970 disconnected");
- }
- tcp_6970_active = socket.is_active();
- if socket.may_recv() {
- let data = socket
- .recv(|buffer| {
- let recvd_len = buffer.len();
- let mut data = buffer.to_owned();
- if !data.is_empty() {
- debug!(
- "tcp:6970 recv data: {:?}",
- 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");
- }
- (recvd_len, data)
- })
- .unwrap();
- if socket.can_send() && !data.is_empty() {
- debug!(
- "tcp:6970 send data: {:?}",
- str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)")
- );
- socket.send_slice(&data[..]).unwrap();
- }
- } else if socket.may_send() {
- debug!("tcp:6970 close");
- socket.close();
- }
- }
- // tcp:6971: sinkhole
- {
- let mut socket = sockets.get::<TcpSocket>(tcp3_handle);
- if !socket.is_open() {
- socket.listen(6971).unwrap();
- socket.set_keep_alive(Some(Duration::from_millis(1000)));
- socket.set_timeout(Some(Duration::from_millis(2000)));
- }
- if socket.may_recv() {
- socket
- .recv(|buffer| {
- if !buffer.is_empty() {
- debug!("tcp:6971 recv {:?} octets", buffer.len());
- }
- (buffer.len(), ())
- })
- .unwrap();
- } else if socket.may_send() {
- socket.close();
- }
- }
- // tcp:6972: fountain
- {
- let mut socket = sockets.get::<TcpSocket>(tcp4_handle);
- if !socket.is_open() {
- socket.listen(6972).unwrap()
- }
- if socket.may_send() {
- socket
- .send(|data| {
- if !data.is_empty() {
- debug!("tcp:6972 send {:?} octets", data.len());
- for (i, b) in data.iter_mut().enumerate() {
- *b = (i % 256) as u8;
- }
- }
- (data.len(), ())
- })
- .unwrap();
- }
- }
- phy_wait(fd, iface.poll_delay(&sockets, timestamp)).expect("wait error");
- }
- }
|