use super::super::iana::OptionCode;
use super::super::message_builder::OptBuilder;
use super::super::net::IpAddr;
use super::super::octets::{
Compose, FormError, OctetsBuilder, Parse, ParseError, Parser, ShortBuf,
};
use super::CodeOptData;
const ERR_ADDR_LEN: &str = "invalid address length in client subnet option";
#[derive(Clone, Copy, Debug, Eq, Hash, Ord, PartialEq, PartialOrd)]
pub struct ClientSubnet {
source_prefix_len: u8,
scope_prefix_len: u8,
addr: IpAddr,
}
impl ClientSubnet {
pub fn new(
source_prefix_len: u8,
scope_prefix_len: u8,
addr: IpAddr,
) -> ClientSubnet {
let source_prefix_len = normalize_prefix_len(addr, source_prefix_len);
let scope_prefix_len = normalize_prefix_len(addr, scope_prefix_len);
let (addr, _) = addr_apply_mask(addr, source_prefix_len);
ClientSubnet {
source_prefix_len,
scope_prefix_len,
addr,
}
}
pub fn push<Target: OctetsBuilder + AsRef<[u8]> + AsMut<[u8]>>(
builder: &mut OptBuilder<Target>,
source_prefix_len: u8,
scope_prefix_len: u8,
addr: IpAddr,
) -> Result<(), ShortBuf> {
builder.push(&Self::new(source_prefix_len, scope_prefix_len, addr))
}
pub fn source_prefix_len(&self) -> u8 {
self.source_prefix_len
}
pub fn scope_prefix_len(&self) -> u8 {
self.scope_prefix_len
}
pub fn addr(&self) -> IpAddr {
self.addr
}
}
impl<Ref: AsRef<[u8]>> Parse<Ref> for ClientSubnet {
fn parse(parser: &mut Parser<Ref>) -> Result<Self, ParseError> {
let family = parser.parse_u16()?;
let source_prefix_len = parser.parse_u8()?;
let scope_prefix_len = parser.parse_u8()?;
let prefix_bytes = prefix_bytes(usize::from(source_prefix_len));
let addr = match family {
1 => {
let mut buf = [0; 4];
if prefix_bytes > buf.len() {
return Err(ParseError::form_error(ERR_ADDR_LEN));
}
parser
.parse_buf(&mut buf[..prefix_bytes])
.map_err(|_| ParseError::form_error(ERR_ADDR_LEN))?;
if parser.remaining() != 0 {
return Err(ParseError::form_error(ERR_ADDR_LEN));
}
IpAddr::from(buf)
}
2 => {
let mut buf = [0; 16];
if prefix_bytes > buf.len() {
return Err(ParseError::form_error(ERR_ADDR_LEN));
}
parser
.parse_buf(&mut buf[..prefix_bytes])
.map_err(|_| ParseError::form_error(ERR_ADDR_LEN))?;
if parser.remaining() != 0 {
return Err(ParseError::form_error(ERR_ADDR_LEN));
}
IpAddr::from(buf)
}
_ => {
return Err(FormError::new(
"invalid client subnet address family",
)
.into())
}
};
let (addr, modified) = addr_apply_mask(addr, source_prefix_len);
if modified {
return Err(ParseError::form_error(ERR_ADDR_LEN));
}
Ok(ClientSubnet {
source_prefix_len,
scope_prefix_len,
addr,
})
}
fn skip(parser: &mut Parser<Ref>) -> Result<(), ParseError> {
parser.advance_to_end();
Ok(())
}
}
impl Compose for ClientSubnet {
fn compose<T: OctetsBuilder + AsMut<[u8]>>(
&self,
target: &mut T,
) -> Result<(), ShortBuf> {
let prefix_bytes = prefix_bytes(self.source_prefix_len as usize);
target.append_all(|target| match self.addr {
IpAddr::V4(addr) => {
1u16.compose(target)?;
self.source_prefix_len.compose(target)?;
self.scope_prefix_len.compose(target)?;
let array = addr.octets();
if prefix_bytes > array.len() {
return Err(ShortBuf);
}
target.append_slice(&array[..prefix_bytes])
}
IpAddr::V6(addr) => {
2u16.compose(target)?;
self.source_prefix_len.compose(target)?;
self.scope_prefix_len.compose(target)?;
let array = addr.octets();
if prefix_bytes > array.len() {
return Err(ShortBuf);
}
target.append_slice(&array[..prefix_bytes])
}
})
}
}
fn prefix_bytes(bits: usize) -> usize {
(bits + 7) / 8
}
fn apply_bit_mask(buf: &mut [u8], mask: usize) -> bool {
let mut modified = false;
let mut p = mask / 8;
if p >= buf.len() {
return modified;
}
let bits = mask % 8;
if bits != 0 {
if buf[p].trailing_zeros() < (8 - bits) as u32 {
buf[p] &= 0xff << (8 - bits);
modified = true;
}
p += 1;
}
while p < buf.len() {
if buf[p] != 0 {
buf[p] = 0;
modified = true;
}
p += 1;
}
modified
}
fn addr_apply_mask(addr: IpAddr, len: u8) -> (IpAddr, bool) {
match addr {
IpAddr::V4(a) => {
let mut array = a.octets();
let m = apply_bit_mask(&mut array, len as usize);
(array.into(), m)
}
IpAddr::V6(a) => {
let mut array = a.octets();
let m = apply_bit_mask(&mut array, len as usize);
(array.into(), m)
}
}
}
fn normalize_prefix_len(addr: IpAddr, len: u8) -> u8 {
let max = match addr {
IpAddr::V4(_) => 32,
IpAddr::V6(_) => 128,
};
core::cmp::min(len, max)
}
impl CodeOptData for ClientSubnet {
const CODE: OptionCode = OptionCode::ClientSubnet;
}
#[cfg(test)]
mod tests {
use super::*;
use crate::base::octets::Octets512;
macro_rules! check {
($name:ident, $addr:expr, $prefix:expr, $exp:expr, $ok:expr) => {
#[test]
fn $name() {
let addr = $addr.parse().unwrap();
let opt = ClientSubnet::new($prefix, 0, addr);
assert_eq!(opt.addr(), $exp.parse::<IpAddr>().unwrap());
let mut opt_ = opt.clone();
opt_.addr = addr;
let mut buf = Octets512::new();
opt_.compose(&mut buf).unwrap();
match ClientSubnet::parse(&mut Parser::from_ref(&buf)) {
Ok(v) => assert_eq!(opt, v),
Err(_) => assert!(!$ok),
}
}
};
}
check!(prefix_at_boundary_v4, "192.0.2.0", 24, "192.0.2.0", true);
check!(prefix_at_boundary_v6, "2001:db8::", 32, "2001:db8::", true);
check!(prefix_no_truncation, "192.0.2.0", 23, "192.0.2.0", true);
check!(prefix_need_truncation, "192.0.2.0", 22, "192.0.0.0", false);
check!(prefix_min, "192.0.2.0", 0, "0.0.0.0", true);
check!(prefix_max, "192.0.2.0", 32, "192.0.2.0", true);
check!(prefix_too_long, "192.0.2.0", 100, "192.0.2.0", false);
}