use std::fmt; use std::net::{SocketAddr, SocketAddrV4, Ipv4Addr, SocketAddrV6, Ipv6Addr}; use super::types::{Error, NetworkId, Range}; use super::util::{Encoder, memcopy}; use super::crypto::Crypto; const MAGIC: [u8; 3] = [0x76, 0x70, 0x6e]; pub const VERSION: u8 = 1; const NETWORK_ID_BYTES: usize = 8; #[derive(Clone)] #[repr(packed)] struct TopHeader { magic: [u8; 3], version: u8, crypto_method : u8, _reserved: u8, flags: u8, msgtype: u8 } impl TopHeader { #[inline(always)] pub fn size() -> usize { 8 } pub fn read_from(data: &[u8]) -> Result<(TopHeader, usize), Error> { if data.len() < TopHeader::size() { return Err(Error::ParseError("Empty message")); } let mut header = TopHeader::default(); for i in 0..3 { header.magic[i] = data[i]; } header.version = data[3]; header.crypto_method = data[4]; header.flags = data[6]; header.msgtype = data[7]; Ok((header, TopHeader::size())) } pub fn write_to(&self, data: &mut [u8]) -> usize { for i in 0..3 { data[i] = self.magic[i]; } data[3] = self.version; data[4] = self.crypto_method; data[6] = self.flags; data[7] = self.msgtype; TopHeader::size() } } impl Default for TopHeader { fn default() -> Self { TopHeader{magic: MAGIC, version: VERSION, crypto_method: 0, _reserved: 0, flags: 0, msgtype: 0} } } #[derive(Default, Debug, PartialEq, Eq)] pub struct Options { pub network_id: Option, } #[derive(PartialEq)] pub enum Message<'a> { Data(&'a[u8]), Peers(Vec), Init(u8, Vec), Close, } impl<'a> fmt::Debug for Message<'a> { fn fmt(&self, formatter: &mut fmt::Formatter) -> Result<(), fmt::Error> { match self { &Message::Data(ref data) => write!(formatter, "Data({} bytes)", data.len()), &Message::Peers(ref peers) => { try!(write!(formatter, "Peers [")); let mut first = true; for p in peers { if !first { try!(write!(formatter, ", ")); } first = false; try!(write!(formatter, "{}", p)); } write!(formatter, "]") }, &Message::Init(stage, ref data) => write!(formatter, "Init(stage={}, {:?})", stage, data), &Message::Close => write!(formatter, "Close"), } } } pub fn decode<'a>(data: &'a mut [u8], crypto: &mut Crypto) -> Result<(Options, Message<'a>), Error> { let mut end = data.len(); let (header, mut pos) = try!(TopHeader::read_from(&data[..end])); if header.magic != MAGIC { return Err(Error::ParseError("Wrong protocol")); } if header.version != VERSION { return Err(Error::ParseError("Wrong version")); } if header.crypto_method != crypto.method() { return Err(Error::CryptoError("Wrong crypto method")); } if crypto.method() > 0 { let len = crypto.nonce_bytes(); if end < pos + len { return Err(Error::ParseError("Truncated crypto header")); } { let (before, after) = data.split_at_mut(pos); let (nonce, crypto_data) = after.split_at_mut(len); pos += len; end = try!(crypto.decrypt(crypto_data, nonce, &before[..TopHeader::size()])) + pos; } assert_eq!(end, data.len()-crypto.additional_bytes()); } let mut options = Options::default(); if header.flags & 0x01 > 0 { if end < pos + NETWORK_ID_BYTES { return Err(Error::ParseError("Truncated options")); } options.network_id = Some(Encoder::read_u64(&data[pos..pos+NETWORK_ID_BYTES])); pos += NETWORK_ID_BYTES; } let msg = match header.msgtype { 0 => Message::Data(&data[pos..end]), 1 => { if end < pos + 1 { return Err(Error::ParseError("Empty peers")); } let mut peers = Vec::new(); let count = data[pos]; pos += 1; let len = count as usize * 6; if end < pos + len { return Err(Error::ParseError("Peer data too short")); } for _ in 0..count { let ip = &data[pos..]; pos += 4; let port = Encoder::read_u16(&data[pos..]); pos += 2; let addr = SocketAddr::V4(SocketAddrV4::new(Ipv4Addr::new(ip[0], ip[1], ip[2], ip[3]), port)); peers.push(addr); } let count = data[pos]; pos += 1; let len = count as usize * 18; if end < pos + len { return Err(Error::ParseError("Peer data too short")); } for _ in 0..count { let mut ip = [0u16; 8]; for i in 0..8 { ip[i] = Encoder::read_u16(&data[pos..]); pos += 2; } let port = Encoder::read_u16(&data[pos..]); pos += 2; let addr = SocketAddr::V6(SocketAddrV6::new(Ipv6Addr::new(ip[0], ip[1], ip[2], ip[3], ip[4], ip[5], ip[6], ip[7]), port, 0, 0)); peers.push(addr); } Message::Peers(peers) }, 2 => { if end < pos + 2 { return Err(Error::ParseError("Init data too short")); } let stage = data[pos]; pos += 1; let count = data[pos] as usize; pos += 1; let mut addrs = Vec::with_capacity(count); for _ in 0..count { let (range, read) = try!(Range::read_from(&data[pos..end])); pos += read; addrs.push(range); } Message::Init(stage, addrs) }, 3 => Message::Close, _ => return Err(Error::ParseError("Unknown message type")) }; Ok((options, msg)) } pub fn encode(options: &Options, msg: &Message, buf: &mut [u8], crypto: &mut Crypto) -> usize { let mut pos = 0; let mut header = TopHeader::default(); header.msgtype = match msg { &Message::Data(_) => 0, &Message::Peers(_) => 1, &Message::Init(_, _) => 2, &Message::Close => 3 }; header.crypto_method = crypto.method(); if options.network_id.is_some() { header.flags |= 0x01; } pos += header.write_to(&mut buf[pos..]); pos += crypto.nonce_bytes(); if let Some(id) = options.network_id { assert!(buf.len() >= pos + NETWORK_ID_BYTES); Encoder::write_u64(id, &mut buf[pos..]); pos += NETWORK_ID_BYTES; } match msg { &Message::Data(ref data) => { memcopy(data, &mut buf[pos..]); pos += data.len(); }, &Message::Peers(ref peers) => { let mut v4addrs = Vec::new(); let mut v6addrs = Vec::new(); for p in peers { match p { &SocketAddr::V4(addr) => v4addrs.push(addr), &SocketAddr::V6(addr) => v6addrs.push(addr) } }; assert!(v4addrs.len() <= 255); assert!(v6addrs.len() <= 255); assert!(buf.len() >= pos + 2 + v4addrs.len() * 6 + v6addrs.len() * 18); buf[pos] = v4addrs.len() as u8; pos += 1; for addr in v4addrs { let ip = addr.ip().octets(); for i in 0..4 { buf[pos+i] = ip[i]; } pos += 4; Encoder::write_u16(addr.port(), &mut buf[pos..]); pos += 2; }; buf[pos] = v6addrs.len() as u8; pos += 1; for addr in v6addrs { let ip = addr.ip().segments(); for i in 0..8 { Encoder::write_u16(ip[i], &mut buf[pos..]); pos += 2; } Encoder::write_u16(addr.port(), &mut buf[pos..]); pos += 2; }; }, &Message::Init(stage, ref ranges) => { assert!(buf.len() >= pos + 2); buf[pos] = stage; pos += 1; assert!(ranges.len() <= 255); buf[pos] = ranges.len() as u8; pos += 1; for range in ranges { pos += range.write_to(&mut buf[pos..]); } }, &Message::Close => { } } if crypto.method() > 0 { let (header, rest) = buf.split_at_mut(TopHeader::size()); let (nonce, rest) = rest.split_at_mut(crypto.nonce_bytes()); let crypto_start = header.len() + nonce.len(); assert!(rest.len() >= pos - crypto_start + crypto.additional_bytes()); pos = crypto.encrypt(rest, pos-crypto_start, nonce, header) + crypto_start; } pos }