server.rs 8.2 KB

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