mirror of
https://github.com/EasyTier/EasyTier.git
synced 2026-05-07 10:14:35 +00:00
Add fake tcp tunnel (experimental) (#1673)
support faketcp to avoid tcp-over-tcp problem. linux/macos/windows are supported. better to be used in internet env, the maximum performance is majorly limited by windivert/raw socket.
This commit is contained in:
@@ -0,0 +1,159 @@
|
||||
use bytes::{Bytes, BytesMut};
|
||||
use pnet::packet::ethernet::{EtherTypes, EthernetPacket, MutableEthernetPacket};
|
||||
use pnet::packet::{ip, ipv4, ipv6, tcp};
|
||||
use pnet::util::MacAddr;
|
||||
use std::convert::TryInto;
|
||||
use std::net::{IpAddr, SocketAddr};
|
||||
|
||||
const IPV4_HEADER_LEN: usize = 20;
|
||||
const IPV6_HEADER_LEN: usize = 40;
|
||||
const TCP_HEADER_LEN: usize = 20;
|
||||
pub const MAX_PACKET_LEN: usize = 1500;
|
||||
|
||||
#[derive(Debug)]
|
||||
pub enum IPPacket<'p> {
|
||||
V4(ipv4::Ipv4Packet<'p>),
|
||||
V6(ipv6::Ipv6Packet<'p>),
|
||||
}
|
||||
|
||||
impl IPPacket<'_> {
|
||||
pub fn get_source(&self) -> IpAddr {
|
||||
match self {
|
||||
IPPacket::V4(p) => IpAddr::V4(p.get_source()),
|
||||
IPPacket::V6(p) => IpAddr::V6(p.get_source()),
|
||||
}
|
||||
}
|
||||
|
||||
pub fn get_destination(&self) -> IpAddr {
|
||||
match self {
|
||||
IPPacket::V4(p) => IpAddr::V4(p.get_destination()),
|
||||
IPPacket::V6(p) => IpAddr::V6(p.get_destination()),
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
const ETH_HDR_LEN: usize = 14;
|
||||
|
||||
#[allow(clippy::too_many_arguments)]
|
||||
pub fn build_tcp_packet(
|
||||
src_mac: MacAddr,
|
||||
dst_mac: MacAddr,
|
||||
local_addr: SocketAddr,
|
||||
remote_addr: SocketAddr,
|
||||
seq: u32,
|
||||
ack: u32,
|
||||
flags: u8,
|
||||
payload: Option<&[u8]>,
|
||||
) -> Bytes {
|
||||
let ip_header_len = match local_addr {
|
||||
SocketAddr::V4(_) => IPV4_HEADER_LEN,
|
||||
SocketAddr::V6(_) => IPV6_HEADER_LEN,
|
||||
};
|
||||
let wscale = (flags & tcp::TcpFlags::SYN) != 0;
|
||||
let tcp_header_len = TCP_HEADER_LEN + if wscale { 4 } else { 0 }; // nop + wscale
|
||||
let tcp_total_len = tcp_header_len + payload.map_or(0, |payload| payload.len());
|
||||
let total_len = ip_header_len + tcp_total_len;
|
||||
let mut buf = BytesMut::zeroed(ETH_HDR_LEN + total_len);
|
||||
|
||||
let mut eth_buf = buf.split_to(ETH_HDR_LEN);
|
||||
let mut ip_buf = buf.split_to(ip_header_len);
|
||||
let mut tcp_buf = buf.split_to(tcp_total_len);
|
||||
assert_eq!(0, buf.len());
|
||||
|
||||
let mut tcp = tcp::MutableTcpPacket::new(&mut tcp_buf).unwrap();
|
||||
tcp.set_window(0xffff);
|
||||
tcp.set_source(local_addr.port());
|
||||
tcp.set_destination(remote_addr.port());
|
||||
tcp.set_sequence(seq);
|
||||
tcp.set_acknowledgement(ack);
|
||||
tcp.set_flags(flags);
|
||||
tcp.set_data_offset(TCP_HEADER_LEN as u8 / 4 + if wscale { 1 } else { 0 });
|
||||
if wscale {
|
||||
let wscale = tcp::TcpOption::wscale(14);
|
||||
tcp.set_options(&[tcp::TcpOption::nop(), wscale]);
|
||||
}
|
||||
|
||||
if let Some(payload) = payload {
|
||||
tcp.set_payload(payload);
|
||||
}
|
||||
|
||||
let mut ethernet = MutableEthernetPacket::new(&mut eth_buf).unwrap();
|
||||
ethernet.set_destination(dst_mac);
|
||||
ethernet.set_source(src_mac);
|
||||
ethernet.set_ethertype(EtherTypes::Ipv4);
|
||||
|
||||
match (local_addr, remote_addr) {
|
||||
(SocketAddr::V4(local), SocketAddr::V4(remote)) => {
|
||||
let mut v4 = ipv4::MutableIpv4Packet::new(&mut ip_buf).unwrap();
|
||||
v4.set_version(4);
|
||||
v4.set_header_length(IPV4_HEADER_LEN as u8 / 4);
|
||||
v4.set_next_level_protocol(ip::IpNextHeaderProtocols::Tcp);
|
||||
v4.set_ttl(64);
|
||||
v4.set_source(*local.ip());
|
||||
v4.set_destination(*remote.ip());
|
||||
v4.set_total_length(total_len.try_into().unwrap());
|
||||
v4.set_flags(ipv4::Ipv4Flags::DontFragment);
|
||||
|
||||
tcp.set_checksum(tcp::ipv4_checksum(
|
||||
&tcp.to_immutable(),
|
||||
&v4.get_source(),
|
||||
&v4.get_destination(),
|
||||
));
|
||||
|
||||
v4.set_checksum(ipv4::checksum(&v4.to_immutable()));
|
||||
}
|
||||
(SocketAddr::V6(local), SocketAddr::V6(remote)) => {
|
||||
let mut v6 = ipv6::MutableIpv6Packet::new(&mut ip_buf).unwrap();
|
||||
v6.set_version(6);
|
||||
v6.set_payload_length(tcp_total_len.try_into().unwrap());
|
||||
v6.set_next_header(ip::IpNextHeaderProtocols::Tcp);
|
||||
v6.set_hop_limit(64);
|
||||
v6.set_source(*local.ip());
|
||||
v6.set_destination(*remote.ip());
|
||||
|
||||
tcp.set_checksum(tcp::ipv6_checksum(
|
||||
&tcp.to_immutable(),
|
||||
&v6.get_source(),
|
||||
&v6.get_destination(),
|
||||
));
|
||||
}
|
||||
_ => unreachable!(),
|
||||
};
|
||||
|
||||
ip_buf.unsplit(tcp_buf);
|
||||
eth_buf.unsplit(ip_buf);
|
||||
eth_buf.freeze()
|
||||
}
|
||||
|
||||
#[tracing::instrument(ret)]
|
||||
pub fn parse_ip_packet(
|
||||
buf: &Bytes,
|
||||
) -> Option<(MacAddr, MacAddr, IPPacket<'_>, tcp::TcpPacket<'_>)> {
|
||||
let eth = EthernetPacket::new(buf).unwrap();
|
||||
let src_mac = eth.get_source();
|
||||
let dst_mac = eth.get_destination();
|
||||
|
||||
tracing::trace!("Parsing IP packet: {:?}", eth);
|
||||
|
||||
let buf = &buf[ETH_HDR_LEN..];
|
||||
if buf[0] >> 4 == 4 {
|
||||
let v4 = ipv4::Ipv4Packet::new(buf).unwrap();
|
||||
if v4.get_next_level_protocol() != ip::IpNextHeaderProtocols::Tcp {
|
||||
return None;
|
||||
}
|
||||
|
||||
let tcp = tcp::TcpPacket::new(&buf[IPV4_HEADER_LEN..]).unwrap();
|
||||
Some((src_mac, dst_mac, IPPacket::V4(v4), tcp))
|
||||
} else if buf[0] >> 4 == 6 {
|
||||
let v6 = ipv6::Ipv6Packet::new(buf).unwrap();
|
||||
if v6.get_next_header() != ip::IpNextHeaderProtocols::Tcp {
|
||||
return None;
|
||||
}
|
||||
|
||||
let tcp = tcp::TcpPacket::new(&buf[IPV6_HEADER_LEN..]).unwrap();
|
||||
Some((src_mac, dst_mac, IPPacket::V6(v6), tcp))
|
||||
} else {
|
||||
tracing::trace!("Invalid IP version: {}", buf[0] >> 4);
|
||||
None
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user