server.rs 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135
  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::time::Instant;
  9. use smoltcp::wire::{EthernetAddress, IpAddress};
  10. use smoltcp::iface::{ArpCache, SliceArpCache, EthernetInterface};
  11. use smoltcp::socket::{AsSocket, SocketSet};
  12. use smoltcp::socket::{UdpSocket, UdpSocketBuffer, UdpPacketBuffer};
  13. use smoltcp::socket::{TcpSocket, TcpSocketBuffer};
  14. fn main() {
  15. utils::setup_logging();
  16. let device = utils::setup_device();
  17. let startup_time = Instant::now();
  18. let arp_cache = SliceArpCache::new(vec![Default::default(); 8]);
  19. let udp_rx_buffer = UdpSocketBuffer::new(vec![UdpPacketBuffer::new(vec![0; 64])]);
  20. let udp_tx_buffer = UdpSocketBuffer::new(vec![UdpPacketBuffer::new(vec![0; 128])]);
  21. let udp_socket = UdpSocket::new(udp_rx_buffer, udp_tx_buffer);
  22. let tcp1_rx_buffer = TcpSocketBuffer::new(vec![0; 64]);
  23. let tcp1_tx_buffer = TcpSocketBuffer::new(vec![0; 128]);
  24. let tcp1_socket = TcpSocket::new(tcp1_rx_buffer, tcp1_tx_buffer);
  25. let tcp2_rx_buffer = TcpSocketBuffer::new(vec![0; 64]);
  26. let tcp2_tx_buffer = TcpSocketBuffer::new(vec![0; 128]);
  27. let tcp2_socket = TcpSocket::new(tcp2_rx_buffer, tcp2_tx_buffer);
  28. let hardware_addr = EthernetAddress([0x02, 0x00, 0x00, 0x00, 0x00, 0x01]);
  29. let protocol_addrs = [IpAddress::v4(192, 168, 69, 1)];
  30. let mut iface = EthernetInterface::new(
  31. Box::new(device), Box::new(arp_cache) as Box<ArpCache>,
  32. hardware_addr, protocol_addrs);
  33. let mut sockets = SocketSet::new(vec![]);
  34. let udp_handle = sockets.add(udp_socket);
  35. let tcp1_handle = sockets.add(tcp1_socket);
  36. let tcp2_handle = sockets.add(tcp2_socket);
  37. let mut tcp_6970_active = false;
  38. loop {
  39. // udp:6969: respond "yo dawg"
  40. {
  41. let socket: &mut UdpSocket = sockets.get_mut(udp_handle).as_socket();
  42. if socket.endpoint().is_unspecified() {
  43. socket.bind(6969)
  44. }
  45. let client = match socket.recv() {
  46. Ok((data, endpoint)) => {
  47. debug!("udp:6969 recv data: {:?} from {}",
  48. str::from_utf8(data.as_ref()).unwrap(), endpoint);
  49. Some(endpoint)
  50. }
  51. Err(_) => None
  52. };
  53. if let Some(endpoint) = client {
  54. let data = b"yo dawg\n";
  55. debug!("udp:6969 send data: {:?}",
  56. str::from_utf8(data.as_ref()).unwrap());
  57. socket.send_slice(data, endpoint).unwrap();
  58. }
  59. }
  60. // tcp:6969: respond "yo dawg"
  61. {
  62. let socket: &mut TcpSocket = sockets.get_mut(tcp1_handle).as_socket();
  63. if !socket.is_open() {
  64. socket.listen(6969).unwrap();
  65. }
  66. if socket.can_send() {
  67. let data = b"yo dawg\n";
  68. debug!("tcp:6969 send data: {:?}",
  69. str::from_utf8(data.as_ref()).unwrap());
  70. socket.send_slice(data).unwrap();
  71. debug!("tcp:6969 close");
  72. socket.close();
  73. }
  74. }
  75. // tcp:6970: echo with reverse
  76. {
  77. let socket: &mut TcpSocket = sockets.get_mut(tcp2_handle).as_socket();
  78. if !socket.is_open() {
  79. socket.listen(6970).unwrap()
  80. }
  81. if socket.is_active() && !tcp_6970_active {
  82. debug!("tcp:6970 connected");
  83. } else if !socket.is_active() && tcp_6970_active {
  84. debug!("tcp:6970 disconnected");
  85. }
  86. tcp_6970_active = socket.is_active();
  87. if socket.may_recv() {
  88. let data = {
  89. let mut data = socket.recv(128).unwrap().to_owned();
  90. if data.len() > 0 {
  91. debug!("tcp:6970 recv data: {:?}",
  92. str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)"));
  93. data = data.split(|&b| b == b'\n').collect::<Vec<_>>().concat();
  94. data.reverse();
  95. data.extend(b"\n");
  96. }
  97. data
  98. };
  99. if socket.can_send() && data.len() > 0 {
  100. debug!("tcp:6970 send data: {:?}",
  101. str::from_utf8(data.as_ref()).unwrap_or("(invalid utf8)"));
  102. socket.send_slice(&data[..]).unwrap();
  103. }
  104. } else if socket.may_send() {
  105. debug!("tcp:6970 close");
  106. socket.close();
  107. }
  108. }
  109. let timestamp = Instant::now().duration_since(startup_time);
  110. let timestamp_ms = (timestamp.as_secs() * 1000) +
  111. (timestamp.subsec_nanos() / 1000000) as u64;
  112. match iface.poll(&mut sockets, timestamp_ms) {
  113. Ok(()) => (),
  114. Err(e) => debug!("poll error: {}", e)
  115. }
  116. }
  117. }