mirror of https://github.com/dswd/vpncloud.git
Lots of changes
This commit is contained in:
parent
b6bde39c3b
commit
e92f237d5e
124
src/ethcloud.rs
124
src/ethcloud.rs
|
@ -12,12 +12,31 @@ use epoll;
|
||||||
|
|
||||||
use super::{ethernet, udpmessage};
|
use super::{ethernet, udpmessage};
|
||||||
use super::udpmessage::{Options, Message};
|
use super::udpmessage::{Options, Message};
|
||||||
use super::ethernet::MacTable;
|
use super::ethernet::{TapDevice, MacTable};
|
||||||
use super::tuntap::{TunTapDevice, DeviceType};
|
|
||||||
|
|
||||||
|
|
||||||
pub type NetworkId = u64;
|
pub type NetworkId = u64;
|
||||||
|
|
||||||
|
pub trait Table {
|
||||||
|
type Address;
|
||||||
|
fn learn(&mut self, Self::Address, SocketAddr);
|
||||||
|
fn lookup(&self, Self::Address) -> Option<SocketAddr>;
|
||||||
|
fn housekeep(&mut self);
|
||||||
|
}
|
||||||
|
|
||||||
|
pub trait InterfaceMessage: fmt::Debug + Sized {
|
||||||
|
type Address;
|
||||||
|
fn src(&self) -> Self::Address;
|
||||||
|
fn dst(&self) -> Self::Address;
|
||||||
|
fn encode_to(&self, &[u8], &mut [u8]) -> usize;
|
||||||
|
fn parse_from(&[u8]) -> Result<(Self, &[u8]), Error>;
|
||||||
|
}
|
||||||
|
|
||||||
|
pub trait VirtualInterface: AsRawFd {
|
||||||
|
fn read<'a, T: InterfaceMessage>(&mut self, &'a mut [u8]) -> Result<(T, &'a[u8]), Error>;
|
||||||
|
fn write<T: InterfaceMessage>(&mut self, &T, &[u8]) -> Result<(), Error>;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
#[derive(Debug)]
|
#[derive(Debug)]
|
||||||
pub enum Error {
|
pub enum Error {
|
||||||
ParseError(&'static str),
|
ParseError(&'static str),
|
||||||
|
@ -94,70 +113,42 @@ impl PeerList {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub trait Table {
|
pub struct EthCloud<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface> {
|
||||||
type Address;
|
|
||||||
fn learn(&mut self, Self::Address, SocketAddr);
|
|
||||||
fn lookup(&self, Self::Address) -> Option<SocketAddr>;
|
|
||||||
fn housekeep(&mut self);
|
|
||||||
}
|
|
||||||
|
|
||||||
pub trait InterfaceMessage {
|
|
||||||
type Address;
|
|
||||||
fn src(&self) -> Self::Address;
|
|
||||||
fn dst(&self) -> Self::Address;
|
|
||||||
}
|
|
||||||
|
|
||||||
pub trait VirtualInterface {
|
|
||||||
type Message: InterfaceMessage;
|
|
||||||
fn read(&mut self) -> Result<Self::Message, Error>;
|
|
||||||
fn write(&mut self, Self::Message) -> Result<(), Error>;
|
|
||||||
}
|
|
||||||
|
|
||||||
pub struct EthCloud<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface<Message=M>> {
|
|
||||||
peers: PeerList,
|
peers: PeerList,
|
||||||
reconnect_peers: Vec<SocketAddr>,
|
reconnect_peers: Vec<SocketAddr>,
|
||||||
table: MacTable,
|
table: T,
|
||||||
socket: UdpSocket,
|
socket: UdpSocket,
|
||||||
tapdev: TunTapDevice,
|
device: I,
|
||||||
network_id: Option<NetworkId>,
|
network_id: Option<NetworkId>,
|
||||||
next_peerlist: SteadyTime,
|
next_peerlist: SteadyTime,
|
||||||
update_freq: Duration,
|
update_freq: Duration,
|
||||||
buffer_out: [u8; 64*1024],
|
buffer_out: [u8; 64*1024],
|
||||||
next_housekeep: SteadyTime,
|
next_housekeep: SteadyTime,
|
||||||
_dummy_t: PhantomData<T>,
|
|
||||||
_dummy_m: PhantomData<M>,
|
_dummy_m: PhantomData<M>,
|
||||||
_dummy_i: PhantomData<I>,
|
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface<Message=M>> EthCloud<A, T, M, I> {
|
impl<A: fmt::Debug, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface> EthCloud<A, T, M, I> {
|
||||||
pub fn new(device: &str, listen: String, network_id: Option<NetworkId>, mac_timeout: Duration, peer_timeout: Duration) -> Self {
|
pub fn new(device: I, listen: String, network_id: Option<NetworkId>, table: T, peer_timeout: Duration) -> Self {
|
||||||
let socket = match UdpSocket::bind(&listen as &str) {
|
let socket = match UdpSocket::bind(&listen as &str) {
|
||||||
Ok(socket) => socket,
|
Ok(socket) => socket,
|
||||||
_ => panic!("Failed to open socket")
|
_ => panic!("Failed to open socket")
|
||||||
};
|
};
|
||||||
let tapdev = match TunTapDevice::new(device, DeviceType::TapDevice) {
|
|
||||||
Ok(tapdev) => tapdev,
|
|
||||||
_ => panic!("Failed to open tap device")
|
|
||||||
};
|
|
||||||
info!("Opened tap device {}", tapdev.ifname());
|
|
||||||
EthCloud{
|
EthCloud{
|
||||||
peers: PeerList::new(peer_timeout),
|
peers: PeerList::new(peer_timeout),
|
||||||
reconnect_peers: Vec::new(),
|
reconnect_peers: Vec::new(),
|
||||||
table: MacTable::new(mac_timeout),
|
table: table,
|
||||||
socket: socket,
|
socket: socket,
|
||||||
tapdev: tapdev,
|
device: device,
|
||||||
network_id: network_id,
|
network_id: network_id,
|
||||||
next_peerlist: SteadyTime::now(),
|
next_peerlist: SteadyTime::now(),
|
||||||
update_freq: peer_timeout/2,
|
update_freq: peer_timeout/2,
|
||||||
buffer_out: [0; 64*1024],
|
buffer_out: [0; 64*1024],
|
||||||
next_housekeep: SteadyTime::now(),
|
next_housekeep: SteadyTime::now(),
|
||||||
_dummy_t: PhantomData,
|
|
||||||
_dummy_m: PhantomData,
|
_dummy_m: PhantomData,
|
||||||
_dummy_i: PhantomData
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
fn send_msg<Addr: ToSocketAddrs+fmt::Display>(&mut self, addr: Addr, msg: &Message) -> Result<(), Error> {
|
fn send_msg<Addr: ToSocketAddrs+fmt::Display>(&mut self, addr: Addr, msg: &Message<M>) -> Result<(), Error> {
|
||||||
debug!("Sending {:?} to {}", msg, addr);
|
debug!("Sending {:?} to {}", msg, addr);
|
||||||
let mut options = Options::default();
|
let mut options = Options::default();
|
||||||
options.network_id = self.network_id;
|
options.network_id = self.network_id;
|
||||||
|
@ -214,16 +205,16 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
fn handle_interface_data(&mut self, frame: ethernet::Frame) -> Result<(), Error> {
|
fn handle_interface_data(&mut self, header: M, payload: &[u8]) -> Result<(), Error> {
|
||||||
debug!("Read ethernet frame from tap {:?}", frame);
|
debug!("Read data from interface {:?}, {} bytes", header, payload.len());
|
||||||
match self.table.lookup(frame.dst()) {
|
match self.table.lookup(header.dst()) {
|
||||||
Some(addr) => {
|
Some(addr) => {
|
||||||
debug!("Found destination for {:?} => {}", frame.dst(), addr);
|
debug!("Found destination for {:?} => {}", header.dst(), addr);
|
||||||
try!(self.send_msg(addr, &Message::Frame(frame)))
|
try!(self.send_msg(addr, &Message::Frame(header, payload)))
|
||||||
},
|
},
|
||||||
None => {
|
None => {
|
||||||
debug!("No destination for {:?} found, broadcasting", frame.dst());
|
debug!("No destination for {:?} found, broadcasting", header.dst());
|
||||||
let msg = Message::Frame(frame);
|
let msg = Message::Frame(header, payload);
|
||||||
for addr in &self.peers.as_vec() {
|
for addr in &self.peers.as_vec() {
|
||||||
try!(self.send_msg(addr, &msg));
|
try!(self.send_msg(addr, &msg));
|
||||||
}
|
}
|
||||||
|
@ -232,7 +223,7 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
fn handle_net_message(&mut self, peer: SocketAddr, options: Options, msg: Message) -> Result<(), Error> {
|
fn handle_net_message(&mut self, peer: SocketAddr, options: Options, msg: Message<M>) -> Result<(), Error> {
|
||||||
if let Some(id) = self.network_id {
|
if let Some(id) = self.network_id {
|
||||||
if options.network_id != Some(id) {
|
if options.network_id != Some(id) {
|
||||||
info!("Ignoring message from {} with wrong token {:?}", peer, options.network_id);
|
info!("Ignoring message from {} with wrong token {:?}", peer, options.network_id);
|
||||||
|
@ -241,10 +232,9 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
}
|
}
|
||||||
debug!("Recieved {:?} from {}", msg, peer);
|
debug!("Recieved {:?} from {}", msg, peer);
|
||||||
match msg {
|
match msg {
|
||||||
Message::Frame(frame) => {
|
Message::Frame(header, payload) => {
|
||||||
let size = ethernet::encode(&frame, &mut self.buffer_out);
|
debug!("Writing data to device: {:?}, {} bytes", header, payload.len());
|
||||||
debug!("Writing ethernet frame to tap: {:?}", frame);
|
match self.device.write(&header, &payload) {
|
||||||
match self.tapdev.write(&self.buffer_out[..size]) {
|
|
||||||
Ok(()) => (),
|
Ok(()) => (),
|
||||||
Err(e) => {
|
Err(e) => {
|
||||||
error!("Failed to send via tap device {:?}", e);
|
error!("Failed to send via tap device {:?}", e);
|
||||||
|
@ -252,7 +242,7 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
self.peers.add(&peer);
|
self.peers.add(&peer);
|
||||||
self.table.learn(frame.src, peer);
|
self.table.learn(header.src(), peer);
|
||||||
},
|
},
|
||||||
Message::Peers(peers) => {
|
Message::Peers(peers) => {
|
||||||
self.peers.add(&peer);
|
self.peers.add(&peer);
|
||||||
|
@ -277,11 +267,11 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
pub fn run(&mut self) {
|
pub fn run(&mut self) {
|
||||||
let epoll_handle = epoll::create1(0).expect("Failed to create epoll handle");
|
let epoll_handle = epoll::create1(0).expect("Failed to create epoll handle");
|
||||||
let socket_fd = self.socket.as_raw_fd();
|
let socket_fd = self.socket.as_raw_fd();
|
||||||
let tapdev_fd = self.tapdev.as_raw_fd();
|
let device_fd = self.device.as_raw_fd();
|
||||||
let mut socket_event = epoll::EpollEvent{events: epoll::util::event_type::EPOLLIN, data: 0};
|
let mut socket_event = epoll::EpollEvent{events: epoll::util::event_type::EPOLLIN, data: 0};
|
||||||
let mut tapdev_event = epoll::EpollEvent{events: epoll::util::event_type::EPOLLIN, data: 1};
|
let mut device_event = epoll::EpollEvent{events: epoll::util::event_type::EPOLLIN, data: 1};
|
||||||
epoll::ctl(epoll_handle, epoll::util::ctl_op::ADD, socket_fd, &mut socket_event).expect("Failed to add socket to epoll handle");
|
epoll::ctl(epoll_handle, epoll::util::ctl_op::ADD, socket_fd, &mut socket_event).expect("Failed to add socket to epoll handle");
|
||||||
epoll::ctl(epoll_handle, epoll::util::ctl_op::ADD, tapdev_fd, &mut tapdev_event).expect("Failed to add tapdev to epoll handle");
|
epoll::ctl(epoll_handle, epoll::util::ctl_op::ADD, device_fd, &mut device_event).expect("Failed to add device to epoll handle");
|
||||||
let mut events = [epoll::EpollEvent{events: 0, data: 0}; 2];
|
let mut events = [epoll::EpollEvent{events: 0, data: 0}; 2];
|
||||||
let mut buffer = [0; 64*1024];
|
let mut buffer = [0; 64*1024];
|
||||||
loop {
|
loop {
|
||||||
|
@ -298,12 +288,10 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
},
|
},
|
||||||
Err(_error) => panic!("Failed to read from network socket")
|
Err(_error) => panic!("Failed to read from network socket")
|
||||||
},
|
},
|
||||||
&1 => match self.tapdev.read(&mut buffer) {
|
&1 => match self.device.read(&mut buffer) {
|
||||||
Ok(size) => {
|
Ok((header, payload)) => match self.handle_interface_data(header, payload) {
|
||||||
match ethernet::decode(&mut buffer[..size]).and_then(|frame| self.handle_interface_data(frame)) {
|
Ok(_) => (),
|
||||||
Ok(_) => (),
|
Err(e) => error!("Error: {:?}", e)
|
||||||
Err(e) => error!("Error: {:?}", e)
|
|
||||||
}
|
|
||||||
},
|
},
|
||||||
Err(_error) => panic!("Failed to read from tap device")
|
Err(_error) => panic!("Failed to read from tap device")
|
||||||
},
|
},
|
||||||
|
@ -321,3 +309,17 @@ impl<A, T: Table<Address=A>, M: InterfaceMessage<Address=A>, I: VirtualInterface
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
pub type TapCloud = EthCloud<ethernet::EthAddr, MacTable, ethernet::Frame, ethernet::TapDevice>;
|
||||||
|
|
||||||
|
impl TapCloud {
|
||||||
|
pub fn new_tap_cloud(device: &str, listen: String, network_id: Option<NetworkId>, mac_timeout: Duration, peer_timeout: Duration) -> Self {
|
||||||
|
let device = match TapDevice::new(device) {
|
||||||
|
Ok(device) => device,
|
||||||
|
_ => panic!("Failed to open tap device")
|
||||||
|
};
|
||||||
|
info!("Opened tap device {}", device.ifname());
|
||||||
|
let table = MacTable::new(mac_timeout);
|
||||||
|
Self::new(device, listen, network_id, table, peer_timeout)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
175
src/ethernet.rs
175
src/ethernet.rs
|
@ -1,13 +1,17 @@
|
||||||
use std::{mem, ptr, fmt};
|
use std::{mem, ptr, fmt, fs};
|
||||||
use std::net::SocketAddr;
|
use std::net::SocketAddr;
|
||||||
use std::collections::HashMap;
|
use std::collections::HashMap;
|
||||||
use std::marker::PhantomData;
|
use std::os::unix::io::{AsRawFd, RawFd};
|
||||||
|
use std::io::{Result as IoResult, Error as IoError, Read, Write};
|
||||||
|
|
||||||
use super::ethcloud::{Error, Table, InterfaceMessage, VirtualInterface};
|
use super::ethcloud::{Error, Table, InterfaceMessage, VirtualInterface};
|
||||||
use super::util::{as_bytes, as_obj};
|
use super::util::{as_bytes, as_obj};
|
||||||
|
|
||||||
use time::{Duration, SteadyTime};
|
use time::{Duration, SteadyTime};
|
||||||
|
|
||||||
|
extern {
|
||||||
|
fn setup_tap_device(fd: i32, ifname: *mut u8) -> i32;
|
||||||
|
}
|
||||||
|
|
||||||
#[derive(Clone, Copy, Hash, PartialEq, Eq, PartialOrd, Ord)]
|
#[derive(Clone, Copy, Hash, PartialEq, Eq, PartialOrd, Ord)]
|
||||||
pub struct Mac(pub [u8; 6]);
|
pub struct Mac(pub [u8; 6]);
|
||||||
|
@ -28,20 +32,18 @@ pub struct EthAddr {
|
||||||
}
|
}
|
||||||
|
|
||||||
#[derive(PartialEq)]
|
#[derive(PartialEq)]
|
||||||
pub struct Frame<'a> {
|
pub struct Frame {
|
||||||
pub src: EthAddr,
|
pub src: EthAddr,
|
||||||
pub dst: EthAddr,
|
pub dst: EthAddr
|
||||||
pub payload: &'a [u8]
|
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<'a> fmt::Debug for Frame<'a> {
|
impl fmt::Debug for Frame {
|
||||||
fn fmt(&self, formatter: &mut fmt::Formatter) -> Result<(), fmt::Error> {
|
fn fmt(&self, formatter: &mut fmt::Formatter) -> Result<(), fmt::Error> {
|
||||||
write!(formatter, "src: {:?}, dst: {:?}, vlan: {}, payload: {} bytes",
|
write!(formatter, "src: {:?}, dst: {:?}, vlan: {}", self.src.mac, self.dst.mac, self.src.vlan)
|
||||||
self.src.mac, self.dst.mac, self.src.vlan, self.payload.len())
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<'a> InterfaceMessage for Frame<'a> {
|
impl InterfaceMessage for Frame {
|
||||||
type Address = EthAddr;
|
type Address = EthAddr;
|
||||||
|
|
||||||
fn src(&self) -> Self::Address {
|
fn src(&self) -> Self::Address {
|
||||||
|
@ -51,68 +53,103 @@ impl<'a> InterfaceMessage for Frame<'a> {
|
||||||
fn dst(&self) -> Self::Address {
|
fn dst(&self) -> Self::Address {
|
||||||
self.dst
|
self.dst
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
pub struct TapDevice<'a>(PhantomData<&'a ()>);
|
fn encode_to(&self, payload: &[u8], data: &mut [u8]) -> usize {
|
||||||
|
assert!(data.len() >= 16 + payload.len());
|
||||||
impl<'a> VirtualInterface for TapDevice<'a> {
|
let mut pos = 0;
|
||||||
type Message = Frame<'a>;
|
unsafe {
|
||||||
|
let dst_dat = as_bytes::<Mac>(&self.dst.mac);
|
||||||
fn read(&mut self) -> Result<Self::Message, Error> {
|
ptr::copy_nonoverlapping(dst_dat.as_ptr(), data[pos..].as_mut_ptr(), dst_dat.len());
|
||||||
unimplemented!();
|
pos += dst_dat.len();
|
||||||
}
|
let src_dat = as_bytes::<Mac>(&self.src.mac);
|
||||||
|
ptr::copy_nonoverlapping(src_dat.as_ptr(), data[pos..].as_mut_ptr(), src_dat.len());
|
||||||
fn write(&mut self, msg: Self::Message) -> Result<(), Error> {
|
pos += src_dat.len();
|
||||||
unimplemented!();
|
if self.src.vlan != 0 {
|
||||||
}
|
data[pos] = 0x81; data[pos+1] = 0x00;
|
||||||
}
|
pos += 2;
|
||||||
|
let vlan_dat = mem::transmute::<u16, [u8; 2]>(self.src.vlan.to_be());
|
||||||
pub fn decode(data: &[u8]) -> Result<Frame, Error> {
|
ptr::copy_nonoverlapping(vlan_dat.as_ptr(), data[pos..].as_mut_ptr(), vlan_dat.len());
|
||||||
if data.len() < 14 {
|
pos += vlan_dat.len();
|
||||||
return Err(Error::ParseError("Frame is too short"));
|
}
|
||||||
}
|
ptr::copy_nonoverlapping(payload.as_ptr(), data[pos..].as_mut_ptr(), payload.len());
|
||||||
let mut pos = 0;
|
|
||||||
let dst = *unsafe { as_obj::<Mac>(&data[pos..]) };
|
|
||||||
pos += mem::size_of::<Mac>();
|
|
||||||
let src = *unsafe { as_obj::<Mac>(&data[pos..]) };
|
|
||||||
pos += mem::size_of::<Mac>();
|
|
||||||
let mut vlan = 0;
|
|
||||||
let mut payload = &data[pos..];
|
|
||||||
if data[pos] == 0x81 && data[pos+1] == 0x00 {
|
|
||||||
pos += 2;
|
|
||||||
if data.len() < pos + 2 {
|
|
||||||
return Err(Error::ParseError("Vlan frame is too short"));
|
|
||||||
}
|
}
|
||||||
vlan = u16::from_be(* unsafe { as_obj::<u16>(&data[pos..]) });
|
pos += payload.len();
|
||||||
pos += 2;
|
pos
|
||||||
payload = &data[pos..];
|
|
||||||
}
|
}
|
||||||
Ok(Frame{src: EthAddr{mac: src, vlan: vlan}, dst: EthAddr{mac: dst, vlan: vlan}, payload: payload})
|
|
||||||
}
|
|
||||||
|
|
||||||
pub fn encode(frame: &Frame, buf: &mut [u8]) -> usize {
|
fn parse_from(data: &[u8]) -> Result<(Frame, &[u8]), Error> {
|
||||||
assert!(buf.len() >= 16 + frame.payload.len());
|
if data.len() < 14 {
|
||||||
let mut pos = 0;
|
return Err(Error::ParseError("Frame is too short"));
|
||||||
unsafe {
|
}
|
||||||
let dst_dat = as_bytes::<Mac>(&frame.dst.mac);
|
let mut pos = 0;
|
||||||
ptr::copy_nonoverlapping(dst_dat.as_ptr(), buf[pos..].as_mut_ptr(), dst_dat.len());
|
let dst = *unsafe { as_obj::<Mac>(&data[pos..]) };
|
||||||
pos += dst_dat.len();
|
pos += mem::size_of::<Mac>();
|
||||||
let src_dat = as_bytes::<Mac>(&frame.src.mac);
|
let src = *unsafe { as_obj::<Mac>(&data[pos..]) };
|
||||||
ptr::copy_nonoverlapping(src_dat.as_ptr(), buf[pos..].as_mut_ptr(), src_dat.len());
|
pos += mem::size_of::<Mac>();
|
||||||
pos += src_dat.len();
|
let mut vlan = 0;
|
||||||
if frame.src.vlan != 0 {
|
let mut payload = &data[pos..];
|
||||||
buf[pos] = 0x81; buf[pos+1] = 0x00;
|
if data[pos] == 0x81 && data[pos+1] == 0x00 {
|
||||||
pos += 2;
|
pos += 2;
|
||||||
let vlan_dat = mem::transmute::<u16, [u8; 2]>(frame.src.vlan.to_be());
|
if data.len() < pos + 2 {
|
||||||
ptr::copy_nonoverlapping(vlan_dat.as_ptr(), buf[pos..].as_mut_ptr(), vlan_dat.len());
|
return Err(Error::ParseError("Vlan frame is too short"));
|
||||||
pos += vlan_dat.len();
|
}
|
||||||
|
vlan = u16::from_be(* unsafe { as_obj::<u16>(&data[pos..]) });
|
||||||
|
pos += 2;
|
||||||
|
payload = &data[pos..];
|
||||||
}
|
}
|
||||||
ptr::copy_nonoverlapping(frame.payload.as_ptr(), buf[pos..].as_mut_ptr(), frame.payload.len());
|
Ok((Frame{src: EthAddr{mac: src, vlan: vlan}, dst: EthAddr{mac: dst, vlan: vlan}}, payload))
|
||||||
}
|
}
|
||||||
pos += frame.payload.len();
|
|
||||||
pos
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
pub struct TapDevice {
|
||||||
|
fd: fs::File,
|
||||||
|
ifname: String
|
||||||
|
}
|
||||||
|
|
||||||
|
impl TapDevice {
|
||||||
|
pub fn new(ifname: &str) -> IoResult<Self> {
|
||||||
|
let fd = try!(fs::OpenOptions::new().read(true).write(true).open("/dev/net/tun"));
|
||||||
|
let mut ifname_string = String::with_capacity(32);
|
||||||
|
ifname_string.push_str(ifname);
|
||||||
|
ifname_string.push('\0');
|
||||||
|
let mut ifname_c = ifname_string.into_bytes();
|
||||||
|
let res = unsafe { setup_tap_device(fd.as_raw_fd(), ifname_c.as_mut_ptr()) };
|
||||||
|
match res {
|
||||||
|
0 => Ok(TapDevice{fd: fd, ifname: String::from_utf8(ifname_c).unwrap()}),
|
||||||
|
_ => Err(IoError::last_os_error())
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[inline(always)]
|
||||||
|
pub fn ifname(&self) -> &str {
|
||||||
|
&self.ifname
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl AsRawFd for TapDevice {
|
||||||
|
fn as_raw_fd(&self) -> RawFd {
|
||||||
|
self.fd.as_raw_fd()
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl VirtualInterface for TapDevice {
|
||||||
|
fn read<'a, T: InterfaceMessage>(&mut self, mut buffer: &'a mut [u8]) -> Result<(T, &'a[u8]), Error> {
|
||||||
|
let size = match self.fd.read(&mut buffer) {
|
||||||
|
Ok(size) => size,
|
||||||
|
Err(_) => return Err(Error::TunTapDevError("Read error"))
|
||||||
|
};
|
||||||
|
T::parse_from(&buffer[..size])
|
||||||
|
}
|
||||||
|
|
||||||
|
fn write<T: InterfaceMessage>(&mut self, msg: &T, payload: &[u8]) -> Result<(), Error> {
|
||||||
|
let mut buffer = [0u8; 64*1024];
|
||||||
|
let size = msg.encode_to(payload, &mut buffer);
|
||||||
|
match self.fd.write_all(&buffer[..size]) {
|
||||||
|
Ok(_) => Ok(()),
|
||||||
|
Err(_) => Err(Error::TunTapDevError("Write error"))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
struct MacTableValue {
|
struct MacTableValue {
|
||||||
address: SocketAddr,
|
address: SocketAddr,
|
||||||
|
@ -169,12 +206,13 @@ fn without_vlan() {
|
||||||
let dst = Mac([6,5,4,3,2,1]);
|
let dst = Mac([6,5,4,3,2,1]);
|
||||||
let payload = [1,2,3,4,5,6,7,8];
|
let payload = [1,2,3,4,5,6,7,8];
|
||||||
let mut buf = [0u8; 1024];
|
let mut buf = [0u8; 1024];
|
||||||
let frame = Frame{src: EthAddr{mac: src, vlan: 0}, dst: EthAddr{mac: dst, vlan: 0}, payload: &payload};
|
let frame = Frame{src: EthAddr{mac: src, vlan: 0}, dst: EthAddr{mac: dst, vlan: 0}};
|
||||||
let size = encode(&frame, &mut buf);
|
let size = frame.encode_to(&payload, &mut buf);
|
||||||
assert_eq!(size, 20);
|
assert_eq!(size, 20);
|
||||||
assert_eq!(&buf[..size], &[6,5,4,3,2,1,1,2,3,4,5,6,1,2,3,4,5,6,7,8]);
|
assert_eq!(&buf[..size], &[6,5,4,3,2,1,1,2,3,4,5,6,1,2,3,4,5,6,7,8]);
|
||||||
let frame2 = decode(&buf[..size]).unwrap();
|
let (frame2, payload2) = Frame::parse_from(&buf[..size]).unwrap();
|
||||||
assert_eq!(frame, frame2);
|
assert_eq!(frame, frame2);
|
||||||
|
assert_eq!(payload, payload2);
|
||||||
}
|
}
|
||||||
|
|
||||||
#[test]
|
#[test]
|
||||||
|
@ -183,10 +221,11 @@ fn with_vlan() {
|
||||||
let dst = Mac([6,5,4,3,2,1]);
|
let dst = Mac([6,5,4,3,2,1]);
|
||||||
let payload = [1,2,3,4,5,6,7,8];
|
let payload = [1,2,3,4,5,6,7,8];
|
||||||
let mut buf = [0u8; 1024];
|
let mut buf = [0u8; 1024];
|
||||||
let frame = Frame{src: EthAddr{mac: src, vlan: 0}, dst: EthAddr{mac: dst, vlan: 0}, payload: &payload};
|
let frame = Frame{src: EthAddr{mac: src, vlan: 1234}, dst: EthAddr{mac: dst, vlan: 1234}};
|
||||||
let size = encode(&frame, &mut buf);
|
let size = frame.encode_to(&payload, &mut buf);
|
||||||
assert_eq!(size, 24);
|
assert_eq!(size, 24);
|
||||||
assert_eq!(&buf[..size], &[6,5,4,3,2,1,1,2,3,4,5,6,0x81,0,4,210,1,2,3,4,5,6,7,8]);
|
assert_eq!(&buf[..size], &[6,5,4,3,2,1,1,2,3,4,5,6,0x81,0,4,210,1,2,3,4,5,6,7,8]);
|
||||||
let frame2 = decode(&buf[..size]).unwrap();
|
let (frame2, payload2) = Frame::parse_from(&buf[..size]).unwrap();
|
||||||
assert_eq!(frame, frame2);
|
assert_eq!(frame, frame2);
|
||||||
|
assert_eq!(payload, payload2);
|
||||||
}
|
}
|
||||||
|
|
|
@ -6,7 +6,6 @@ extern crate epoll;
|
||||||
|
|
||||||
mod util;
|
mod util;
|
||||||
mod udpmessage;
|
mod udpmessage;
|
||||||
mod tuntap;
|
|
||||||
mod ethernet;
|
mod ethernet;
|
||||||
mod ip;
|
mod ip;
|
||||||
mod ethcloud;
|
mod ethcloud;
|
||||||
|
@ -16,7 +15,7 @@ use docopt::Docopt;
|
||||||
|
|
||||||
use std::hash::{Hash, SipHasher, Hasher};
|
use std::hash::{Hash, SipHasher, Hasher};
|
||||||
|
|
||||||
use ethcloud::{Error, EthCloud};
|
use ethcloud::{Error, TapCloud};
|
||||||
|
|
||||||
|
|
||||||
//TODO: Implement IPv6
|
//TODO: Implement IPv6
|
||||||
|
@ -81,7 +80,7 @@ fn main() {
|
||||||
Box::new(SimpleLogger)
|
Box::new(SimpleLogger)
|
||||||
}).unwrap();
|
}).unwrap();
|
||||||
debug!("Args: {:?}", args);
|
debug!("Args: {:?}", args);
|
||||||
let mut tapcloud = EthCloud::<ethernet::EthAddr, ethernet::MacTable, ethernet::Frame, ethernet::TapDevice>::new(
|
let mut tapcloud = TapCloud::new_tap_cloud(
|
||||||
&args.flag_device,
|
&args.flag_device,
|
||||||
args.flag_listen,
|
args.flag_listen,
|
||||||
args.flag_network_id.map(|name| {
|
args.flag_network_id.map(|name| {
|
||||||
|
|
|
@ -1,64 +0,0 @@
|
||||||
use std::fs;
|
|
||||||
use std::io::{Read, Write, Result as IoResult, Error as IoError};
|
|
||||||
use std::os::unix::io::{AsRawFd, RawFd};
|
|
||||||
|
|
||||||
extern {
|
|
||||||
fn setup_tap_device(fd: i32, ifname: *mut u8) -> i32;
|
|
||||||
fn setup_tun_device(fd: i32, ifname: *mut u8) -> i32;
|
|
||||||
}
|
|
||||||
|
|
||||||
#[derive(Clone, Copy, Debug, PartialEq, PartialOrd, Eq, Ord)]
|
|
||||||
pub enum DeviceType {
|
|
||||||
TunDevice, TapDevice
|
|
||||||
}
|
|
||||||
|
|
||||||
pub struct TunTapDevice {
|
|
||||||
fd: fs::File,
|
|
||||||
ifname: String,
|
|
||||||
iftype: DeviceType
|
|
||||||
}
|
|
||||||
|
|
||||||
impl TunTapDevice {
|
|
||||||
pub fn new(ifname: &str, iftype: DeviceType) -> IoResult<Self> {
|
|
||||||
let fd = try!(fs::OpenOptions::new().read(true).write(true).open("/dev/net/tun"));
|
|
||||||
let mut ifname_string = String::with_capacity(32);
|
|
||||||
ifname_string.push_str(ifname);
|
|
||||||
ifname_string.push('\0');
|
|
||||||
let mut ifname_c = ifname_string.into_bytes();
|
|
||||||
let res = match iftype {
|
|
||||||
DeviceType::TapDevice => unsafe { setup_tap_device(fd.as_raw_fd(), ifname_c.as_mut_ptr()) },
|
|
||||||
DeviceType::TunDevice => unsafe { setup_tun_device(fd.as_raw_fd(), ifname_c.as_mut_ptr()) }
|
|
||||||
};
|
|
||||||
match res {
|
|
||||||
0 => Ok(TunTapDevice{fd: fd, ifname: String::from_utf8(ifname_c).unwrap(), iftype: iftype}),
|
|
||||||
_ => Err(IoError::last_os_error())
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn ifname(&self) -> &str {
|
|
||||||
&self.ifname
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn iftype(&self) -> DeviceType {
|
|
||||||
self.iftype
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn read(&mut self, buffer: &mut [u8]) -> IoResult<usize> {
|
|
||||||
self.fd.read(buffer)
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn write(&mut self, buffer: &[u8]) -> IoResult<()> {
|
|
||||||
self.fd.write_all(buffer)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
impl AsRawFd for TunTapDevice {
|
|
||||||
#[inline(always)]
|
|
||||||
fn as_raw_fd(&self) -> RawFd {
|
|
||||||
self.fd.as_raw_fd()
|
|
||||||
}
|
|
||||||
}
|
|
|
@ -2,7 +2,7 @@ use std::{mem, ptr, fmt};
|
||||||
use std::net::{SocketAddr, SocketAddrV4, Ipv4Addr};
|
use std::net::{SocketAddr, SocketAddrV4, Ipv4Addr};
|
||||||
use std::u16;
|
use std::u16;
|
||||||
|
|
||||||
use super::ethcloud::{Error, NetworkId};
|
use super::ethcloud::{Error, NetworkId, InterfaceMessage};
|
||||||
use super::ethernet;
|
use super::ethernet;
|
||||||
use super::util::{as_obj, as_bytes};
|
use super::util::{as_obj, as_bytes};
|
||||||
|
|
||||||
|
@ -31,17 +31,17 @@ pub struct Options {
|
||||||
|
|
||||||
|
|
||||||
#[derive(PartialEq)]
|
#[derive(PartialEq)]
|
||||||
pub enum Message<'a> {
|
pub enum Message<'a, M: InterfaceMessage> {
|
||||||
Frame(ethernet::Frame<'a>),
|
Frame(M, &'a[u8]),
|
||||||
Peers(Vec<SocketAddr>),
|
Peers(Vec<SocketAddr>),
|
||||||
GetPeers,
|
GetPeers,
|
||||||
Close,
|
Close,
|
||||||
}
|
}
|
||||||
|
|
||||||
impl<'a> fmt::Debug for Message<'a> {
|
impl<'a, M: InterfaceMessage> fmt::Debug for Message<'a, M> {
|
||||||
fn fmt(&self, formatter: &mut fmt::Formatter) -> Result<(), fmt::Error> {
|
fn fmt(&self, formatter: &mut fmt::Formatter) -> Result<(), fmt::Error> {
|
||||||
match self {
|
match self {
|
||||||
&Message::Frame(ref frame) => write!(formatter, "Frame({:?})", frame),
|
&Message::Frame(ref frame, ref payload) => write!(formatter, "Frame({:?}, payload: {})", frame, payload.len()),
|
||||||
&Message::Peers(ref peers) => {
|
&Message::Peers(ref peers) => {
|
||||||
try!(write!(formatter, "Peers ["));
|
try!(write!(formatter, "Peers ["));
|
||||||
let mut first = true;
|
let mut first = true;
|
||||||
|
@ -60,7 +60,7 @@ impl<'a> fmt::Debug for Message<'a> {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn decode(data: &[u8]) -> Result<(Options, Message), Error> {
|
pub fn decode<M: InterfaceMessage>(data: &[u8]) -> Result<(Options, Message<M>), Error> {
|
||||||
if data.len() < mem::size_of::<TopHeader>() {
|
if data.len() < mem::size_of::<TopHeader>() {
|
||||||
return Err(Error::ParseError("Empty message"));
|
return Err(Error::ParseError("Empty message"));
|
||||||
}
|
}
|
||||||
|
@ -83,7 +83,10 @@ pub fn decode(data: &[u8]) -> Result<(Options, Message), Error> {
|
||||||
pos += 8;
|
pos += 8;
|
||||||
}
|
}
|
||||||
let msg = match header.msgtype {
|
let msg = match header.msgtype {
|
||||||
0 => Message::Frame(try!(ethernet::decode(&data[pos..]))),
|
0 => {
|
||||||
|
let (header, payload) = try!(M::parse_from(&data[pos..]));
|
||||||
|
Message::Frame(header, payload)
|
||||||
|
},
|
||||||
1 => {
|
1 => {
|
||||||
if data.len() < pos + 1 {
|
if data.len() < pos + 1 {
|
||||||
return Err(Error::ParseError("Empty peers"));
|
return Err(Error::ParseError("Empty peers"));
|
||||||
|
@ -116,12 +119,12 @@ pub fn decode(data: &[u8]) -> Result<(Options, Message), Error> {
|
||||||
Ok((options, msg))
|
Ok((options, msg))
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn encode(options: &Options, msg: &Message, buf: &mut [u8]) -> usize {
|
pub fn encode<M: InterfaceMessage>(options: &Options, msg: &Message<M>, buf: &mut [u8]) -> usize {
|
||||||
assert!(buf.len() >= mem::size_of::<TopHeader>());
|
assert!(buf.len() >= mem::size_of::<TopHeader>());
|
||||||
let mut pos = 0;
|
let mut pos = 0;
|
||||||
let mut header = TopHeader::default();
|
let mut header = TopHeader::default();
|
||||||
header.msgtype = match msg {
|
header.msgtype = match msg {
|
||||||
&Message::Frame(_) => 0,
|
&Message::Frame(_, _) => 0,
|
||||||
&Message::Peers(_) => 1,
|
&Message::Peers(_) => 1,
|
||||||
&Message::GetPeers => 2,
|
&Message::GetPeers => 2,
|
||||||
&Message::Close => 3
|
&Message::Close => 3
|
||||||
|
@ -141,8 +144,8 @@ pub fn encode(options: &Options, msg: &Message, buf: &mut [u8]) -> usize {
|
||||||
pos += 8;
|
pos += 8;
|
||||||
}
|
}
|
||||||
match msg {
|
match msg {
|
||||||
&Message::Frame(ref frame) => {
|
&Message::Frame(ref header, ref payload) => {
|
||||||
pos += ethernet::encode(&frame, &mut buf[pos..])
|
pos += header.encode_to(&payload, &mut buf[pos..])
|
||||||
},
|
},
|
||||||
&Message::Peers(ref peers) => {
|
&Message::Peers(ref peers) => {
|
||||||
let count_pos = pos;
|
let count_pos = pos;
|
||||||
|
@ -186,8 +189,8 @@ fn encode_message_packet() {
|
||||||
let src = Mac([1,2,3,4,5,6]);
|
let src = Mac([1,2,3,4,5,6]);
|
||||||
let dst = Mac([7,8,9,10,11,12]);
|
let dst = Mac([7,8,9,10,11,12]);
|
||||||
let payload = [1,2,3,4,5];
|
let payload = [1,2,3,4,5];
|
||||||
let frame = ethernet::Frame{src: ethernet::EthAddr{mac: src, vlan: 0}, dst: ethernet::EthAddr{mac: dst, vlan: 0}, payload: &payload};
|
let frame = ethernet::Frame{src: ethernet::EthAddr{mac: src, vlan: 0}, dst: ethernet::EthAddr{mac: dst, vlan: 0}};
|
||||||
let msg = Message::Frame(frame);
|
let msg = Message::Frame(frame, &payload);
|
||||||
let mut buf = [0; 1024];
|
let mut buf = [0; 1024];
|
||||||
let size = encode(&options, &msg, &mut buf[..]);
|
let size = encode(&options, &msg, &mut buf[..]);
|
||||||
assert_eq!(size, 25);
|
assert_eq!(size, 25);
|
||||||
|
@ -201,7 +204,7 @@ fn encode_message_packet() {
|
||||||
fn encode_message_peers() {
|
fn encode_message_peers() {
|
||||||
use std::str::FromStr;
|
use std::str::FromStr;
|
||||||
let options = Options::default();
|
let options = Options::default();
|
||||||
let msg = Message::Peers(vec![SocketAddr::from_str("1.2.3.4:123").unwrap(), SocketAddr::from_str("5.6.7.8:12345").unwrap()]);
|
let msg: Message<ethernet::Frame> = Message::Peers(vec![SocketAddr::from_str("1.2.3.4:123").unwrap(), SocketAddr::from_str("5.6.7.8:12345").unwrap()]);
|
||||||
let mut buf = [0; 1024];
|
let mut buf = [0; 1024];
|
||||||
let size = encode(&options, &msg, &mut buf[..]);
|
let size = encode(&options, &msg, &mut buf[..]);
|
||||||
assert_eq!(size, 22);
|
assert_eq!(size, 22);
|
||||||
|
@ -215,7 +218,7 @@ fn encode_message_peers() {
|
||||||
fn encode_option_network_id() {
|
fn encode_option_network_id() {
|
||||||
let mut options = Options::default();
|
let mut options = Options::default();
|
||||||
options.network_id = Some(134);
|
options.network_id = Some(134);
|
||||||
let msg = Message::GetPeers;
|
let msg: Message<ethernet::Frame> = Message::GetPeers;
|
||||||
let mut buf = [0; 1024];
|
let mut buf = [0; 1024];
|
||||||
let size = encode(&options, &msg, &mut buf[..]);
|
let size = encode(&options, &msg, &mut buf[..]);
|
||||||
assert_eq!(size, 16);
|
assert_eq!(size, 16);
|
||||||
|
@ -228,7 +231,7 @@ fn encode_option_network_id() {
|
||||||
#[test]
|
#[test]
|
||||||
fn encode_message_getpeers() {
|
fn encode_message_getpeers() {
|
||||||
let options = Options::default();
|
let options = Options::default();
|
||||||
let msg = Message::GetPeers;
|
let msg: Message<ethernet::Frame> = Message::GetPeers;
|
||||||
let mut buf = [0; 1024];
|
let mut buf = [0; 1024];
|
||||||
let size = encode(&options, &msg, &mut buf[..]);
|
let size = encode(&options, &msg, &mut buf[..]);
|
||||||
assert_eq!(size, 8);
|
assert_eq!(size, 8);
|
||||||
|
@ -241,7 +244,7 @@ fn encode_message_getpeers() {
|
||||||
#[test]
|
#[test]
|
||||||
fn encode_message_close() {
|
fn encode_message_close() {
|
||||||
let options = Options::default();
|
let options = Options::default();
|
||||||
let msg = Message::Close;
|
let msg: Message<ethernet::Frame> = Message::Close;
|
||||||
let mut buf = [0; 1024];
|
let mut buf = [0; 1024];
|
||||||
let size = encode(&options, &msg, &mut buf[..]);
|
let size = encode(&options, &msg, &mut buf[..]);
|
||||||
assert_eq!(size, 8);
|
assert_eq!(size, 8);
|
||||||
|
|
Loading…
Reference in New Issue