use crate::{Decodable, Decoder, Encodable, Encoder, Error, ErrorKind, Result};
use core::{
convert::{TryFrom, TryInto},
fmt,
ops::Add,
};
const MAX_U32: u32 = 0xfff_ffff;
#[derive(Copy, Clone, Debug, Default, Eq, PartialEq, PartialOrd, Ord)]
pub struct Length(u32);
impl Length {
pub const ZERO: Self = Self(0);
pub const ONE: Self = Self(1);
pub const MAX: Self = Self(MAX_U32);
pub const fn new(value: u16) -> Self {
Length(value as u32)
}
pub fn for_tlv(self) -> Result<Self> {
Length(1) + self.encoded_len()? + self
}
fn initial_octet(self) -> Option<u8> {
match self.0 {
0x80..=0xFF => Some(0x81),
0x100..=0xFFFF => Some(0x82),
0x10000..=MAX_U32 => Some(0x83),
_ => None,
}
}
}
impl Add for Length {
type Output = Result<Self>;
fn add(self, other: Self) -> Result<Self> {
self.0
.checked_add(other.0)
.ok_or_else(|| ErrorKind::Overflow.into())
.and_then(TryInto::try_into)
}
}
impl Add<u8> for Length {
type Output = Result<Self>;
fn add(self, other: u8) -> Result<Self> {
self + Length::from(other)
}
}
impl Add<u16> for Length {
type Output = Result<Self>;
fn add(self, other: u16) -> Result<Self> {
self + Length::from(other)
}
}
impl Add<u32> for Length {
type Output = Result<Self>;
fn add(self, other: u32) -> Result<Self> {
self + Length::try_from(other)?
}
}
impl Add<usize> for Length {
type Output = Result<Self>;
fn add(self, other: usize) -> Result<Self> {
self + Length::try_from(other)?
}
}
impl Add<Length> for Result<Length> {
type Output = Self;
fn add(self, other: Length) -> Self {
self? + other
}
}
impl From<u8> for Length {
fn from(len: u8) -> Length {
Length(len as u32)
}
}
impl From<u16> for Length {
fn from(len: u16) -> Length {
Length(len as u32)
}
}
impl TryFrom<u32> for Length {
type Error = Error;
fn try_from(len: u32) -> Result<Length> {
if len <= Self::MAX.0 {
Ok(Length(len))
} else {
Err(ErrorKind::Overflow.into())
}
}
}
impl TryFrom<usize> for Length {
type Error = Error;
fn try_from(len: usize) -> Result<Length> {
u32::try_from(len)
.map_err(|_| ErrorKind::Overflow)?
.try_into()
}
}
impl TryFrom<Length> for usize {
type Error = Error;
fn try_from(len: Length) -> Result<usize> {
len.0.try_into().map_err(|_| ErrorKind::Overflow.into())
}
}
impl Decodable<'_> for Length {
fn decode(decoder: &mut Decoder<'_>) -> Result<Length> {
match decoder.byte()? {
len if len < 0x80 => Ok(len.into()),
tag @ 0x81..=0x84 => {
let nbytes = tag.checked_sub(0x80).ok_or(ErrorKind::Overlength)? as usize;
debug_assert!(nbytes <= 4);
let mut decoded_len = 0;
for _ in 0..nbytes {
decoded_len = (decoded_len << 8) | decoder.byte()? as u32;
}
let length = Length::try_from(decoded_len)?;
if length.initial_octet() == Some(tag) {
Ok(length)
} else {
Err(ErrorKind::Overlength.into())
}
}
_ => {
Err(ErrorKind::Overlength.into())
}
}
}
}
impl Encodable for Length {
fn encoded_len(&self) -> Result<Length> {
match self.0 {
0..=0x7F => Ok(Length(1)),
0x80..=0xFF => Ok(Length(2)),
0x100..=0xFFFF => Ok(Length(3)),
0x10000..=MAX_U32 => Ok(Length(4)),
_ => Err(ErrorKind::Overflow.into()),
}
}
fn encode(&self, encoder: &mut Encoder<'_>) -> Result<()> {
if let Some(tag_byte) = self.initial_octet() {
encoder.byte(tag_byte)?;
match self.0.to_be_bytes() {
[0, 0, 0, byte] => encoder.byte(byte),
[0, 0, bytes @ ..] => encoder.bytes(&bytes),
[0, bytes @ ..] => encoder.bytes(&bytes),
_ => Err(ErrorKind::Overlength.into()),
}
} else {
encoder.byte(self.0 as u8)
}
}
}
impl fmt::Display for Length {
fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
self.0.fmt(f)
}
}
#[cfg(test)]
mod tests {
use super::Length;
use crate::{Decodable, Encodable, ErrorKind};
use core::convert::TryFrom;
#[test]
fn decode() {
assert_eq!(Length::ZERO, Length::from_der(&[0x00]).unwrap());
assert_eq!(Length::from(0x7Fu8), Length::from_der(&[0x7F]).unwrap());
assert_eq!(
Length::from(0x80u8),
Length::from_der(&[0x81, 0x80]).unwrap()
);
assert_eq!(
Length::from(0xFFu8),
Length::from_der(&[0x81, 0xFF]).unwrap()
);
assert_eq!(
Length::from(0x100u16),
Length::from_der(&[0x82, 0x01, 0x00]).unwrap()
);
assert_eq!(
Length::try_from(0x10000u32).unwrap(),
Length::from_der(&[0x83, 0x01, 0x00, 0x00]).unwrap()
);
}
#[test]
fn encode() {
let mut buffer = [0u8; 4];
assert_eq!(&[0x00], Length::ZERO.encode_to_slice(&mut buffer).unwrap());
assert_eq!(
&[0x7F],
Length::from(0x7Fu8).encode_to_slice(&mut buffer).unwrap()
);
assert_eq!(
&[0x81, 0x80],
Length::from(0x80u8).encode_to_slice(&mut buffer).unwrap()
);
assert_eq!(
&[0x81, 0xFF],
Length::from(0xFFu8).encode_to_slice(&mut buffer).unwrap()
);
assert_eq!(
&[0x82, 0x01, 0x00],
Length::from(0x100u16).encode_to_slice(&mut buffer).unwrap()
);
assert_eq!(
&[0x83, 0x01, 0x00, 0x00],
Length::try_from(0x10000u32)
.unwrap()
.encode_to_slice(&mut buffer)
.unwrap()
);
}
#[test]
fn reject_indefinite_lengths() {
assert!(Length::from_der(&[0x80]).is_err());
}
#[test]
fn add_overflows_when_max_length_exceeded() {
let result = Length::MAX + Length::ONE;
assert_eq!(
result.err().map(|err| err.kind()),
Some(ErrorKind::Overflow)
);
}
}