use bytes::{Bytes, BytesMut};
use socks5_proto::{Address, Error as Socks5Error, Reply, Response, UdpHeader};
use std::{
io::{Cursor, Error},
marker::PhantomData,
net::SocketAddr,
sync::atomic::{AtomicUsize, Ordering},
};
use tokio::{
io::{AsyncReadExt, AsyncWriteExt},
net::{TcpStream, UdpSocket},
};
pub mod state {
#[derive(Debug)]
pub struct NeedReply;
#[derive(Debug)]
pub struct Ready;
}
#[derive(Debug)]
pub struct Associate<S> {
stream: TcpStream,
_state: PhantomData<S>,
}
impl Associate<state::NeedReply> {
pub async fn reply(
mut self,
reply: Reply,
addr: Address,
) -> Result<Associate<state::Ready>, (Error, TcpStream)> {
let resp = Response::new(reply, addr);
if let Err(err) = resp.write_to(&mut self.stream).await {
return Err((err, self.stream));
}
Ok(Associate::new(self.stream))
}
}
impl Associate<state::Ready> {
pub async fn wait_close(&mut self) -> Result<(), Error> {
loop {
match self.stream.read(&mut [0]).await {
Ok(0) => break Ok(()),
Ok(_) => {}
Err(err) => break Err(err),
}
}
}
}
impl<S> Associate<S> {
#[inline]
pub(super) fn new(stream: TcpStream) -> Self {
Self {
stream,
_state: PhantomData,
}
}
#[inline]
pub async fn close(&mut self) -> Result<(), Error> {
self.stream.shutdown().await
}
#[inline]
pub fn local_addr(&self) -> Result<SocketAddr, Error> {
self.stream.local_addr()
}
#[inline]
pub fn peer_addr(&self) -> Result<SocketAddr, Error> {
self.stream.peer_addr()
}
#[inline]
pub fn get_ref(&self) -> &TcpStream {
&self.stream
}
#[inline]
pub fn get_mut(&mut self) -> &mut TcpStream {
&mut self.stream
}
#[inline]
pub fn into_inner(self) -> TcpStream {
self.stream
}
}
#[derive(Debug)]
pub struct AssociatedUdpSocket {
socket: UdpSocket,
buf_size: AtomicUsize,
}
impl AssociatedUdpSocket {
pub fn new(socket: UdpSocket, buf_size: usize) -> Self {
Self {
socket,
buf_size: AtomicUsize::new(buf_size),
}
}
pub async fn recv(&self) -> Result<(Bytes, UdpHeader), (Socks5Error, Option<Vec<u8>>)> {
let max_pkt_size = self.buf_size.load(Ordering::Acquire);
let mut buf = vec![0; max_pkt_size];
let len = match self.socket.recv(&mut buf).await {
Ok(len) => len,
Err(err) => return Err((Socks5Error::Io(err), None)),
};
buf.truncate(len);
let header = match UdpHeader::read_from(&mut Cursor::new(buf.as_slice())).await {
Ok(header) => header,
Err(err) => return Err((err, Some(buf))),
};
let pkt = Bytes::from(buf).slice(header.serialized_len()..);
Ok((pkt, header))
}
pub async fn recv_from(
&self,
) -> Result<(Bytes, UdpHeader, SocketAddr), (Socks5Error, Option<Vec<u8>>)> {
let max_pkt_size = self.buf_size.load(Ordering::Acquire);
let mut buf = vec![0; max_pkt_size];
let (len, addr) = match self.socket.recv_from(&mut buf).await {
Ok(res) => res,
Err(err) => return Err((Socks5Error::Io(err), None)),
};
buf.truncate(len);
let header = match UdpHeader::read_from(&mut Cursor::new(buf.as_slice())).await {
Ok(header) => header,
Err(err) => return Err((err, Some(buf))),
};
let pkt = Bytes::from(buf).slice(header.serialized_len()..);
Ok((pkt, header, addr))
}
pub async fn send<P: AsRef<[u8]>>(&self, pkt: P, header: &UdpHeader) -> Result<usize, Error> {
let mut buf = BytesMut::with_capacity(header.serialized_len() + pkt.as_ref().len());
header.write_to_buf(&mut buf);
buf.extend_from_slice(pkt.as_ref());
self.socket
.send(&buf)
.await
.map(|len| len - header.serialized_len())
}
pub async fn send_to<P: AsRef<[u8]>>(
&self,
pkt: P,
header: &UdpHeader,
addr: SocketAddr,
) -> Result<usize, Error> {
let mut buf = BytesMut::with_capacity(header.serialized_len() + pkt.as_ref().len());
header.write_to_buf(&mut buf);
buf.extend_from_slice(pkt.as_ref());
self.socket
.send_to(&buf, addr)
.await
.map(|len| len - header.serialized_len())
}
#[inline]
pub fn get_max_pkt_size(&self) -> usize {
self.buf_size.load(Ordering::Acquire)
}
#[inline]
pub fn set_max_pkt_size(&self, size: usize) {
self.buf_size.store(size, Ordering::Release);
}
#[inline]
pub fn get_ref(&self) -> &UdpSocket {
&self.socket
}
#[inline]
pub fn get_mut(&mut self) -> &mut UdpSocket {
&mut self.socket
}
#[inline]
pub fn into_inner(self) -> UdpSocket {
self.socket
}
}