server.rs 6.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187
  1. #[macro_use]
  2. extern crate log;
  3. extern crate env_logger;
  4. extern crate getopts;
  5. extern crate smoltcp;
  6. mod utils;
  7. use std::str;
  8. use std::fmt::Write;
  9. use std::time::Instant;
  10. use std::os::unix::io::AsRawFd;
  11. use smoltcp::phy::wait as phy_wait;
  12. use smoltcp::wire::{EthernetAddress, IpAddress};
  13. use smoltcp::iface::{ArpCache, SliceArpCache, EthernetInterface};
  14. use smoltcp::socket::{AsSocket, SocketSet};
  15. use smoltcp::socket::{UdpSocket, UdpSocketBuffer, UdpPacketBuffer};
  16. use smoltcp::socket::{TcpSocket, TcpSocketBuffer};
  17. fn main() {
  18. utils::setup_logging("");
  19. let (mut opts, mut free) = utils::create_options();
  20. utils::add_tap_options(&mut opts, &mut free);
  21. utils::add_middleware_options(&mut opts, &mut free);
  22. let mut matches = utils::parse_options(&opts, free);
  23. let device = utils::parse_tap_options(&mut matches);
  24. let fd = device.as_raw_fd();
  25. let device = utils::parse_middleware_options(&mut matches, device, /*loopback=*/false);
  26. let startup_time = Instant::now();
  27. let arp_cache = SliceArpCache::new(vec![Default::default(); 8]);
  28. let udp_rx_buffer = UdpSocketBuffer::new(vec![UdpPacketBuffer::new(vec![0; 64])]);
  29. let udp_tx_buffer = UdpSocketBuffer::new(vec![UdpPacketBuffer::new(vec![0; 128])]);
  30. let udp_socket = UdpSocket::new(udp_rx_buffer, udp_tx_buffer);
  31. let tcp1_rx_buffer = TcpSocketBuffer::new(vec![0; 64]);
  32. let tcp1_tx_buffer = TcpSocketBuffer::new(vec![0; 128]);
  33. let tcp1_socket = TcpSocket::new(tcp1_rx_buffer, tcp1_tx_buffer);
  34. let tcp2_rx_buffer = TcpSocketBuffer::new(vec![0; 64]);
  35. let tcp2_tx_buffer = TcpSocketBuffer::new(vec![0; 128]);
  36. let tcp2_socket = TcpSocket::new(tcp2_rx_buffer, tcp2_tx_buffer);
  37. let tcp3_rx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
  38. let tcp3_tx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
  39. let tcp3_socket = TcpSocket::new(tcp3_rx_buffer, tcp3_tx_buffer);
  40. let tcp4_rx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
  41. let tcp4_tx_buffer = TcpSocketBuffer::new(vec![0; 65535]);
  42. let tcp4_socket = TcpSocket::new(tcp4_rx_buffer, tcp4_tx_buffer);
  43. let hardware_addr = EthernetAddress([0x02, 0x00, 0x00, 0x00, 0x00, 0x01]);
  44. let protocol_addrs = [IpAddress::v4(192, 168, 69, 1)];
  45. let mut iface = EthernetInterface::new(
  46. Box::new(device), Box::new(arp_cache) as Box<ArpCache>,
  47. hardware_addr, protocol_addrs);
  48. let mut sockets = SocketSet::new(vec![]);
  49. let udp_handle = sockets.add(udp_socket);
  50. let tcp1_handle = sockets.add(tcp1_socket);
  51. let tcp2_handle = sockets.add(tcp2_socket);
  52. let tcp3_handle = sockets.add(tcp3_socket);
  53. let tcp4_handle = sockets.add(tcp4_socket);
  54. let mut tcp_6970_active = false;
  55. loop {
  56. // udp:6969: respond "hello"
  57. {
  58. let socket: &mut UdpSocket = sockets.get_mut(udp_handle).as_socket();
  59. if !socket.is_open() {
  60. socket.bind(6969).unwrap()
  61. }
  62. let client = match socket.recv() {
  63. Ok((data, endpoint)) => {
  64. debug!("udp:6969 recv data: {:?} from {}",
  65. str::from_utf8(data.as_ref()).unwrap(), endpoint);
  66. Some(endpoint)
  67. }
  68. Err(_) => None
  69. };
  70. if let Some(endpoint) = client {
  71. let data = b"hello\n";
  72. debug!("udp:6969 send data: {:?}",
  73. str::from_utf8(data.as_ref()).unwrap());
  74. socket.send_slice(data, endpoint).unwrap();
  75. }
  76. }
  77. // tcp:6969: respond "hello"
  78. {
  79. let socket: &mut TcpSocket = sockets.get_mut(tcp1_handle).as_socket();
  80. if !socket.is_open() {
  81. socket.listen(6969).unwrap();
  82. }
  83. if socket.can_send() {
  84. debug!("tcp:6969 send greeting");
  85. write!(socket, "hello\n").unwrap();
  86. debug!("tcp:6969 close");
  87. socket.close();
  88. }
  89. }
  90. // tcp:6970: echo with reverse
  91. {
  92. let socket: &mut TcpSocket = sockets.get_mut(tcp2_handle).as_socket();
  93. if !socket.is_open() {
  94. socket.listen(6970).unwrap()
  95. }
  96. if socket.is_active() && !tcp_6970_active {
  97. debug!("tcp:6970 connected");
  98. } else if !socket.is_active() && tcp_6970_active {
  99. debug!("tcp:6970 disconnected");
  100. }
  101. tcp_6970_active = socket.is_active();
  102. if socket.may_recv() {
  103. let data = {
  104. let mut data = socket.recv(128).unwrap().to_owned();
  105. if data.len() > 0 {
  106. debug!("tcp:6970 recv data: {:?}",
  107. str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)"));
  108. data = data.split(|&b| b == b'\n').collect::<Vec<_>>().concat();
  109. data.reverse();
  110. data.extend(b"\n");
  111. }
  112. data
  113. };
  114. if socket.can_send() && data.len() > 0 {
  115. debug!("tcp:6970 send data: {:?}",
  116. str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)"));
  117. socket.send_slice(&data[..]).unwrap();
  118. }
  119. } else if socket.may_send() {
  120. debug!("tcp:6970 close");
  121. socket.close();
  122. }
  123. }
  124. // tcp:6971: sinkhole
  125. {
  126. let socket: &mut TcpSocket = sockets.get_mut(tcp3_handle).as_socket();
  127. if !socket.is_open() {
  128. socket.listen(6971).unwrap()
  129. }
  130. if socket.may_recv() {
  131. if let Ok(data) = socket.recv(65535) {
  132. if data.len() > 0 {
  133. debug!("tcp:6971 recv {:?} octets", data.len());
  134. }
  135. }
  136. } else if socket.may_send() {
  137. socket.close();
  138. }
  139. }
  140. // tcp:6972: fountain
  141. {
  142. let socket: &mut TcpSocket = sockets.get_mut(tcp4_handle).as_socket();
  143. if !socket.is_open() {
  144. socket.listen(6972).unwrap()
  145. }
  146. if socket.may_send() {
  147. if let Ok(data) = socket.send(65535) {
  148. if data.len() > 0 {
  149. debug!("tcp:6972 send {:?} octets", data.len());
  150. for (i, b) in data.iter_mut().enumerate() {
  151. *b = (i % 256) as u8;
  152. }
  153. }
  154. }
  155. }
  156. }
  157. let timestamp = utils::millis_since(startup_time);
  158. let poll_at = iface.poll(&mut sockets, timestamp).expect("poll error");
  159. phy_wait(fd, poll_at).expect("wait error");
  160. }
  161. }