Compare commits
4 Commits
f070bc713b
...
4a6ac4a8b9
| Author | SHA1 | Date | |
|---|---|---|---|
| 4a6ac4a8b9 | |||
| 33ff338fd2 | |||
| 8493f80bdd | |||
| ebf0ea3a04 |
2
.vscode/settings.json
vendored
2
.vscode/settings.json
vendored
@ -1,5 +1,5 @@
|
|||||||
{
|
{
|
||||||
// "rust-analyzer.cargo.target": "x86_64-pc-windows-gnu",
|
// "rust-analyzer.cargo.target": "x86_64-pc-windows-gnu",
|
||||||
// "rust-analyzer.cargo.target": "x86_64-unknown-linux-gnu",
|
"rust-analyzer.cargo.target": "x86_64-unknown-linux-gnu",
|
||||||
// "rust-analyzer.cargo.features": ["tun"]
|
// "rust-analyzer.cargo.features": ["tun"]
|
||||||
}
|
}
|
||||||
@ -551,16 +551,17 @@ impl ArpWaitList {
|
|||||||
if (now - item.timestamp) > 5 {
|
if (now - item.timestamp) > 5 {
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
let mut packet = form_ethernet_packet(src_mac, mac, item.origin_data);
|
let packet = form_ethernet_packet(src_mac, mac, item.origin_data);
|
||||||
|
|
||||||
let pkt_size = packet.len();
|
let pkt_size = packet.len();
|
||||||
|
|
||||||
let encryptor = edge.encryptor.load();
|
let Ok(encrypted) = edge.encryptor.load().encrypt(&packet) else {
|
||||||
if let Err(e) = encryptor.encrypt(&mut packet) {
|
// let Ok(encrypted) = edge.encryptor.read().unwrap().encrypt(&packet) else {
|
||||||
error!("failed to encrypt packet request: {:?}", e);
|
// let Ok(encrypted) = aes_encrypt(&encrypt_key, &packet) else {
|
||||||
|
error!("failed to encrypt packet request");
|
||||||
return;
|
return;
|
||||||
}
|
};
|
||||||
let data_bytes = packet.freeze();
|
let data_bytes = Bytes::from(encrypted);
|
||||||
let data = SdlData {
|
let data = SdlData {
|
||||||
is_p2p: true,
|
is_p2p: true,
|
||||||
network_id,
|
network_id,
|
||||||
|
|||||||
@ -304,10 +304,8 @@ async fn get_data_from_tun_with_layer2_zeroed(eee: &Node) -> BytesMut {
|
|||||||
// let mut temp = BytesMut::with_capacity(1514);
|
// let mut temp = BytesMut::with_capacity(1514);
|
||||||
let mut data_buf = temp.split_off(14);
|
let mut data_buf = temp.split_off(14);
|
||||||
let Ok(size) = eee.device.recv(&mut data_buf).await else {
|
let Ok(size) = eee.device.recv(&mut data_buf).await else {
|
||||||
error!("failed to receive");
|
|
||||||
return BytesMut::new();
|
return BytesMut::new();
|
||||||
};
|
};
|
||||||
warn!("got {} bytes from tun with layer 2", size);
|
|
||||||
|
|
||||||
data_buf.truncate(size);
|
data_buf.truncate(size);
|
||||||
temp.unsplit(data_buf);
|
temp.unsplit(data_buf);
|
||||||
@ -336,7 +334,6 @@ async fn get_tun_flow(eee: &'static Node, tx: Sender<BytesMut>) {
|
|||||||
};
|
};
|
||||||
|
|
||||||
if buf.len() == 0 {
|
if buf.len() == 0 {
|
||||||
error!("buf length is zero, quitting loop");
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
if let Err(e) = tx.send(buf).await {
|
if let Err(e) = tx.send(buf).await {
|
||||||
|
|||||||
@ -1,8 +1,8 @@
|
|||||||
use std::{net::SocketAddr, sync::atomic::Ordering, time::Duration};
|
use std::{net::SocketAddr, sync::atomic::Ordering, time::Duration};
|
||||||
|
|
||||||
use crate::pb::SdlPolicyRequest;
|
|
||||||
use crate::tcp::{get_quic_write_conn, NatType};
|
|
||||||
use crate::FiveTuple;
|
use crate::FiveTuple;
|
||||||
|
use crate::pb::SdlPolicyRequest;
|
||||||
|
use crate::tcp::{NatType, get_quic_write_conn};
|
||||||
use crate::{network::TunTapPacketHandler, utils::mac_to_string};
|
use crate::{network::TunTapPacketHandler, utils::mac_to_string};
|
||||||
|
|
||||||
use crate::{
|
use crate::{
|
||||||
@ -11,19 +11,19 @@ use crate::{
|
|||||||
encode_to_tcp_message, encode_to_udp_message, SdlData, SdlEmpty, SdlPeerInfo, SdlQueryInfo,
|
encode_to_tcp_message, encode_to_udp_message, SdlData, SdlEmpty, SdlPeerInfo, SdlQueryInfo,
|
||||||
SdlRegister, SdlRegisterAck, SdlStunProbeReply,
|
SdlRegister, SdlRegisterAck, SdlStunProbeReply,
|
||||||
},
|
},
|
||||||
tcp::PacketType,
|
tcp::{PacketType},
|
||||||
utils::{send_to_sock, Socket},
|
utils::{send_to_sock, Socket},
|
||||||
};
|
};
|
||||||
use bytes::BytesMut;
|
use bytes::BytesMut;
|
||||||
use etherparse::{ip_number, Ethernet2Header, IpNumber, PacketHeaders};
|
use etherparse::{Ethernet2Header, IpNumber, PacketHeaders, ip_number};
|
||||||
use prost::Message;
|
use prost::Message;
|
||||||
use sdlan_sn_rs::utils::BROADCAST_MAC;
|
use sdlan_sn_rs::utils::{BROADCAST_MAC};
|
||||||
use sdlan_sn_rs::{
|
use sdlan_sn_rs::{
|
||||||
config::{AF_INET, AF_INET6},
|
config::{AF_INET, AF_INET6},
|
||||||
peer::{is_sdlan_sock_equal, SdlanSock, V6Info},
|
peer::{is_sdlan_sock_equal, SdlanSock, V6Info},
|
||||||
utils::{
|
utils::{
|
||||||
get_current_timestamp, get_sdlan_sock_from_socketaddr, is_multi_broadcast, Mac, Result,
|
get_current_timestamp, get_sdlan_sock_from_socketaddr, is_multi_broadcast,
|
||||||
SDLanError,
|
Mac, Result, SDLanError,
|
||||||
},
|
},
|
||||||
};
|
};
|
||||||
|
|
||||||
@ -550,7 +550,7 @@ pub async fn check_peer_registration_needed(
|
|||||||
_v6_info: &Option<V6Info>,
|
_v6_info: &Option<V6Info>,
|
||||||
peer_sock: &SdlanSock,
|
peer_sock: &SdlanSock,
|
||||||
) {
|
) {
|
||||||
let p = eee.known_peers.peers.get(&src_mac);
|
let mut p = eee.known_peers.peers.get_mut(&src_mac);
|
||||||
let last_seen;
|
let last_seen;
|
||||||
let now;
|
let now;
|
||||||
match p {
|
match p {
|
||||||
@ -561,7 +561,7 @@ pub async fn check_peer_registration_needed(
|
|||||||
return;
|
return;
|
||||||
// unimplemented!();
|
// unimplemented!();
|
||||||
}
|
}
|
||||||
Some(k) => {
|
Some(ref mut k) => {
|
||||||
// let mut ipv4_to_ipv6 = false;
|
// let mut ipv4_to_ipv6 = false;
|
||||||
now = get_current_timestamp();
|
now = get_current_timestamp();
|
||||||
if !from_sn {
|
if !from_sn {
|
||||||
@ -570,13 +570,9 @@ pub async fn check_peer_registration_needed(
|
|||||||
let origin_family = k.sock.family;
|
let origin_family = k.sock.family;
|
||||||
if origin_family != peer_sock.family {
|
if origin_family != peer_sock.family {
|
||||||
if peer_sock.family == AF_INET6 && origin_family == AF_INET {
|
if peer_sock.family == AF_INET6 && origin_family == AF_INET {
|
||||||
info!(
|
info!("Upgrading peer {} from IPv4 to IPv6 P2P", mac_to_string(&src_mac));
|
||||||
"Upgrading peer {} from IPv4 to IPv6 P2P",
|
k.sock = peer_sock.deepcopy();
|
||||||
mac_to_string(&src_mac)
|
k.last_seen.store(now, Ordering::Relaxed);
|
||||||
);
|
|
||||||
|
|
||||||
// k.sock = peer_sock.deepcopy();
|
|
||||||
// k.last_seen.store(now, Ordering::Relaxed);
|
|
||||||
} else {
|
} else {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@ -843,8 +839,11 @@ async fn renew_identity_request(eee: &Node, identity: u32) {
|
|||||||
// println!("policy request: {:?}", policy_request);
|
// println!("policy request: {:?}", policy_request);
|
||||||
// debug!("send register super: {:?}", register_super);
|
// debug!("send register super: {:?}", register_super);
|
||||||
// let packet_id = edge.get_next_packet_id();
|
// let packet_id = edge.get_next_packet_id();
|
||||||
let data =
|
let data = encode_to_tcp_message(
|
||||||
encode_to_tcp_message(Some(policy_request), PacketType::PolicyRequest as u8).unwrap();
|
Some(policy_request),
|
||||||
|
PacketType::PolicyRequest as u8,
|
||||||
|
)
|
||||||
|
.unwrap();
|
||||||
|
|
||||||
let stream = get_quic_write_conn();
|
let stream = get_quic_write_conn();
|
||||||
if let Err(e) = stream.send(data).await {
|
if let Err(e) = stream.send(data).await {
|
||||||
@ -862,34 +861,31 @@ async fn handle_tun_packet(
|
|||||||
//let key = eee.get_encrypt_key();
|
//let key = eee.get_encrypt_key();
|
||||||
|
|
||||||
// if key.len() == 0 {
|
// if key.len() == 0 {
|
||||||
// check the encrypt key
|
// check the encrypt key
|
||||||
// error!("packet encrypt key not provided");
|
// error!("packet encrypt key not provided");
|
||||||
// return;
|
// return;
|
||||||
// }
|
// }
|
||||||
|
|
||||||
// test_aes(key.as_slice());
|
// test_aes(key.as_slice());
|
||||||
|
|
||||||
let mut payload = BytesMut::from(payload);
|
let origin = eee.encryptor.load().decrypt(&payload);
|
||||||
let decrypt_res = eee.encryptor.load().decrypt(&mut payload);
|
// let origin = eee.encryptor.read().unwrap().decrypt(&payload);
|
||||||
if let Err(_e) = decrypt_res {
|
// let origin = aes_decrypt(&payload);
|
||||||
|
if let Err(_e) = origin {
|
||||||
error!("failed to decrypt original data");
|
error!("failed to decrypt original data");
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
let data = payload;
|
let data = origin.unwrap();
|
||||||
let Ok(headers) = PacketHeaders::from_ethernet_slice(&data) else {
|
let Ok(headers) = PacketHeaders::from_ethernet_slice(&data) else {
|
||||||
error!("failed to parse packet");
|
error!("failed to parse packet");
|
||||||
return;
|
return;
|
||||||
};
|
};
|
||||||
|
|
||||||
if _from_sn {
|
if _from_sn {
|
||||||
eee.stats
|
eee.stats.rx_sup.fetch_add(data.len() as u64, Ordering::Relaxed);
|
||||||
.rx_sup
|
|
||||||
.fetch_add(data.len() as u64, Ordering::Relaxed);
|
|
||||||
} else {
|
} else {
|
||||||
eee.stats
|
eee.stats.rx_p2p.fetch_add(data.len() as u64, Ordering::Relaxed);
|
||||||
.rx_p2p
|
|
||||||
.fetch_add(data.len() as u64, Ordering::Relaxed);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if let Some(ip) = headers.net {
|
if let Some(ip) = headers.net {
|
||||||
@ -898,6 +894,7 @@ async fn handle_tun_packet(
|
|||||||
let protocol = ipv4.protocol;
|
let protocol = ipv4.protocol;
|
||||||
match protocol {
|
match protocol {
|
||||||
ip_number::TCP => {
|
ip_number::TCP => {
|
||||||
|
|
||||||
let Some(transport) = headers.transport else {
|
let Some(transport) = headers.transport else {
|
||||||
error!("failed to get transport header");
|
error!("failed to get transport header");
|
||||||
return;
|
return;
|
||||||
@ -913,13 +910,9 @@ async fn handle_tun_packet(
|
|||||||
dst_ip: ipv4.source.into(),
|
dst_ip: ipv4.source.into(),
|
||||||
src_port: tcp_header.destination_port,
|
src_port: tcp_header.destination_port,
|
||||||
dst_port: tcp_header.source_port,
|
dst_port: tcp_header.source_port,
|
||||||
proto: IpNumber::TCP.0,
|
proto:IpNumber::TCP.0,
|
||||||
};
|
};
|
||||||
let (valid, need_refresh) = eee.rule_cache.is_identity_ok(
|
let (valid, need_refresh) = eee.rule_cache.is_identity_ok(eee.config.allow_routing.load(Ordering::Relaxed), pkt.identity_id, five_tuple);
|
||||||
eee.config.allow_routing.load(Ordering::Relaxed),
|
|
||||||
pkt.identity_id,
|
|
||||||
five_tuple,
|
|
||||||
);
|
|
||||||
if need_refresh {
|
if need_refresh {
|
||||||
renew_identity_request(eee, pkt.identity_id).await;
|
renew_identity_request(eee, pkt.identity_id).await;
|
||||||
}
|
}
|
||||||
@ -943,13 +936,9 @@ async fn handle_tun_packet(
|
|||||||
dst_ip: ipv4.source.into(),
|
dst_ip: ipv4.source.into(),
|
||||||
src_port: udp_header.destination_port,
|
src_port: udp_header.destination_port,
|
||||||
dst_port: udp_header.source_port,
|
dst_port: udp_header.source_port,
|
||||||
proto: IpNumber::UDP.0,
|
proto:IpNumber::UDP.0,
|
||||||
};
|
};
|
||||||
let (valid, need_refresh) = eee.rule_cache.is_identity_ok(
|
let (valid, need_refresh) = eee.rule_cache.is_identity_ok(eee.config.allow_routing.load(Ordering::Relaxed), pkt.identity_id, five_tuple);
|
||||||
eee.config.allow_routing.load(Ordering::Relaxed),
|
|
||||||
pkt.identity_id,
|
|
||||||
five_tuple,
|
|
||||||
);
|
|
||||||
if need_refresh {
|
if need_refresh {
|
||||||
renew_identity_request(eee, pkt.identity_id).await;
|
renew_identity_request(eee, pkt.identity_id).await;
|
||||||
}
|
}
|
||||||
@ -966,10 +955,17 @@ async fn handle_tun_packet(
|
|||||||
// just ignore, ok
|
// just ignore, ok
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
debug!("sending packet to tun, {} bytes", data.len());
|
debug!("sending packet to tun, {} bytes", data.len());
|
||||||
if let Err(e) = eee.device.handle_packet_from_net(&data).await {
|
if let Err(e) = eee
|
||||||
|
.device
|
||||||
|
.handle_packet_from_net(&data)
|
||||||
|
.await
|
||||||
|
{
|
||||||
error!("failed to handle packet from net: {}", e.to_string());
|
error!("failed to handle packet from net: {}", e.to_string());
|
||||||
}
|
}
|
||||||
/*
|
/*
|
||||||
@ -1322,11 +1318,7 @@ pub async fn update_supernode_reg(eee: &Node) {
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#[allow(unused)]
|
#[allow(unused)]
|
||||||
pub fn form_ethernet_packet(
|
pub fn form_ethernet_packet(src_mac: Mac, dst_mac: Mac, mut data_with_zeroed_layer2: BytesMut) -> BytesMut {
|
||||||
src_mac: Mac,
|
|
||||||
dst_mac: Mac,
|
|
||||||
mut data_with_zeroed_layer2: BytesMut,
|
|
||||||
) -> BytesMut {
|
|
||||||
let mut etherheader = Ethernet2Header::default();
|
let mut etherheader = Ethernet2Header::default();
|
||||||
etherheader.destination = dst_mac;
|
etherheader.destination = dst_mac;
|
||||||
etherheader.ether_type = etherparse::EtherType::IPV4;
|
etherheader.ether_type = etherparse::EtherType::IPV4;
|
||||||
|
|||||||
@ -328,16 +328,17 @@ impl TunTapPacketHandler for Iface {
|
|||||||
return Ok(());
|
return Ok(());
|
||||||
}
|
}
|
||||||
|
|
||||||
let mut data = data;
|
|
||||||
let size = data.len();
|
let size = data.len();
|
||||||
|
|
||||||
let encryptor = edge.encryptor.load();
|
let encrypted = match edge.encryptor.load().encrypt(&data) {
|
||||||
if let Err(e) = encryptor.encrypt(&mut data) {
|
Ok(data) => data,
|
||||||
error!("failed to encrypt packet request: {:?}", e);
|
Err(e) => {
|
||||||
return Ok(());
|
error!("failed to encrypt packet request: {}", e.as_str());
|
||||||
}
|
return Ok(());
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
let data_bytes = data.freeze();
|
let data_bytes = Bytes::from(encrypted);
|
||||||
let data = SdlData {
|
let data = SdlData {
|
||||||
is_p2p: true,
|
is_p2p: true,
|
||||||
network_id: edge.network_id.load(Ordering::Relaxed),
|
network_id: edge.network_id.load(Ordering::Relaxed),
|
||||||
@ -443,14 +444,14 @@ impl TunTapPacketHandler for Iface {
|
|||||||
arp.sipaddr =
|
arp.sipaddr =
|
||||||
[((self_ip >> 16) & 0xffff) as u16, (self_ip & 0xffff) as u16];
|
[((self_ip >> 16) & 0xffff) as u16, (self_ip & 0xffff) as u16];
|
||||||
|
|
||||||
let mut data_buf = BytesMut::from(arp.marshal_to_bytes().as_slice());
|
let data = arp.marshal_to_bytes();
|
||||||
let encryptor = edge.encryptor.load();
|
// let Ok(encrypted) = aes_encrypt(key, &data) else {
|
||||||
if let Err(e) = encryptor.encrypt(&mut data_buf) {
|
let Ok(encrypted) = edge.encryptor.load().encrypt(&data) else {
|
||||||
error!("failed to encrypt arp reply: {:?}", e);
|
error!("failed to encrypt arp reply");
|
||||||
return Ok(());
|
return Ok(());
|
||||||
}
|
};
|
||||||
|
|
||||||
let data_bytes = data_buf.freeze();
|
let data_bytes = Bytes::from(encrypted);
|
||||||
|
|
||||||
let data = SdlData {
|
let data = SdlData {
|
||||||
is_p2p: true,
|
is_p2p: true,
|
||||||
@ -606,72 +607,71 @@ impl TunTapPacketHandler for Iface {
|
|||||||
}
|
}
|
||||||
_other => {}
|
_other => {}
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
match eee.arp_table.get(dstip) {
|
match eee.arp_table.get(dstip) {
|
||||||
Some(mac) => {
|
Some(mac) => {
|
||||||
let pkt_size = data.len() + 14;
|
let pkt_size = data.len() + 14;
|
||||||
let mut etherheader = Ethernet2Header::default();
|
let mut etherheader = Ethernet2Header::default();
|
||||||
etherheader.destination = mac;
|
etherheader.destination = mac;
|
||||||
etherheader.ether_type = etherparse::EtherType::IPV4;
|
etherheader.ether_type = etherparse::EtherType::IPV4;
|
||||||
etherheader.source = src_mac;
|
etherheader.source = src_mac;
|
||||||
// let mut packet = Vec::with_capacity(14 + data.len() + 4);
|
// let mut packet = Vec::with_capacity(14 + data.len() + 4);
|
||||||
|
|
||||||
header.copy_from_slice(ðerheader.to_bytes()[..]);
|
header.copy_from_slice(ðerheader.to_bytes()[..]);
|
||||||
|
|
||||||
let crc = caculate_crc(&data);
|
let crc = caculate_crc(&data);
|
||||||
header.unsplit(data);
|
header.unsplit(data);
|
||||||
|
|
||||||
// packet.extend_from_slice(ðerheader.to_bytes()[..]);
|
// packet.extend_from_slice(ðerheader.to_bytes()[..]);
|
||||||
// packet.extend_from_slice(&data);
|
// packet.extend_from_slice(&data);
|
||||||
header.extend_from_slice(&crc.to_be_bytes());
|
header.extend_from_slice(&crc.to_be_bytes());
|
||||||
// packet.extend_from_slice(&crc.to_be_bytes());
|
// packet.extend_from_slice(&crc.to_be_bytes());
|
||||||
|
|
||||||
// let pkt_size = packet.len();
|
// let pkt_size = packet.len();
|
||||||
// println!("sending data with mac");
|
// println!("sending data with mac");
|
||||||
|
|
||||||
let encryptor = eee.encryptor.load();
|
// let Ok(encrypted) = aes_encrypt(&encrypt_key, &packet) else {
|
||||||
if let Err(e) = encryptor.encrypt(&mut header) {
|
let Ok(encrypted) = eee.encryptor.load().encrypt(&header) else {
|
||||||
error!("failed to encrypt packet request: {:?}", e);
|
error!("failed to encrypt packet request");
|
||||||
return Ok(());
|
return Ok(());
|
||||||
|
};
|
||||||
|
|
||||||
|
let data = SdlData {
|
||||||
|
is_p2p: true,
|
||||||
|
network_id: eee.network_id.load(Ordering::Relaxed),
|
||||||
|
ttl: SDLAN_DEFAULT_TTL as u32,
|
||||||
|
src_mac: Vec::from(src_mac),
|
||||||
|
dst_mac: Vec::from(mac),
|
||||||
|
data: Bytes::from(encrypted),
|
||||||
|
session_token: eee.session_token.get(),
|
||||||
|
identity_id: eee.identity_id.load(),
|
||||||
|
};
|
||||||
|
let msg =
|
||||||
|
encode_to_udp_message(Some(data), PacketType::Data as u8).unwrap();
|
||||||
|
let size = msg.len();
|
||||||
|
send_packet_to_net(eee, mac, &msg, pkt_size as u64).await;
|
||||||
}
|
}
|
||||||
let data_bytes = header.freeze();
|
None => {
|
||||||
|
header.unsplit(data);
|
||||||
|
eee.arp_table.add_to_arp_wait_list(dstip, header);
|
||||||
|
debug!(
|
||||||
|
"find ip: {:?} => {:?}",
|
||||||
|
src.to_be_bytes(),
|
||||||
|
dstip.to_be_bytes()
|
||||||
|
);
|
||||||
|
debug!(
|
||||||
|
"no mac found for ip {:?}, sending arp request",
|
||||||
|
dstip.to_be_bytes()
|
||||||
|
);
|
||||||
|
// let _ = eee.send_arp_request(dstip, dstip).await;
|
||||||
|
|
||||||
let data = SdlData {
|
if eee.device_config.contains(&Ipv4Addr::from_bits(dstip)) {
|
||||||
is_p2p: true,
|
let _ = eee.send_arp_request(dstip, dstip).await;
|
||||||
network_id: eee.network_id.load(Ordering::Relaxed),
|
} else {
|
||||||
ttl: SDLAN_DEFAULT_TTL as u32,
|
if let Some((_, real_ip)) = eee.route_table.lookup(dstip) {
|
||||||
src_mac: Vec::from(src_mac),
|
let real_ip = u32::from_be_bytes(real_ip.octets());
|
||||||
dst_mac: Vec::from(mac),
|
let _ = eee.send_arp_request(dstip, real_ip).await;
|
||||||
data: data_bytes,
|
}
|
||||||
session_token: eee.session_token.get(),
|
|
||||||
identity_id: eee.identity_id.load(),
|
|
||||||
};
|
|
||||||
let msg =
|
|
||||||
encode_to_udp_message(Some(data), PacketType::Data as u8).unwrap();
|
|
||||||
let size = msg.len();
|
|
||||||
send_packet_to_net(eee, mac, &msg, pkt_size as u64).await;
|
|
||||||
}
|
|
||||||
None => {
|
|
||||||
header.unsplit(data);
|
|
||||||
eee.arp_table.add_to_arp_wait_list(dstip, header);
|
|
||||||
debug!(
|
|
||||||
"find ip: {:?} => {:?}",
|
|
||||||
src.to_be_bytes(),
|
|
||||||
dstip.to_be_bytes()
|
|
||||||
);
|
|
||||||
debug!(
|
|
||||||
"no mac found for ip {:?}, sending arp request",
|
|
||||||
dstip.to_be_bytes()
|
|
||||||
);
|
|
||||||
// let _ = eee.send_arp_request(dstip, dstip).await;
|
|
||||||
|
|
||||||
if eee.device_config.contains(&Ipv4Addr::from_bits(dstip)) {
|
|
||||||
let _ = eee.send_arp_request(dstip, dstip).await;
|
|
||||||
} else {
|
|
||||||
if let Some((_, real_ip)) = eee.route_table.lookup(dstip) {
|
|
||||||
let real_ip = u32::from_be_bytes(real_ip.octets());
|
|
||||||
let _ = eee.send_arp_request(dstip, real_ip).await;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
@ -10,11 +10,11 @@ use sdlan_sn_rs::utils::{
|
|||||||
use std::io::{Error, ErrorKind};
|
use std::io::{Error, ErrorKind};
|
||||||
use std::net::Ipv4Addr;
|
use std::net::Ipv4Addr;
|
||||||
use std::os::windows::process::CommandExt;
|
use std::os::windows::process::CommandExt;
|
||||||
use std::process::{Command, Stdio};
|
use std::process::Command;
|
||||||
use std::sync::atomic::Ordering;
|
use std::sync::atomic::Ordering;
|
||||||
use std::sync::Arc;
|
use std::sync::Arc;
|
||||||
use tracing::{debug, error, info};
|
use tracing::{debug, error, info};
|
||||||
use tun_rs::{AsyncDevice, SyncDevice};
|
use tun_rs::AsyncDevice;
|
||||||
use wintun;
|
use wintun;
|
||||||
|
|
||||||
use crate::network::{
|
use crate::network::{
|
||||||
@ -36,20 +36,16 @@ pub struct Iface {
|
|||||||
}
|
}
|
||||||
|
|
||||||
impl Iface {
|
impl Iface {
|
||||||
fn new(_path: &str, name: &str) -> Self {
|
fn new(path: &str, name: &str) -> Self {
|
||||||
println!("layer = {:?}", LAYER);
|
|
||||||
let dev = tun_rs::DeviceBuilder::new()
|
let dev = tun_rs::DeviceBuilder::new()
|
||||||
// .wintun_file(path.to_string())
|
.wintun_file(path.to_string())
|
||||||
.name(name)
|
.name(name)
|
||||||
// .ipv4(Ipv4Addr::new(10, 10, 4, 39), Ipv4Addr::new(255, 255, 255, 0), None)
|
.layer(LAYER)
|
||||||
.layer(tun_rs::Layer::L3)
|
|
||||||
.mtu(1280)
|
.mtu(1280)
|
||||||
// .enable(true)
|
|
||||||
.build_async()
|
.build_async()
|
||||||
.expect("failed to create tun");
|
.expect("failed to create tun");
|
||||||
|
|
||||||
let idx = dev.if_index().expect("failed to get if index");
|
let idx = dev.if_index().expect("failed to get if index");
|
||||||
println!("index = {}", idx);
|
|
||||||
Self {
|
Self {
|
||||||
device: dev,
|
device: dev,
|
||||||
if_idx: idx,
|
if_idx: idx,
|
||||||
@ -355,14 +351,14 @@ impl TunTapPacketHandler for Iface {
|
|||||||
arp.sipaddr =
|
arp.sipaddr =
|
||||||
[((self_ip >> 16) & 0xffff) as u16, (self_ip & 0xffff) as u16];
|
[((self_ip >> 16) & 0xffff) as u16, (self_ip & 0xffff) as u16];
|
||||||
|
|
||||||
let mut data_buf = BytesMut::from(arp.marshal_to_bytes().as_slice());
|
let data = arp.marshal_to_bytes();
|
||||||
let encryptor = edge.encryptor.load();
|
// let Ok(encrypted) = aes_encrypt(key, &data) else {
|
||||||
if let Err(e) = encryptor.encrypt(&mut data_buf) {
|
let Ok(encrypted) = edge.encryptor.load().encrypt(&data) else {
|
||||||
error!("failed to encrypt arp reply: {:?}", e);
|
error!("failed to encrypt arp reply");
|
||||||
return Ok(());
|
return Ok(());
|
||||||
}
|
};
|
||||||
|
|
||||||
let data_bytes = data_buf.freeze();
|
let data_bytes = Bytes::from(encrypted);
|
||||||
|
|
||||||
let data = SdlData {
|
let data = SdlData {
|
||||||
is_p2p: true,
|
is_p2p: true,
|
||||||
@ -455,7 +451,140 @@ impl TunTapPacketHandler for Iface {
|
|||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// async fn handle_packet_from_device(
|
||||||
|
// &self,
|
||||||
|
// data: BytesMut,
|
||||||
|
// // encrypt_key: &[u8],
|
||||||
|
// ) -> std::io::Result<()> {
|
||||||
|
// let eee = get_edge();
|
||||||
|
|
||||||
|
// let src_mac = eee.device_config.get_mac();
|
||||||
|
|
||||||
|
// match IpHeaders::from_slice(&data) {
|
||||||
|
// Ok((iphdr, _payload)) => {
|
||||||
|
// let Some(ipv4hdr) = iphdr.ipv4() else {
|
||||||
|
// debug!("ipv6 packet ignored");
|
||||||
|
// return Ok(());
|
||||||
|
// };
|
||||||
|
// let dstip = u32::from_be_bytes(ipv4hdr.0.destination);
|
||||||
|
// debug!("packet dst ip: {:?}", ipv4hdr.0.destination);
|
||||||
|
// let src = u32::from_be_bytes(ipv4hdr.0.source);
|
||||||
|
// debug!("packet src ip: {:?}", ipv4hdr.0.source);
|
||||||
|
// // packet should be sent to dev
|
||||||
|
// debug!("got {} bytes from tun", data.len());
|
||||||
|
// if (!eee.config.allow_routing.load(Ordering::Relaxed)) && (src != eee.device_config.get_ip()) {
|
||||||
|
// info!("dropping routed packet");
|
||||||
|
// return Ok(());
|
||||||
|
// }
|
||||||
|
// if !eee.is_authorized() {
|
||||||
|
// debug!("drop tun packet due to not authed");
|
||||||
|
// return Ok(());
|
||||||
|
// }
|
||||||
|
// if dstip == DNS_IP {
|
||||||
|
// // println!("request for dns");
|
||||||
|
// let addr = format!("{}:15353", eee.server_ip);
|
||||||
|
// // println!("send dns to {}", addr);
|
||||||
|
// if let Err(e) = eee.udp_sock_for_dns.send_to(&data, &addr).await {
|
||||||
|
// error!("failed to send request to 15353: {}", e);
|
||||||
|
// }
|
||||||
|
// return Ok(());
|
||||||
|
// }
|
||||||
|
// match send_arp_request(ArpRequestInfo::Lookup { ip: dstip }).await {
|
||||||
|
// ArpResponse::LookupResp {
|
||||||
|
// mac,
|
||||||
|
// ip,
|
||||||
|
// do_arp_request,
|
||||||
|
// } => {
|
||||||
|
// if do_arp_request {
|
||||||
|
// add_to_arp_wait_list(dstip, data);
|
||||||
|
|
||||||
|
// info!(
|
||||||
|
// "find ip: {:?} => {:?}",
|
||||||
|
// src.to_be_bytes(),
|
||||||
|
// dstip.to_be_bytes()
|
||||||
|
// );
|
||||||
|
// let arp_msg =
|
||||||
|
// generate_arp_request(src_mac, ip, eee.device_config.get_ip());
|
||||||
|
|
||||||
|
// let Ok(encrypted) = eee.encryptor.load().encrypt(&arp_msg) else {
|
||||||
|
// // let Ok(encrypted) = aes_encrypt(&encrypt_key, &arp_msg) else {
|
||||||
|
// error!("failed to encrypt arp request");
|
||||||
|
// return Ok(());
|
||||||
|
// };
|
||||||
|
// // println!("arp_msg: {:?}", arp_msg);
|
||||||
|
// let data = SdlData {
|
||||||
|
// network_id: eee.network_id.load(Ordering::Relaxed),
|
||||||
|
// src_mac: Vec::from(src_mac),
|
||||||
|
// dst_mac: Vec::from([0xff; 6]),
|
||||||
|
// is_p2p: true,
|
||||||
|
// ttl: SDLAN_DEFAULT_TTL as u32,
|
||||||
|
// data: Bytes::from(encrypted),
|
||||||
|
|
||||||
|
// session_token: eee.session_token.get(),
|
||||||
|
// identity_id: eee.identity_id.load(),
|
||||||
|
// };
|
||||||
|
// let data =
|
||||||
|
// encode_to_udp_message(Some(data), PacketType::Data as u8).unwrap();
|
||||||
|
// debug!("sending arp");
|
||||||
|
// // let data = marshal_message(&data);
|
||||||
|
// send_packet_to_net(eee, BROADCAST_MAC, &data, arp_msg.len() as u64)
|
||||||
|
// .await;
|
||||||
|
// // edge.sock.send(data).await;
|
||||||
|
// // println!("should send arp");
|
||||||
|
// return Ok(());
|
||||||
|
// }
|
||||||
|
|
||||||
|
// let packet = form_ethernet_packet(src_mac, mac, &data);
|
||||||
|
// // prepend the ether header
|
||||||
|
// /*
|
||||||
|
// let mut etherheader = Ethernet2Header::default();
|
||||||
|
// etherheader.destination = mac;
|
||||||
|
// etherheader.ether_type = etherparse::EtherType::IPV4;
|
||||||
|
// etherheader.source = src_mac;
|
||||||
|
// let mut packet = Vec::with_capacity(14 + data.len() + 4);
|
||||||
|
// packet.extend_from_slice(ðerheader.to_bytes()[..]);
|
||||||
|
// packet.extend_from_slice(&data);
|
||||||
|
// */
|
||||||
|
// // let crc = CRC_HASH.checksum(&packet);
|
||||||
|
// // packet.extend_from_slice(&crc.to_be_bytes());
|
||||||
|
|
||||||
|
// let pkt_size = packet.len();
|
||||||
|
// // println!("sending data with mac");
|
||||||
|
|
||||||
|
// // let Ok(encrypted) = aes_encrypt(&encrypt_key, &packet) else {
|
||||||
|
// let Ok(encrypted) = eee.encryptor.load().encrypt(&packet) else {
|
||||||
|
// error!("failed to encrypt packet request");
|
||||||
|
// return Ok(());
|
||||||
|
// };
|
||||||
|
// let data = SdlData {
|
||||||
|
// is_p2p: true,
|
||||||
|
// network_id: eee.network_id.load(Ordering::Relaxed),
|
||||||
|
// ttl: SDLAN_DEFAULT_TTL as u32,
|
||||||
|
// src_mac: Vec::from(src_mac),
|
||||||
|
// dst_mac: Vec::from(mac),
|
||||||
|
// data: Bytes::from(encrypted),
|
||||||
|
// session_token: eee.session_token.get(),
|
||||||
|
// identity_id: eee.identity_id.load(),
|
||||||
|
// };
|
||||||
|
// let msg =
|
||||||
|
// encode_to_udp_message(Some(data), PacketType::Data as u8).unwrap();
|
||||||
|
// let size = msg.len();
|
||||||
|
// send_packet_to_net(eee, mac, &msg, pkt_size as u64).await;
|
||||||
|
// // let dstip = u32::from_be_bytes(ipv4hdr.0.destination);
|
||||||
|
// }
|
||||||
|
// _ => {}
|
||||||
|
// }
|
||||||
|
// }
|
||||||
|
// Err(e) => {
|
||||||
|
// error!("failed to parse ip packet: {}", e.to_string());
|
||||||
|
// }
|
||||||
|
// }
|
||||||
|
// Ok(())
|
||||||
|
// }
|
||||||
|
|
||||||
async fn handle_packet_from_device(&self, mut header: BytesMut) -> std::io::Result<()> {
|
async fn handle_packet_from_device(&self, mut header: BytesMut) -> std::io::Result<()> {
|
||||||
|
use etherparse::IpHeaders;
|
||||||
|
|
||||||
let eee = get_edge();
|
let eee = get_edge();
|
||||||
|
|
||||||
let src_mac = eee.device_config.get_mac();
|
let src_mac = eee.device_config.get_mac();
|
||||||
@ -516,79 +645,78 @@ impl TunTapPacketHandler for Iface {
|
|||||||
}
|
}
|
||||||
_other => {}
|
_other => {}
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
match eee.arp_table.get(dstip) {
|
match eee.arp_table.get(dstip) {
|
||||||
Some(mac) => {
|
Some(mac) => {
|
||||||
let pkt_size = data.len() + 14;
|
let pkt_size = data.len() + 14;
|
||||||
let mut etherheader = Ethernet2Header::default();
|
let mut etherheader = Ethernet2Header::default();
|
||||||
etherheader.destination = mac;
|
etherheader.destination = mac;
|
||||||
etherheader.ether_type = etherparse::EtherType::IPV4;
|
etherheader.ether_type = etherparse::EtherType::IPV4;
|
||||||
etherheader.source = src_mac;
|
etherheader.source = src_mac;
|
||||||
// let mut packet = Vec::with_capacity(14 + data.len() + 4);
|
// let mut packet = Vec::with_capacity(14 + data.len() + 4);
|
||||||
|
|
||||||
header.copy_from_slice(ðerheader.to_bytes()[..]);
|
header.copy_from_slice(ðerheader.to_bytes()[..]);
|
||||||
|
|
||||||
let crc = caculate_crc(&data);
|
let crc = caculate_crc(&data);
|
||||||
header.unsplit(data);
|
header.unsplit(data);
|
||||||
|
|
||||||
// packet.extend_from_slice(ðerheader.to_bytes()[..]);
|
// packet.extend_from_slice(ðerheader.to_bytes()[..]);
|
||||||
// packet.extend_from_slice(&data);
|
// packet.extend_from_slice(&data);
|
||||||
header.extend_from_slice(&crc.to_be_bytes());
|
header.extend_from_slice(&crc.to_be_bytes());
|
||||||
// packet.extend_from_slice(&crc.to_be_bytes());
|
// packet.extend_from_slice(&crc.to_be_bytes());
|
||||||
|
|
||||||
// let pkt_size = packet.len();
|
// let pkt_size = packet.len();
|
||||||
// println!("sending data with mac");
|
// println!("sending data with mac");
|
||||||
|
|
||||||
let encryptor = eee.encryptor.load();
|
// let Ok(encrypted) = aes_encrypt(&encrypt_key, &packet) else {
|
||||||
if let Err(e) = encryptor.encrypt(&mut header) {
|
let Ok(encrypted) = eee.encryptor.load().encrypt(&header) else {
|
||||||
error!("failed to encrypt packet request: {:?}", e);
|
error!("failed to encrypt packet request");
|
||||||
return Ok(());
|
return Ok(());
|
||||||
|
};
|
||||||
|
|
||||||
|
let data = SdlData {
|
||||||
|
is_p2p: true,
|
||||||
|
network_id: eee.network_id.load(Ordering::Relaxed),
|
||||||
|
ttl: SDLAN_DEFAULT_TTL as u32,
|
||||||
|
src_mac: Vec::from(src_mac),
|
||||||
|
dst_mac: Vec::from(mac),
|
||||||
|
data: Bytes::from(encrypted),
|
||||||
|
session_token: eee.session_token.get(),
|
||||||
|
identity_id: eee.identity_id.load(),
|
||||||
|
};
|
||||||
|
let msg =
|
||||||
|
encode_to_udp_message(Some(data), PacketType::Data as u8).unwrap();
|
||||||
|
let size = msg.len();
|
||||||
|
send_packet_to_net(eee, mac, &msg, pkt_size as u64).await;
|
||||||
}
|
}
|
||||||
let data_bytes = header.freeze();
|
None => {
|
||||||
|
header.unsplit(data);
|
||||||
|
debug!(
|
||||||
|
"find ip: {:?} => {:?}",
|
||||||
|
src.to_be_bytes(),
|
||||||
|
dstip.to_be_bytes()
|
||||||
|
);
|
||||||
|
debug!(
|
||||||
|
"no mac found for ip {:?}, sending arp request",
|
||||||
|
dstip.to_be_bytes()
|
||||||
|
);
|
||||||
|
// let _ = eee.send_arp_request(dstip, dstip).await;
|
||||||
|
|
||||||
let data = SdlData {
|
if eee.device_config.contains(&Ipv4Addr::from_bits(dstip)) {
|
||||||
is_p2p: true,
|
debug!("contains dst ip {}", ip_to_string(&dstip));
|
||||||
network_id: eee.network_id.load(Ordering::Relaxed),
|
eee.arp_table.add_to_arp_wait_list(dstip, header);
|
||||||
ttl: SDLAN_DEFAULT_TTL as u32,
|
let _ = eee.send_arp_request(dstip, dstip).await;
|
||||||
src_mac: Vec::from(src_mac),
|
} else {
|
||||||
dst_mac: Vec::from(mac),
|
debug!("try to lookup ip: {}", ip_to_string(&dstip));
|
||||||
data: data_bytes,
|
if let Some((_, real_ip)) = eee.route_table.lookup(dstip) {
|
||||||
session_token: eee.session_token.get(),
|
eee.arp_table.add_to_arp_wait_list(
|
||||||
identity_id: eee.identity_id.load(),
|
u32::from_be_bytes(real_ip.octets()),
|
||||||
};
|
header,
|
||||||
let msg =
|
);
|
||||||
encode_to_udp_message(Some(data), PacketType::Data as u8).unwrap();
|
error!("got target route: {}", real_ip);
|
||||||
let size = msg.len();
|
let real_ip = u32::from_be_bytes(real_ip.octets());
|
||||||
send_packet_to_net(eee, mac, &msg, pkt_size as u64).await;
|
let _ = eee.send_arp_request(real_ip, dstip).await;
|
||||||
}
|
}
|
||||||
None => {
|
|
||||||
header.unsplit(data);
|
|
||||||
debug!(
|
|
||||||
"find ip: {:?} => {:?}",
|
|
||||||
src.to_be_bytes(),
|
|
||||||
dstip.to_be_bytes()
|
|
||||||
);
|
|
||||||
debug!(
|
|
||||||
"no mac found for ip {:?}, sending arp request",
|
|
||||||
dstip.to_be_bytes()
|
|
||||||
);
|
|
||||||
// let _ = eee.send_arp_request(dstip, dstip).await;
|
|
||||||
|
|
||||||
if eee.device_config.contains(&Ipv4Addr::from_bits(dstip)) {
|
|
||||||
debug!("contains dst ip {}", ip_to_string(&dstip));
|
|
||||||
eee.arp_table.add_to_arp_wait_list(dstip, header);
|
|
||||||
let _ = eee.send_arp_request(dstip, dstip).await;
|
|
||||||
} else {
|
|
||||||
debug!("try to lookup ip: {}", ip_to_string(&dstip));
|
|
||||||
if let Some((_, real_ip)) = eee.route_table.lookup(dstip) {
|
|
||||||
eee.arp_table.add_to_arp_wait_list(
|
|
||||||
u32::from_be_bytes(real_ip.octets()),
|
|
||||||
header,
|
|
||||||
);
|
|
||||||
error!("got target route: {}", real_ip);
|
|
||||||
let real_ip = u32::from_be_bytes(real_ip.octets());
|
|
||||||
let _ = eee.send_arp_request(real_ip, dstip).await;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -759,8 +887,8 @@ fn create_wintun(path: &str, name: &str) -> std::io::Result<Iface> {
|
|||||||
*/
|
*/
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn new_iface(name: &str) -> std::io::Result<Iface> {
|
pub fn new_iface(name: &str, _mode: Mode) -> std::io::Result<Iface> {
|
||||||
create_wintun("wintun.dll", name)
|
create_wintun("./wintun.dll", name)
|
||||||
// Ok(Box::new(create_wintun("/path/to/file")))
|
// Ok(Box::new(create_wintun("/path/to/file")))
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@ -8,10 +8,10 @@ use sdlan_sn_rs::{
|
|||||||
utils::{get_current_timestamp, ip_to_string, Mac, Result},
|
utils::{get_current_timestamp, ip_to_string, Mac, Result},
|
||||||
};
|
};
|
||||||
|
|
||||||
#[cfg(any(feature = "tun", target_os = "windows"))]
|
#[cfg(feature = "tun")]
|
||||||
pub const LAYER: tun_rs::Layer = tun_rs::Layer::L3;
|
pub const LAYER: tun_rs::Layer = tun_rs::Layer::L3;
|
||||||
|
|
||||||
#[cfg(all(not(feature = "tun"), not(target_os = "windows")))]
|
#[cfg(not(feature = "tun"))]
|
||||||
pub const LAYER: tun_rs::Layer = tun_rs::Layer::L2;
|
pub const LAYER: tun_rs::Layer = tun_rs::Layer::L2;
|
||||||
|
|
||||||
use tracing::{debug, warn};
|
use tracing::{debug, warn};
|
||||||
@ -102,16 +102,17 @@ impl ArpWaitList {
|
|||||||
if (now - item.timestamp) > 5 {
|
if (now - item.timestamp) > 5 {
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
let mut packet = form_ethernet_packet(src_mac, mac, item.origin_data);
|
let packet = form_ethernet_packet(src_mac, mac, item.origin_data);
|
||||||
|
|
||||||
let pkt_size = packet.len();
|
let pkt_size = packet.len();
|
||||||
|
|
||||||
let encryptor = edge.encryptor.load();
|
let Ok(encrypted) = edge.encryptor.load().encrypt(&packet) else {
|
||||||
if let Err(e) = encryptor.encrypt(&mut packet) {
|
// let Ok(encrypted) = edge.encryptor.read().unwrap().encrypt(&packet) else {
|
||||||
error!("failed to encrypt packet request: {:?}", e);
|
// let Ok(encrypted) = aes_encrypt(&encrypt_key, &packet) else {
|
||||||
|
error!("failed to encrypt packet request");
|
||||||
return;
|
return;
|
||||||
}
|
};
|
||||||
let data_bytes = packet.freeze();
|
let data_bytes = Bytes::from(encrypted);
|
||||||
let data = SdlData {
|
let data = SdlData {
|
||||||
is_p2p: true,
|
is_p2p: true,
|
||||||
network_id,
|
network_id,
|
||||||
|
|||||||
@ -730,14 +730,12 @@ impl ReadWriteActor {
|
|||||||
match start_stop_chan.recv().await {
|
match start_stop_chan.recv().await {
|
||||||
Some(v) => {
|
Some(v) => {
|
||||||
if !v.is_start {
|
if !v.is_start {
|
||||||
error!("stop called1");
|
|
||||||
started = false;
|
started = false;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
_other => {
|
_other => {
|
||||||
// send chan is closed;
|
// send chan is closed;
|
||||||
error!("stop called2");
|
|
||||||
started = false;
|
started = false;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|||||||
@ -3,8 +3,7 @@ use std::{
|
|||||||
time::{SystemTime, UNIX_EPOCH},
|
time::{SystemTime, UNIX_EPOCH},
|
||||||
};
|
};
|
||||||
|
|
||||||
use bytes::BytesMut;
|
use chacha20poly1305::{aead::Aead, ChaCha20Poly1305, KeyInit};
|
||||||
use chacha20poly1305::{aead::AeadInPlace, ChaCha20Poly1305, KeyInit};
|
|
||||||
use sdlan_sn_rs::utils::{aes_decrypt, aes_encrypt, Result, SDLanError};
|
use sdlan_sn_rs::utils::{aes_decrypt, aes_encrypt, Result, SDLanError};
|
||||||
|
|
||||||
const COUNTER_MASK: u32 = (1 << 24) - 1;
|
const COUNTER_MASK: u32 = (1 << 24) - 1;
|
||||||
@ -12,8 +11,8 @@ const COUNTER_MASK: u32 = (1 << 24) - 1;
|
|||||||
pub trait Encryptor {
|
pub trait Encryptor {
|
||||||
fn is_setted(&self) -> bool;
|
fn is_setted(&self) -> bool;
|
||||||
fn set_key(&mut self, region_id: u32, key: Vec<u8>);
|
fn set_key(&mut self, region_id: u32, key: Vec<u8>);
|
||||||
fn encrypt(&self, data: &mut BytesMut) -> Result<()>;
|
fn encrypt(&self, data: &[u8]) -> Result<Vec<u8>>;
|
||||||
fn decrypt(&self, data: &mut BytesMut) -> Result<()>;
|
fn decrypt(&self, ciphered: &[u8]) -> Result<Vec<u8>>;
|
||||||
}
|
}
|
||||||
|
|
||||||
pub enum MyEncryptor {
|
pub enum MyEncryptor {
|
||||||
@ -47,19 +46,18 @@ impl MyEncryptor {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn encrypt(&self, data: &mut BytesMut) -> Result<()> {
|
pub fn encrypt(&self, data: &[u8]) -> Result<Vec<u8>> {
|
||||||
match self {
|
match self {
|
||||||
Self::Invalid => Err(SDLanError::EncryptError("invalid encryptor".to_owned())),
|
Self::Invalid => Err(SDLanError::EncryptError("invalid encryptor".to_owned())),
|
||||||
Self::Aes(aes) => aes.encrypt(data),
|
Self::Aes(aes) => aes.encrypt(data),
|
||||||
Self::ChaChao20(cha) => cha.encrypt(data),
|
Self::ChaChao20(cha) => cha.encrypt(data),
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
pub fn decrypt(&self, ciphered: &[u8]) -> Result<Vec<u8>> {
|
||||||
pub fn decrypt(&self, data: &mut BytesMut) -> Result<()> {
|
|
||||||
match self {
|
match self {
|
||||||
Self::Invalid => Err(SDLanError::EncryptError("invalid encryptor".to_owned())),
|
Self::Invalid => Err(SDLanError::EncryptError("invalid encryptor".to_owned())),
|
||||||
Self::Aes(aes) => aes.decrypt(data),
|
Self::Aes(aes) => aes.decrypt(ciphered),
|
||||||
Self::ChaChao20(cha) => cha.decrypt(data),
|
Self::ChaChao20(cha) => cha.decrypt(ciphered),
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -91,10 +89,8 @@ impl Encryptor for Chacha20Encryptor {
|
|||||||
self.region_id = region_id;
|
self.region_id = region_id;
|
||||||
}
|
}
|
||||||
|
|
||||||
fn encrypt(&self, data: &mut BytesMut) -> Result<()> {
|
fn encrypt(&self, data: &[u8]) -> Result<Vec<u8>> {
|
||||||
let plaintext_len = data.len();
|
// let cipher = chacha20poly1305::ChaCha20Poly1305::new(self.key.as_slice().into());
|
||||||
|
|
||||||
// Prepare nonce
|
|
||||||
let now = SystemTime::now()
|
let now = SystemTime::now()
|
||||||
.duration_since(UNIX_EPOCH)
|
.duration_since(UNIX_EPOCH)
|
||||||
.unwrap()
|
.unwrap()
|
||||||
@ -107,61 +103,36 @@ impl Encryptor for Chacha20Encryptor {
|
|||||||
})
|
})
|
||||||
.unwrap() as u64;
|
.unwrap() as u64;
|
||||||
|
|
||||||
let mut nonce_bytes = [0u8; 12];
|
let mut nonce = Vec::new();
|
||||||
let region_id_bytes = self.region_id.to_be_bytes();
|
let region_id = self.region_id.to_be_bytes();
|
||||||
nonce_bytes[0..4].copy_from_slice(®ion_id_bytes);
|
nonce.extend_from_slice(®ion_id);
|
||||||
let next_data = (now << 24) | next_counter;
|
let next_data = (now << 24) | next_counter;
|
||||||
nonce_bytes[4..12].copy_from_slice(&next_data.to_be_bytes());
|
nonce.extend_from_slice(&next_data.to_be_bytes());
|
||||||
let nonce = chacha20poly1305::Nonce::from_slice(&nonce_bytes);
|
|
||||||
|
|
||||||
// Make room for tag (16 bytes) at the end
|
match self.cipher.encrypt(nonce.as_slice().into(), data) {
|
||||||
data.resize(plaintext_len + 16, 0);
|
Ok(data) => {
|
||||||
let (payload, tag_space) = data.split_at_mut(plaintext_len);
|
nonce.extend_from_slice(&data);
|
||||||
|
Ok(nonce)
|
||||||
// Encrypt payload in place and get tag
|
}
|
||||||
let tag = self
|
Err(e) => Err(SDLanError::EncryptError(e.to_string())),
|
||||||
.cipher
|
}
|
||||||
.encrypt_in_place_detached(&nonce, &[], payload)
|
|
||||||
.map_err(|e| SDLanError::EncryptError(e.to_string()))?;
|
|
||||||
|
|
||||||
tag_space[..16].copy_from_slice(&tag);
|
|
||||||
|
|
||||||
// Prepend nonce (12 bytes)
|
|
||||||
let mut final_buf = BytesMut::with_capacity(12 + data.len());
|
|
||||||
final_buf.extend_from_slice(&nonce_bytes);
|
|
||||||
final_buf.unsplit(data.split_off(0));
|
|
||||||
*data = final_buf;
|
|
||||||
|
|
||||||
Ok(())
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn decrypt(&self, data: &mut BytesMut) -> Result<()> {
|
fn decrypt(&self, ciphered: &[u8]) -> Result<Vec<u8>> {
|
||||||
if data.len() < 28 {
|
if ciphered.len() < 12 {
|
||||||
return Err(SDLanError::EncryptError(
|
return Err(SDLanError::EncryptError(
|
||||||
"ciphered text size error".to_owned(),
|
"ciphered text size error".to_owned(),
|
||||||
));
|
));
|
||||||
}
|
}
|
||||||
|
// let cipher = chacha20poly1305::ChaCha20Poly1305::new(self.key.as_slice().into());
|
||||||
// Split off the 12-byte Nonce
|
let nonce = &ciphered[0..12];
|
||||||
let mut payload = data.split_off(12);
|
match self.cipher.decrypt(nonce.into(), &ciphered[12..]) {
|
||||||
let mut nonce_bytes = [0u8; 12];
|
Ok(data) => Ok(data),
|
||||||
nonce_bytes.copy_from_slice(&data[0..12]);
|
Err(e) => Err(SDLanError::EncryptError(format!(
|
||||||
let nonce = chacha20poly1305::Nonce::from_slice(&nonce_bytes);
|
"failed to decyrpt: {}",
|
||||||
|
e.to_string()
|
||||||
// Split off the 16-byte Tag
|
))),
|
||||||
let ciphertext_len = payload.len() - 16;
|
}
|
||||||
let (ciphertext, tag_space) = payload.split_at_mut(ciphertext_len);
|
|
||||||
let tag = chacha20poly1305::Tag::from_slice(&tag_space[..16]);
|
|
||||||
|
|
||||||
// Decrypt in place
|
|
||||||
self.cipher
|
|
||||||
.decrypt_in_place_detached(&nonce, &[], ciphertext, tag)
|
|
||||||
.map_err(|e| SDLanError::EncryptError(format!("failed to decrypt: {}", e.to_string())))?;
|
|
||||||
|
|
||||||
payload.truncate(ciphertext_len);
|
|
||||||
*data = payload;
|
|
||||||
|
|
||||||
Ok(())
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn is_setted(&self) -> bool {
|
fn is_setted(&self) -> bool {
|
||||||
@ -184,16 +155,12 @@ impl AesEncryptor {
|
|||||||
}
|
}
|
||||||
|
|
||||||
impl Encryptor for AesEncryptor {
|
impl Encryptor for AesEncryptor {
|
||||||
fn decrypt(&self, data: &mut BytesMut) -> Result<()> {
|
fn decrypt(&self, ciphered: &[u8]) -> Result<Vec<u8>> {
|
||||||
let res = aes_decrypt(&self.key, data)?;
|
aes_decrypt(&self.key, ciphered)
|
||||||
*data = BytesMut::from(res.as_slice());
|
|
||||||
Ok(())
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn encrypt(&self, data: &mut BytesMut) -> Result<()> {
|
fn encrypt(&self, data: &[u8]) -> Result<Vec<u8>> {
|
||||||
let res = aes_encrypt(&self.key, data)?;
|
aes_encrypt(&self.key, data)
|
||||||
*data = BytesMut::from(res.as_slice());
|
|
||||||
Ok(())
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn is_setted(&self) -> bool {
|
fn is_setted(&self) -> bool {
|
||||||
@ -205,18 +172,3 @@ impl Encryptor for AesEncryptor {
|
|||||||
self.is_setted = true;
|
self.is_setted = true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#[cfg(test)]
|
|
||||||
mod tests {
|
|
||||||
use super::*;
|
|
||||||
|
|
||||||
#[test]
|
|
||||||
fn test_chacha20_encrypt_decrypt() {
|
|
||||||
let key = vec![0u8; 32];
|
|
||||||
let encryptor = Chacha20Encryptor::new(key, 1);
|
|
||||||
let mut data = BytesMut::from(&b"hello world"[..]);
|
|
||||||
encryptor.encrypt(&mut data).unwrap();
|
|
||||||
encryptor.decrypt(&mut data).unwrap();
|
|
||||||
assert_eq!(&data[..], b"hello world");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user