server.rs 7.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205
  1. mod utils;
  2. use log::debug;
  3. use std::collections::BTreeMap;
  4. use std::fmt::Write;
  5. use std::os::unix::io::AsRawFd;
  6. use std::str;
  7. use smoltcp::iface::{InterfaceBuilder, NeighborCache};
  8. use smoltcp::phy::{wait as phy_wait, Device, Medium};
  9. use smoltcp::socket::{tcp, udp};
  10. use smoltcp::time::{Duration, Instant};
  11. use smoltcp::wire::{EthernetAddress, IpAddress, IpCidr};
  12. fn main() {
  13. utils::setup_logging("");
  14. let (mut opts, mut free) = utils::create_options();
  15. utils::add_tuntap_options(&mut opts, &mut free);
  16. utils::add_middleware_options(&mut opts, &mut free);
  17. let mut matches = utils::parse_options(&opts, free);
  18. let device = utils::parse_tuntap_options(&mut matches);
  19. let fd = device.as_raw_fd();
  20. let device = utils::parse_middleware_options(&mut matches, device, /*loopback=*/ false);
  21. let neighbor_cache = NeighborCache::new(BTreeMap::new());
  22. let udp_rx_buffer = udp::PacketBuffer::new(vec![udp::PacketMetadata::EMPTY], vec![0; 64]);
  23. let udp_tx_buffer = udp::PacketBuffer::new(vec![udp::PacketMetadata::EMPTY], vec![0; 128]);
  24. let udp_socket = udp::Socket::new(udp_rx_buffer, udp_tx_buffer);
  25. let tcp1_rx_buffer = tcp::SocketBuffer::new(vec![0; 64]);
  26. let tcp1_tx_buffer = tcp::SocketBuffer::new(vec![0; 128]);
  27. let tcp1_socket = tcp::Socket::new(tcp1_rx_buffer, tcp1_tx_buffer);
  28. let tcp2_rx_buffer = tcp::SocketBuffer::new(vec![0; 64]);
  29. let tcp2_tx_buffer = tcp::SocketBuffer::new(vec![0; 128]);
  30. let tcp2_socket = tcp::Socket::new(tcp2_rx_buffer, tcp2_tx_buffer);
  31. let tcp3_rx_buffer = tcp::SocketBuffer::new(vec![0; 65535]);
  32. let tcp3_tx_buffer = tcp::SocketBuffer::new(vec![0; 65535]);
  33. let tcp3_socket = tcp::Socket::new(tcp3_rx_buffer, tcp3_tx_buffer);
  34. let tcp4_rx_buffer = tcp::SocketBuffer::new(vec![0; 65535]);
  35. let tcp4_tx_buffer = tcp::SocketBuffer::new(vec![0; 65535]);
  36. let tcp4_socket = tcp::Socket::new(tcp4_rx_buffer, tcp4_tx_buffer);
  37. let ethernet_addr = EthernetAddress([0x02, 0x00, 0x00, 0x00, 0x00, 0x01]);
  38. let ip_addrs = [
  39. IpCidr::new(IpAddress::v4(192, 168, 69, 1), 24),
  40. IpCidr::new(IpAddress::v6(0xfdaa, 0, 0, 0, 0, 0, 0, 1), 64),
  41. IpCidr::new(IpAddress::v6(0xfe80, 0, 0, 0, 0, 0, 0, 1), 64),
  42. ];
  43. let medium = device.capabilities().medium;
  44. let mut builder = InterfaceBuilder::new(device, vec![]).ip_addrs(ip_addrs);
  45. if medium == Medium::Ethernet {
  46. builder = builder
  47. .hardware_addr(ethernet_addr.into())
  48. .neighbor_cache(neighbor_cache);
  49. }
  50. let mut iface = builder.finalize();
  51. let udp_handle = iface.add_socket(udp_socket);
  52. let tcp1_handle = iface.add_socket(tcp1_socket);
  53. let tcp2_handle = iface.add_socket(tcp2_socket);
  54. let tcp3_handle = iface.add_socket(tcp3_socket);
  55. let tcp4_handle = iface.add_socket(tcp4_socket);
  56. let mut tcp_6970_active = false;
  57. loop {
  58. let timestamp = Instant::now();
  59. match iface.poll(timestamp) {
  60. Ok(_) => {}
  61. Err(e) => {
  62. debug!("poll error: {}", e);
  63. }
  64. }
  65. // udp:6969: respond "hello"
  66. let socket = iface.get_socket::<udp::Socket>(udp_handle);
  67. if !socket.is_open() {
  68. socket.bind(6969).unwrap()
  69. }
  70. let client = match socket.recv() {
  71. Ok((data, endpoint)) => {
  72. debug!(
  73. "udp:6969 recv data: {:?} from {}",
  74. str::from_utf8(data).unwrap(),
  75. endpoint
  76. );
  77. Some(endpoint)
  78. }
  79. Err(_) => None,
  80. };
  81. if let Some(endpoint) = client {
  82. let data = b"hello\n";
  83. debug!(
  84. "udp:6969 send data: {:?}",
  85. str::from_utf8(data.as_ref()).unwrap()
  86. );
  87. socket.send_slice(data, endpoint).unwrap();
  88. }
  89. // tcp:6969: respond "hello"
  90. let socket = iface.get_socket::<tcp::Socket>(tcp1_handle);
  91. if !socket.is_open() {
  92. socket.listen(6969).unwrap();
  93. }
  94. if socket.can_send() {
  95. debug!("tcp:6969 send greeting");
  96. writeln!(socket, "hello").unwrap();
  97. debug!("tcp:6969 close");
  98. socket.close();
  99. }
  100. // tcp:6970: echo with reverse
  101. let socket = iface.get_socket::<tcp::Socket>(tcp2_handle);
  102. if !socket.is_open() {
  103. socket.listen(6970).unwrap()
  104. }
  105. if socket.is_active() && !tcp_6970_active {
  106. debug!("tcp:6970 connected");
  107. } else if !socket.is_active() && tcp_6970_active {
  108. debug!("tcp:6970 disconnected");
  109. }
  110. tcp_6970_active = socket.is_active();
  111. if socket.may_recv() {
  112. let data = socket
  113. .recv(|buffer| {
  114. let recvd_len = buffer.len();
  115. let mut data = buffer.to_owned();
  116. if !data.is_empty() {
  117. debug!(
  118. "tcp:6970 recv data: {:?}",
  119. str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)")
  120. );
  121. data = data.split(|&b| b == b'\n').collect::<Vec<_>>().concat();
  122. data.reverse();
  123. data.extend(b"\n");
  124. }
  125. (recvd_len, data)
  126. })
  127. .unwrap();
  128. if socket.can_send() && !data.is_empty() {
  129. debug!(
  130. "tcp:6970 send data: {:?}",
  131. str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)")
  132. );
  133. socket.send_slice(&data[..]).unwrap();
  134. }
  135. } else if socket.may_send() {
  136. debug!("tcp:6970 close");
  137. socket.close();
  138. }
  139. // tcp:6971: sinkhole
  140. let socket = iface.get_socket::<tcp::Socket>(tcp3_handle);
  141. if !socket.is_open() {
  142. socket.listen(6971).unwrap();
  143. socket.set_keep_alive(Some(Duration::from_millis(1000)));
  144. socket.set_timeout(Some(Duration::from_millis(2000)));
  145. }
  146. if socket.may_recv() {
  147. socket
  148. .recv(|buffer| {
  149. if !buffer.is_empty() {
  150. debug!("tcp:6971 recv {:?} octets", buffer.len());
  151. }
  152. (buffer.len(), ())
  153. })
  154. .unwrap();
  155. } else if socket.may_send() {
  156. socket.close();
  157. }
  158. // tcp:6972: fountain
  159. let socket = iface.get_socket::<tcp::Socket>(tcp4_handle);
  160. if !socket.is_open() {
  161. socket.listen(6972).unwrap()
  162. }
  163. if socket.may_send() {
  164. socket
  165. .send(|data| {
  166. if !data.is_empty() {
  167. debug!("tcp:6972 send {:?} octets", data.len());
  168. for (i, b) in data.iter_mut().enumerate() {
  169. *b = (i % 256) as u8;
  170. }
  171. }
  172. (data.len(), ())
  173. })
  174. .unwrap();
  175. }
  176. phy_wait(fd, iface.poll_delay(timestamp)).expect("wait error");
  177. }
  178. }