1use std::collections::HashSet;
9use std::net::{IpAddr, Ipv4Addr, Ipv6Addr, SocketAddr};
10use std::sync::Arc;
11use std::sync::atomic::Ordering;
12
13use smoltcp::iface::{Config, Interface, SocketSet};
14use smoltcp::time::Instant;
15
16use smoltcp::wire::{
17 EthernetAddress, EthernetFrame, EthernetProtocol, HardwareAddress, Icmpv4Packet, Icmpv4Repr,
18 Icmpv6Packet, Icmpv6Repr, IpAddress, IpCidr, IpProtocol, Ipv4Packet, Ipv4Repr, Ipv6Packet,
19 Ipv6Repr, TcpPacket, UdpPacket,
20};
21
22use crate::config::{DnsConfig, PublishedPort};
23use crate::conn::ConnectionTracker;
24use crate::device::SmoltcpDevice;
25use crate::dns::common::ports::DnsPortType;
26use crate::dns::{
27 interceptor::DnsInterceptor,
28 proxies::{dot::DotProxy, tcp::DnsTcpProxy},
29};
30use crate::icmp_relay::IcmpRelay;
31use crate::policy::{EgressEvaluation, HostnameSource, NetworkPolicy, Protocol};
32use crate::proxy;
33use crate::publisher::PortPublisher;
34use crate::secrets::config::SecretsConfig;
35use crate::shared::SharedState;
36use crate::tls::{proxy as tls_proxy, state::TlsState};
37use crate::udp_relay::UdpRelay;
38
39pub enum FrameAction {
50 TcpSyn { src: SocketAddr, dst: SocketAddr },
53
54 UdpRelay { src: SocketAddr, dst: SocketAddr },
57
58 Dns,
60
61 Passthrough,
64}
65
66pub struct PollLoopConfig {
69 pub gateway_mac: [u8; 6],
71 pub guest_mac: [u8; 6],
73 pub gateway: GatewayIps,
77 pub guest_ipv4: Option<Ipv4Addr>,
79 pub guest_ipv6: Option<Ipv6Addr>,
81 pub mtu: usize,
83}
84
85#[derive(Debug, Clone, Copy)]
90pub struct GatewayIps {
91 pub ipv4: Option<Ipv4Addr>,
93 pub ipv6: Option<Ipv6Addr>,
95}
96
97pub fn classify_frame(frame: &[u8]) -> FrameAction {
107 let Ok(eth) = EthernetFrame::new_checked(frame) else {
108 return FrameAction::Passthrough;
109 };
110
111 match eth.ethertype() {
112 EthernetProtocol::Ipv4 => classify_ipv4(eth.payload()),
113 EthernetProtocol::Ipv6 => classify_ipv6(eth.payload()),
114 _ => FrameAction::Passthrough, }
116}
117
118pub fn create_interface(device: &mut SmoltcpDevice, config: &PollLoopConfig) -> Interface {
125 let hw_addr = HardwareAddress::Ethernet(EthernetAddress(config.gateway_mac));
126 let iface_config = Config::new(hw_addr);
127 let mut iface = Interface::new(iface_config, device, smoltcp_now());
128
129 iface.update_ip_addrs(|addrs| {
131 if let Some(ipv4) = config.gateway.ipv4 {
132 addrs
133 .push(IpCidr::new(IpAddress::Ipv4(ipv4), 30)) .expect("failed to add gateway IPv4 address");
135 }
136 if let Some(ipv6) = config.gateway.ipv6 {
137 addrs
138 .push(IpCidr::new(IpAddress::Ipv6(ipv6), 64))
139 .expect("failed to add gateway IPv6 address");
140 }
141 });
142
143 if let Some(ipv4) = config.gateway.ipv4 {
145 iface
146 .routes_mut()
147 .add_default_ipv4_route(ipv4)
148 .expect("failed to add default IPv4 route");
149 }
150 if let Some(ipv6) = config.gateway.ipv6 {
151 iface
152 .routes_mut()
153 .add_default_ipv6_route(ipv6)
154 .expect("failed to add default IPv6 route");
155 }
156
157 iface.set_any_ip(true);
159
160 iface
161}
162
163#[allow(clippy::too_many_arguments)]
194pub fn smoltcp_poll_loop(
195 shared: Arc<SharedState>,
196 config: PollLoopConfig,
197 network_policy: NetworkPolicy,
198 dns_config: DnsConfig,
199 tls_state: Option<Arc<TlsState>>,
200 published_ports: Vec<PublishedPort>,
201 max_connections: Option<usize>,
202 tokio_handle: tokio::runtime::Handle,
203 secrets: Arc<SecretsConfig>,
204) {
205 let mut device = SmoltcpDevice::new(shared.clone(), config.mtu);
206 let mut iface = create_interface(&mut device, &config);
207 let mut sockets = SocketSet::new(vec![]);
208 let mut conn_tracker = ConnectionTracker::new(max_connections);
209
210 let gateway_ips: Arc<HashSet<IpAddr>> = Arc::new(
216 config
217 .gateway
218 .ipv4
219 .map(IpAddr::V4)
220 .into_iter()
221 .chain(config.gateway.ipv6.map(IpAddr::V6))
222 .collect(),
223 );
224 shared.set_gateway_ips(config.gateway.ipv4, config.gateway.ipv6);
227 let network_policy = Arc::new(network_policy);
228
229 let (mut dns_interceptor, dns_forwarder_handle) = DnsInterceptor::new(
230 &mut sockets,
231 dns_config,
232 shared.clone(),
233 &tokio_handle,
234 gateway_ips,
235 network_policy.clone(),
236 config.gateway,
237 config.gateway_mac,
238 config.guest_mac,
239 );
240 let mut port_publisher = PortPublisher::new(
241 &published_ports,
242 config.guest_ipv4,
243 config.guest_ipv6,
244 config.gateway.ipv4,
245 config.gateway.ipv6,
246 config.gateway_mac,
247 config.guest_mac,
248 network_policy.clone(),
249 shared.clone(),
250 &tokio_handle,
251 );
252 let mut udp_relay = UdpRelay::new(
253 shared.clone(),
254 config.gateway_mac,
255 config.guest_mac,
256 tokio_handle.clone(),
257 );
258 let icmp_relay = IcmpRelay::new(
259 shared.clone(),
260 config.gateway_mac,
261 config.guest_mac,
262 tokio_handle.clone(),
263 );
264
265 let mut last_cleanup = std::time::Instant::now();
267
268 let mut poll_fds = [
270 libc::pollfd {
271 fd: shared.tx_wake.as_raw_fd(),
272 events: libc::POLLIN,
273 revents: 0,
274 },
275 libc::pollfd {
276 fd: shared.proxy_wake.as_raw_fd(),
277 events: libc::POLLIN,
278 revents: 0,
279 },
280 ];
281
282 loop {
283 let now = smoltcp_now();
284
285 while let Some(frame) = device.stage_next_frame() {
287 if handle_gateway_icmp_echo(frame, &config, &shared) {
288 device.drop_staged_frame();
289 continue;
290 }
291
292 if icmp_relay.relay_outbound_if_echo(frame, &config, &network_policy) {
293 device.drop_staged_frame();
294 continue;
295 }
296
297 match classify_frame(frame) {
298 FrameAction::TcpSyn { src, dst } => {
299 let allow = match DnsPortType::from_tcp(dst.port()) {
300 DnsPortType::Dns => true,
304 DnsPortType::EncryptedDns => {
313 if tls_state.is_some() {
314 true
315 } else {
316 tracing::debug!(%dst, "DoT port refused (TLS interception not configured); stub should fall back to TCP/53");
317 false
318 }
319 }
320 DnsPortType::AlternativeDns => {
326 tracing::debug!(%dst, "alternative-DNS TCP port refused; stub should fall back to TCP/53");
327 false
328 }
329 DnsPortType::Other => match network_policy.evaluate_egress_with_source(
332 dst,
333 Protocol::Tcp,
334 &shared,
335 HostnameSource::Deferred,
336 ) {
337 EgressEvaluation::Allow | EgressEvaluation::DeferUntilHostname => true,
338 EgressEvaluation::Deny => false,
339 },
340 };
341 if allow && !conn_tracker.has_socket_for(&src, &dst) {
342 conn_tracker.create_tcp_socket(src, dst, &mut sockets);
343 }
344 iface.poll_ingress_single(now, &mut device, &mut sockets);
347 }
348
349 FrameAction::UdpRelay { src, dst } => {
350 if port_publisher.relay_udp_outbound(frame, src, dst) {
351 device.drop_staged_frame();
352 continue;
353 }
354
355 if let Some(ref tls) = tls_state
358 && tls.config.intercepted_ports.contains(&dst.port())
359 && tls.config.block_quic_on_intercept
360 {
361 device.drop_staged_frame();
362 continue;
363 }
364
365 match DnsPortType::from_udp(dst.port()) {
366 DnsPortType::Dns => {
370 device.drop_staged_frame();
371 continue;
372 }
373 DnsPortType::EncryptedDns => {
378 device.drop_staged_frame();
379 continue;
380 }
381 DnsPortType::AlternativeDns => {
384 tracing::debug!(%dst, "alternative-DNS UDP port dropped; stub should fall back to UDP/53");
385 device.drop_staged_frame();
386 continue;
387 }
388 DnsPortType::Other => {}
389 }
390
391 if network_policy
393 .evaluate_egress(dst, Protocol::Udp, &shared)
394 .is_deny()
395 {
396 device.drop_staged_frame();
397 continue;
398 }
399
400 let host_dst = resolve_host_dst(dst, config.gateway);
404 udp_relay.relay_outbound(frame, src, dst, host_dst);
405 device.drop_staged_frame();
406 }
407
408 FrameAction::Dns | FrameAction::Passthrough => {
409 iface.poll_ingress_single(now, &mut device, &mut sockets);
411 }
412 }
413 }
414
415 loop {
419 let result = iface.poll_egress(now, &mut device, &mut sockets);
420 if matches!(result, smoltcp::iface::PollResult::None) {
421 break;
422 }
423 }
424 iface.poll_maintenance(now);
425
426 if device.frames_emitted.swap(false, Ordering::Relaxed) {
429 shared.rx_wake.wake();
430 }
431
432 conn_tracker.relay_data(&mut sockets);
437 dns_interceptor.process(&mut sockets);
438
439 port_publisher.accept_inbound(&mut iface, &mut sockets, &shared, &tokio_handle);
441 port_publisher.relay_data(&mut sockets);
442
443 let new_conns = conn_tracker.take_new_connections(&mut sockets);
445 for conn in new_conns {
446 if let Some(ref tls_state) = tls_state
447 && tls_state
448 .config
449 .intercepted_ports
450 .contains(&conn.dst.port())
451 {
452 let connect_dst = resolve_host_dst(conn.dst, config.gateway);
454 tls_proxy::spawn_tls_proxy(
455 &tokio_handle,
456 conn.dst,
457 connect_dst,
458 conn.from_smoltcp,
459 conn.to_smoltcp,
460 shared.clone(),
461 tls_state.clone(),
462 network_policy.clone(),
463 conn.proxy_connect,
464 );
465 continue;
466 }
467 if conn.dst.port() == 53 {
468 conn.proxy_connect.mark_connected();
475
476 DnsTcpProxy::spawn(
486 &tokio_handle,
487 conn.dst,
488 conn.from_smoltcp,
489 conn.to_smoltcp,
490 dns_forwarder_handle.clone(),
491 shared.clone(),
492 );
493 continue;
494 }
495 if conn.dst.port() == 853
496 && let Some(ref tls_state) = tls_state
497 {
498 conn.proxy_connect.mark_connected();
500
501 DotProxy::spawn(
507 &tokio_handle,
508 conn.dst,
509 conn.from_smoltcp,
510 conn.to_smoltcp,
511 dns_forwarder_handle.clone(),
512 tls_state.clone(),
513 shared.clone(),
514 );
515 continue;
516 }
517 let connect_dst = resolve_host_dst(conn.dst, config.gateway);
519 proxy::spawn_tcp_proxy(
520 &tokio_handle,
521 conn.dst,
522 connect_dst,
523 conn.from_smoltcp,
524 conn.to_smoltcp,
525 shared.clone(),
526 network_policy.clone(),
527 secrets.clone(),
528 conn.proxy_connect,
529 );
530 }
531
532 if last_cleanup.elapsed() >= std::time::Duration::from_secs(1) {
535 conn_tracker.cleanup_closed(&mut sockets);
536 port_publisher.cleanup_closed(&mut sockets);
537 udp_relay.cleanup_expired();
538 shared.cleanup_resolved_hostnames();
539 last_cleanup = std::time::Instant::now();
540 }
541
542 loop {
545 let result = iface.poll_egress(now, &mut device, &mut sockets);
546 if matches!(result, smoltcp::iface::PollResult::None) {
547 break;
548 }
549 }
550
551 if device.frames_emitted.swap(false, Ordering::Relaxed) {
553 shared.rx_wake.wake();
554 }
555
556 let timeout_ms = iface
557 .poll_delay(now, &sockets)
558 .map(|d| d.total_millis().min(i32::MAX as u64) as i32)
559 .unwrap_or(100); unsafe {
563 libc::poll(
564 poll_fds.as_mut_ptr(),
565 poll_fds.len() as libc::nfds_t,
566 timeout_ms,
567 );
568 }
569
570 if poll_fds[0].revents & libc::POLLIN != 0 {
572 shared.tx_wake.drain();
573 }
574 if poll_fds[1].revents & libc::POLLIN != 0 {
575 shared.proxy_wake.drain();
576 }
577 }
578}
579
580pub(crate) fn resolve_host_dst(dst: SocketAddr, gateway: GatewayIps) -> SocketAddr {
594 match dst.ip() {
595 IpAddr::V4(v4) if gateway.ipv4 == Some(v4) => {
596 SocketAddr::new(IpAddr::V4(Ipv4Addr::LOCALHOST), dst.port())
597 }
598 IpAddr::V6(v6) if gateway.ipv6 == Some(v6) => {
599 SocketAddr::new(IpAddr::V6(Ipv6Addr::LOCALHOST), dst.port())
600 }
601 _ => dst,
602 }
603}
604
605fn smoltcp_now() -> Instant {
611 static EPOCH: std::sync::OnceLock<std::time::Instant> = std::sync::OnceLock::new();
612 let epoch = EPOCH.get_or_init(std::time::Instant::now);
613 let elapsed = epoch.elapsed();
614 Instant::from_millis(elapsed.as_millis() as i64)
615}
616
617fn handle_gateway_icmp_echo(frame: &[u8], config: &PollLoopConfig, shared: &SharedState) -> bool {
624 let Ok(eth) = EthernetFrame::new_checked(frame) else {
625 return false;
626 };
627
628 let reply = match eth.ethertype() {
629 EthernetProtocol::Ipv4 => gateway_icmpv4_echo_reply(ð, config),
630 EthernetProtocol::Ipv6 => gateway_icmpv6_echo_reply(ð, config),
631 _ => None,
632 };
633 let Some(reply) = reply else {
634 return false;
635 };
636
637 shared.push_rx_frame_and_wake(reply);
638
639 true
640}
641
642fn gateway_icmpv4_echo_reply(
644 eth: &EthernetFrame<&[u8]>,
645 config: &PollLoopConfig,
646) -> Option<Vec<u8>> {
647 let gateway_ipv4 = config.gateway.ipv4?;
648 let ipv4 = Ipv4Packet::new_checked(eth.payload()).ok()?;
649 if ipv4.dst_addr() != gateway_ipv4 || ipv4.next_header() != IpProtocol::Icmp {
650 return None;
651 }
652
653 let icmp = Icmpv4Packet::new_checked(ipv4.payload()).ok()?;
654 let Icmpv4Repr::EchoRequest {
655 ident,
656 seq_no,
657 data,
658 } = Icmpv4Repr::parse(&icmp, &smoltcp::phy::ChecksumCapabilities::default()).ok()?
659 else {
660 return None;
661 };
662
663 let ipv4_repr = Ipv4Repr {
664 src_addr: gateway_ipv4,
665 dst_addr: ipv4.src_addr(),
666 next_header: IpProtocol::Icmp,
667 payload_len: 8 + data.len(),
668 hop_limit: 64,
669 };
670 let icmp_repr = Icmpv4Repr::EchoReply {
671 ident,
672 seq_no,
673 data,
674 };
675 let mut reply = vec![0u8; 14 + ipv4_repr.buffer_len() + icmp_repr.buffer_len()];
676
677 let mut reply_eth = EthernetFrame::new_unchecked(&mut reply);
678 reply_eth.set_src_addr(EthernetAddress(config.gateway_mac));
679 reply_eth.set_dst_addr(eth.src_addr());
680 reply_eth.set_ethertype(EthernetProtocol::Ipv4);
681
682 ipv4_repr.emit(
683 &mut Ipv4Packet::new_unchecked(&mut reply[14..34]),
684 &smoltcp::phy::ChecksumCapabilities::default(),
685 );
686 icmp_repr.emit(
687 &mut Icmpv4Packet::new_unchecked(&mut reply[34..]),
688 &smoltcp::phy::ChecksumCapabilities::default(),
689 );
690
691 Some(reply)
692}
693
694fn gateway_icmpv6_echo_reply(
696 eth: &EthernetFrame<&[u8]>,
697 config: &PollLoopConfig,
698) -> Option<Vec<u8>> {
699 let gateway_ipv6 = config.gateway.ipv6?;
700 let ipv6 = Ipv6Packet::new_checked(eth.payload()).ok()?;
701 if ipv6.dst_addr() != gateway_ipv6 || ipv6.next_header() != IpProtocol::Icmpv6 {
702 return None;
703 }
704
705 let icmp = Icmpv6Packet::new_checked(ipv6.payload()).ok()?;
706 let Icmpv6Repr::EchoRequest {
707 ident,
708 seq_no,
709 data,
710 } = Icmpv6Repr::parse(
711 &ipv6.src_addr(),
712 &ipv6.dst_addr(),
713 &icmp,
714 &smoltcp::phy::ChecksumCapabilities::default(),
715 )
716 .ok()?
717 else {
718 return None;
719 };
720
721 let ipv6_repr = Ipv6Repr {
722 src_addr: gateway_ipv6,
723 dst_addr: ipv6.src_addr(),
724 next_header: IpProtocol::Icmpv6,
725 payload_len: icmp_repr_buffer_len_v6(data),
726 hop_limit: 64,
727 };
728 let icmp_repr = Icmpv6Repr::EchoReply {
729 ident,
730 seq_no,
731 data,
732 };
733 let ipv6_hdr_len = 40;
734 let mut reply = vec![0u8; 14 + ipv6_hdr_len + icmp_repr.buffer_len()];
735
736 let mut reply_eth = EthernetFrame::new_unchecked(&mut reply);
737 reply_eth.set_src_addr(EthernetAddress(config.gateway_mac));
738 reply_eth.set_dst_addr(eth.src_addr());
739 reply_eth.set_ethertype(EthernetProtocol::Ipv6);
740
741 ipv6_repr.emit(&mut Ipv6Packet::new_unchecked(&mut reply[14..54]));
742 icmp_repr.emit(
743 &gateway_ipv6,
744 &ipv6.src_addr(),
745 &mut Icmpv6Packet::new_unchecked(&mut reply[54..]),
746 &smoltcp::phy::ChecksumCapabilities::default(),
747 );
748
749 Some(reply)
750}
751
752fn icmp_repr_buffer_len_v6(data: &[u8]) -> usize {
753 Icmpv6Repr::EchoReply {
754 ident: 0,
755 seq_no: 0,
756 data,
757 }
758 .buffer_len()
759}
760
761fn classify_ipv4(payload: &[u8]) -> FrameAction {
763 let Ok(ipv4) = Ipv4Packet::new_checked(payload) else {
764 return FrameAction::Passthrough;
765 };
766 classify_transport(
767 ipv4.next_header(),
768 ipv4.src_addr().into(),
769 ipv4.dst_addr().into(),
770 ipv4.payload(),
771 )
772}
773
774fn classify_ipv6(payload: &[u8]) -> FrameAction {
776 let Ok(ipv6) = Ipv6Packet::new_checked(payload) else {
777 return FrameAction::Passthrough;
778 };
779 classify_transport(
780 ipv6.next_header(),
781 ipv6.src_addr().into(),
782 ipv6.dst_addr().into(),
783 ipv6.payload(),
784 )
785}
786
787fn classify_transport(
789 protocol: IpProtocol,
790 src_ip: std::net::IpAddr,
791 dst_ip: std::net::IpAddr,
792 transport_payload: &[u8],
793) -> FrameAction {
794 match protocol {
795 IpProtocol::Tcp => {
796 let Ok(tcp) = TcpPacket::new_checked(transport_payload) else {
797 return FrameAction::Passthrough;
798 };
799 if tcp.syn() && !tcp.ack() {
800 FrameAction::TcpSyn {
801 src: SocketAddr::new(src_ip, tcp.src_port()),
802 dst: SocketAddr::new(dst_ip, tcp.dst_port()),
803 }
804 } else {
805 FrameAction::Passthrough
806 }
807 }
808 IpProtocol::Udp => {
809 let Ok(udp) = UdpPacket::new_checked(transport_payload) else {
810 return FrameAction::Passthrough;
811 };
812 if DnsPortType::from_udp(udp.dst_port()) == DnsPortType::Dns {
816 FrameAction::Dns
817 } else {
818 FrameAction::UdpRelay {
819 src: SocketAddr::new(src_ip, udp.src_port()),
820 dst: SocketAddr::new(dst_ip, udp.dst_port()),
821 }
822 }
823 }
824 _ => FrameAction::Passthrough, }
826}
827
828#[cfg(test)]
833mod tests {
834 use super::*;
835 use std::sync::Arc;
836
837 use smoltcp::phy::ChecksumCapabilities;
838 use smoltcp::wire::{
839 ArpOperation, ArpPacket, ArpRepr, EthernetRepr, Icmpv4Packet, Icmpv4Repr, Ipv4Repr,
840 };
841
842 use crate::device::SmoltcpDevice;
843 use crate::shared::SharedState;
844
845 fn build_tcp_syn_frame(
847 src_ip: [u8; 4],
848 dst_ip: [u8; 4],
849 src_port: u16,
850 dst_port: u16,
851 ) -> Vec<u8> {
852 let mut frame = vec![0u8; 14 + 20 + 20]; frame[12] = 0x08; frame[13] = 0x00;
857
858 let ip = &mut frame[14..34];
860 ip[0] = 0x45; let total_len = 40u16; ip[2..4].copy_from_slice(&total_len.to_be_bytes());
863 ip[6] = 0x40; ip[8] = 64; ip[9] = 6; ip[12..16].copy_from_slice(&src_ip);
867 ip[16..20].copy_from_slice(&dst_ip);
868
869 let tcp = &mut frame[34..54];
871 tcp[0..2].copy_from_slice(&src_port.to_be_bytes());
872 tcp[2..4].copy_from_slice(&dst_port.to_be_bytes());
873 tcp[12] = 0x50; tcp[13] = 0x02; frame
877 }
878
879 fn build_udp_frame(src_ip: [u8; 4], dst_ip: [u8; 4], src_port: u16, dst_port: u16) -> Vec<u8> {
881 let mut frame = vec![0u8; 14 + 20 + 8]; frame[12] = 0x08;
885 frame[13] = 0x00;
886
887 let ip = &mut frame[14..34];
889 ip[0] = 0x45;
890 let total_len = 28u16; ip[2..4].copy_from_slice(&total_len.to_be_bytes());
892 ip[8] = 64;
893 ip[9] = 17; ip[12..16].copy_from_slice(&src_ip);
895 ip[16..20].copy_from_slice(&dst_ip);
896
897 let udp = &mut frame[34..42];
899 udp[0..2].copy_from_slice(&src_port.to_be_bytes());
900 udp[2..4].copy_from_slice(&dst_port.to_be_bytes());
901 let udp_len = 8u16;
902 udp[4..6].copy_from_slice(&udp_len.to_be_bytes());
903
904 frame
905 }
906
907 fn build_icmpv4_echo_frame(
909 src_mac: [u8; 6],
910 dst_mac: [u8; 6],
911 src_ip: [u8; 4],
912 dst_ip: [u8; 4],
913 ident: u16,
914 seq_no: u16,
915 data: &[u8],
916 ) -> Vec<u8> {
917 let ipv4_repr = Ipv4Repr {
918 src_addr: Ipv4Addr::from(src_ip),
919 dst_addr: Ipv4Addr::from(dst_ip),
920 next_header: IpProtocol::Icmp,
921 payload_len: 8 + data.len(),
922 hop_limit: 64,
923 };
924 let icmp_repr = Icmpv4Repr::EchoRequest {
925 ident,
926 seq_no,
927 data,
928 };
929 let frame_len = 14 + ipv4_repr.buffer_len() + icmp_repr.buffer_len();
930 let mut frame = vec![0u8; frame_len];
931
932 let mut eth_frame = EthernetFrame::new_unchecked(&mut frame);
933 EthernetRepr {
934 src_addr: EthernetAddress(src_mac),
935 dst_addr: EthernetAddress(dst_mac),
936 ethertype: EthernetProtocol::Ipv4,
937 }
938 .emit(&mut eth_frame);
939
940 ipv4_repr.emit(
941 &mut Ipv4Packet::new_unchecked(&mut frame[14..34]),
942 &ChecksumCapabilities::default(),
943 );
944 icmp_repr.emit(
945 &mut Icmpv4Packet::new_unchecked(&mut frame[34..]),
946 &ChecksumCapabilities::default(),
947 );
948
949 frame
950 }
951
952 fn build_arp_request_frame(src_mac: [u8; 6], src_ip: [u8; 4], target_ip: [u8; 4]) -> Vec<u8> {
954 let mut frame = vec![0u8; 14 + 28];
955
956 let mut eth_frame = EthernetFrame::new_unchecked(&mut frame);
957 EthernetRepr {
958 src_addr: EthernetAddress(src_mac),
959 dst_addr: EthernetAddress([0xff; 6]),
960 ethertype: EthernetProtocol::Arp,
961 }
962 .emit(&mut eth_frame);
963
964 ArpRepr::EthernetIpv4 {
965 operation: ArpOperation::Request,
966 source_hardware_addr: EthernetAddress(src_mac),
967 source_protocol_addr: Ipv4Addr::from(src_ip),
968 target_hardware_addr: EthernetAddress([0x00; 6]),
969 target_protocol_addr: Ipv4Addr::from(target_ip),
970 }
971 .emit(&mut ArpPacket::new_unchecked(&mut frame[14..]));
972
973 frame
974 }
975
976 #[test]
977 fn classify_tcp_syn() {
978 let frame = build_tcp_syn_frame([10, 0, 0, 2], [93, 184, 216, 34], 54321, 443);
979 match classify_frame(&frame) {
980 FrameAction::TcpSyn { src, dst } => {
981 assert_eq!(
982 src,
983 SocketAddr::new(Ipv4Addr::new(10, 0, 0, 2).into(), 54321)
984 );
985 assert_eq!(
986 dst,
987 SocketAddr::new(Ipv4Addr::new(93, 184, 216, 34).into(), 443)
988 );
989 }
990 _ => panic!("expected TcpSyn"),
991 }
992 }
993
994 #[test]
995 fn classify_tcp_ack_is_passthrough() {
996 let mut frame = build_tcp_syn_frame([10, 0, 0, 2], [93, 184, 216, 34], 54321, 443);
997 frame[34 + 13] = 0x10; assert!(matches!(classify_frame(&frame), FrameAction::Passthrough));
1000 }
1001
1002 #[test]
1003 fn classify_udp_dns() {
1004 let frame = build_udp_frame([10, 0, 0, 2], [10, 0, 0, 1], 12345, 53);
1005 assert!(matches!(classify_frame(&frame), FrameAction::Dns));
1006 }
1007
1008 #[test]
1009 fn classify_udp_non_dns() {
1010 let frame = build_udp_frame([10, 0, 0, 2], [8, 8, 8, 8], 12345, 443);
1011 match classify_frame(&frame) {
1012 FrameAction::UdpRelay { src, dst } => {
1013 assert_eq!(src.port(), 12345);
1014 assert_eq!(dst.port(), 443);
1015 }
1016 _ => panic!("expected UdpRelay"),
1017 }
1018 }
1019
1020 #[test]
1021 fn classify_arp_is_passthrough() {
1022 let mut frame = vec![0u8; 42]; frame[12] = 0x08;
1024 frame[13] = 0x06; assert!(matches!(classify_frame(&frame), FrameAction::Passthrough));
1026 }
1027
1028 #[test]
1029 fn classify_garbage_is_passthrough() {
1030 assert!(matches!(classify_frame(&[]), FrameAction::Passthrough));
1031 assert!(matches!(classify_frame(&[0; 5]), FrameAction::Passthrough));
1032 }
1033
1034 #[test]
1035 fn gateway_replies_to_icmp_echo_requests() {
1036 fn drive_one_frame(
1037 device: &mut SmoltcpDevice,
1038 iface: &mut Interface,
1039 sockets: &mut SocketSet<'_>,
1040 shared: &Arc<SharedState>,
1041 poll_config: &PollLoopConfig,
1042 now: Instant,
1043 ) {
1044 let frame = device.stage_next_frame().expect("expected staged frame");
1045 if handle_gateway_icmp_echo(frame, poll_config, shared) {
1046 device.drop_staged_frame();
1047 return;
1048 }
1049 let _ = iface.poll_ingress_single(now, device, sockets);
1050 let _ = iface.poll_egress(now, device, sockets);
1051 }
1052
1053 let shared = Arc::new(SharedState::new(4));
1054 let poll_config = PollLoopConfig {
1055 gateway_mac: [0x02, 0x00, 0x00, 0x00, 0x00, 0x01],
1056 guest_mac: [0x02, 0x00, 0x00, 0x00, 0x00, 0x02],
1057 gateway: GatewayIps {
1058 ipv4: Some(Ipv4Addr::new(100, 96, 0, 1)),
1059 ipv6: Some(Ipv6Addr::LOCALHOST),
1060 },
1061 guest_ipv4: Some(Ipv4Addr::new(100, 96, 0, 2)),
1062 guest_ipv6: None,
1063 mtu: 1500,
1064 };
1065 let guest_ipv4 = poll_config.guest_ipv4.unwrap();
1066 let gateway_ipv4 = poll_config.gateway.ipv4.unwrap();
1067 let mut device = SmoltcpDevice::new(shared.clone(), poll_config.mtu);
1068 let mut iface = create_interface(&mut device, &poll_config);
1069 let mut sockets = SocketSet::new(vec![]);
1070 let now = smoltcp_now();
1071
1072 shared
1075 .tx_ring
1076 .push(build_arp_request_frame(
1077 poll_config.guest_mac,
1078 guest_ipv4.octets(),
1079 gateway_ipv4.octets(),
1080 ))
1081 .unwrap();
1082 shared
1083 .tx_ring
1084 .push(build_icmpv4_echo_frame(
1085 poll_config.guest_mac,
1086 poll_config.gateway_mac,
1087 guest_ipv4.octets(),
1088 gateway_ipv4.octets(),
1089 0x1234,
1090 0xABCD,
1091 b"ping",
1092 ))
1093 .unwrap();
1094
1095 drive_one_frame(
1096 &mut device,
1097 &mut iface,
1098 &mut sockets,
1099 &shared,
1100 &poll_config,
1101 now,
1102 );
1103 let _ = shared.rx_ring.pop().expect("expected ARP reply");
1104
1105 drive_one_frame(
1106 &mut device,
1107 &mut iface,
1108 &mut sockets,
1109 &shared,
1110 &poll_config,
1111 now,
1112 );
1113
1114 let reply = shared.rx_ring.pop().expect("expected ICMP echo reply");
1115 let eth = EthernetFrame::new_checked(&reply).expect("valid ethernet frame");
1116 assert_eq!(eth.src_addr(), EthernetAddress(poll_config.gateway_mac));
1117 assert_eq!(eth.dst_addr(), EthernetAddress(poll_config.guest_mac));
1118 assert_eq!(eth.ethertype(), EthernetProtocol::Ipv4);
1119
1120 let ipv4 = Ipv4Packet::new_checked(eth.payload()).expect("valid IPv4 packet");
1121 assert_eq!(ipv4.src_addr(), gateway_ipv4);
1122 assert_eq!(ipv4.dst_addr(), guest_ipv4);
1123 assert_eq!(ipv4.next_header(), IpProtocol::Icmp);
1124
1125 let icmp = Icmpv4Packet::new_checked(ipv4.payload()).expect("valid ICMP packet");
1126 let icmp_repr = Icmpv4Repr::parse(&icmp, &ChecksumCapabilities::default())
1127 .expect("valid ICMP echo reply");
1128 assert_eq!(
1129 icmp_repr,
1130 Icmpv4Repr::EchoReply {
1131 ident: 0x1234,
1132 seq_no: 0xABCD,
1133 data: b"ping",
1134 }
1135 );
1136 }
1137
1138 fn test_gateway() -> GatewayIps {
1139 GatewayIps {
1140 ipv4: Some(Ipv4Addr::new(100, 96, 0, 1)),
1141 ipv6: Some("fd42:6d73:62::1".parse().unwrap()),
1142 }
1143 }
1144
1145 #[test]
1146 fn resolve_host_dst_matches_ipv4() {
1147 let gw = test_gateway();
1148 let dst = SocketAddr::new(IpAddr::V4(gw.ipv4.unwrap()), 8080);
1149 assert_eq!(
1150 resolve_host_dst(dst, gw),
1151 SocketAddr::new(IpAddr::V4(Ipv4Addr::LOCALHOST), 8080)
1152 );
1153 }
1154
1155 #[test]
1156 fn resolve_host_dst_matches_ipv6() {
1157 let gw = test_gateway();
1158 let dst = SocketAddr::new(IpAddr::V6(gw.ipv6.unwrap()), 8080);
1159 assert_eq!(
1160 resolve_host_dst(dst, gw),
1161 SocketAddr::new(IpAddr::V6(Ipv6Addr::LOCALHOST), 8080)
1162 );
1163 }
1164
1165 #[test]
1166 fn resolve_host_dst_passes_through_when_family_absent() {
1167 let gw = GatewayIps {
1168 ipv4: None,
1169 ipv6: Some("fd42:6d73:62::1".parse().unwrap()),
1170 };
1171 let dst = SocketAddr::new(IpAddr::V4(Ipv4Addr::new(100, 96, 0, 1)), 8080);
1173 assert_eq!(resolve_host_dst(dst, gw), dst);
1174 }
1175
1176 #[test]
1177 fn resolve_host_dst_passes_through_non_gateway() {
1178 let gw = test_gateway();
1179 let dst = SocketAddr::new(IpAddr::V4(Ipv4Addr::new(8, 8, 8, 8)), 443);
1180 assert_eq!(resolve_host_dst(dst, gw), dst);
1181 }
1182
1183 #[test]
1184 fn external_icmp_echo_requests_are_not_answered_locally() {
1185 fn drive_one_frame(
1186 device: &mut SmoltcpDevice,
1187 iface: &mut Interface,
1188 sockets: &mut SocketSet<'_>,
1189 shared: &Arc<SharedState>,
1190 poll_config: &PollLoopConfig,
1191 now: Instant,
1192 ) {
1193 let frame = device.stage_next_frame().expect("expected staged frame");
1194 if handle_gateway_icmp_echo(frame, poll_config, shared) {
1195 device.drop_staged_frame();
1196 return;
1197 }
1198 let _ = iface.poll_ingress_single(now, device, sockets);
1199 let _ = iface.poll_egress(now, device, sockets);
1200 }
1201
1202 let shared = Arc::new(SharedState::new(4));
1203 let poll_config = PollLoopConfig {
1204 gateway_mac: [0x02, 0x00, 0x00, 0x00, 0x00, 0x01],
1205 guest_mac: [0x02, 0x00, 0x00, 0x00, 0x00, 0x02],
1206 gateway: GatewayIps {
1207 ipv4: Some(Ipv4Addr::new(100, 96, 0, 1)),
1208 ipv6: Some(Ipv6Addr::LOCALHOST),
1209 },
1210 guest_ipv4: Some(Ipv4Addr::new(100, 96, 0, 2)),
1211 guest_ipv6: None,
1212 mtu: 1500,
1213 };
1214 let guest_ipv4 = poll_config.guest_ipv4.unwrap();
1215 let gateway_ipv4 = poll_config.gateway.ipv4.unwrap();
1216 let mut device = SmoltcpDevice::new(shared.clone(), poll_config.mtu);
1217 let mut iface = create_interface(&mut device, &poll_config);
1218 let mut sockets = SocketSet::new(vec![]);
1219 let now = smoltcp_now();
1220
1221 shared
1222 .tx_ring
1223 .push(build_arp_request_frame(
1224 poll_config.guest_mac,
1225 guest_ipv4.octets(),
1226 gateway_ipv4.octets(),
1227 ))
1228 .unwrap();
1229 shared
1230 .tx_ring
1231 .push(build_icmpv4_echo_frame(
1232 poll_config.guest_mac,
1233 poll_config.gateway_mac,
1234 guest_ipv4.octets(),
1235 [142, 251, 216, 46],
1236 0x1234,
1237 0xABCD,
1238 b"ping",
1239 ))
1240 .unwrap();
1241
1242 drive_one_frame(
1243 &mut device,
1244 &mut iface,
1245 &mut sockets,
1246 &shared,
1247 &poll_config,
1248 now,
1249 );
1250 let _ = shared.rx_ring.pop().expect("expected ARP reply");
1251
1252 drive_one_frame(
1253 &mut device,
1254 &mut iface,
1255 &mut sockets,
1256 &shared,
1257 &poll_config,
1258 now,
1259 );
1260 assert!(
1261 shared.rx_ring.pop().is_none(),
1262 "external ICMP should not be answered locally"
1263 );
1264 }
1265}