use crate::{Decode, DerOrd, Encode, Error, ErrorKind, Reader, Result, SliceWriter, Writer};
use core::{
cmp::Ordering,
fmt,
ops::{Add, Sub},
};
const MAX_DER_OCTETS: usize = 5;
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 {
Self(value as u32)
}
pub fn is_zero(self) -> bool {
self == Self::ZERO
}
pub fn for_tlv(self) -> Result<Self> {
Self::ONE + self.encoded_len()? + self
}
pub fn saturating_add(self, rhs: Self) -> Self {
Self(self.0.saturating_add(rhs.0))
}
pub fn saturating_sub(self, rhs: Self) -> Self {
Self(self.0.saturating_sub(rhs.0))
}
fn initial_octet(self) -> Option<u8> {
match self.0 {
0x80..=0xFF => Some(0x81),
0x100..=0xFFFF => Some(0x82),
0x10000..=0xFFFFFF => Some(0x83),
0x1000000..=MAX_U32 => Some(0x84),
_ => 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 Sub for Length {
type Output = Result<Self>;
fn sub(self, other: Length) -> Result<Self> {
self.0
.checked_sub(other.0)
.ok_or_else(|| ErrorKind::Overflow.into())
.and_then(TryInto::try_into)
}
}
impl Sub<Length> for Result<Length> {
type Output = Self;
fn sub(self, other: Length) -> Self {
self? - other
}
}
impl From<u8> for Length {
fn from(len: u8) -> Length {
Length(len.into())
}
}
impl From<u16> for Length {
fn from(len: u16) -> Length {
Length(len.into())
}
}
impl From<Length> for u32 {
fn from(length: Length) -> u32 {
length.0
}
}
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<'a> Decode<'a> for Length {
fn decode<R: Reader<'a>>(reader: &mut R) -> Result<Length> {
match reader.read_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 = 0u32;
for _ in 0..nbytes {
decoded_len = decoded_len.checked_shl(8).ok_or(ErrorKind::Overflow)?
| u32::from(reader.read_byte()?);
}
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 Encode 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..=0xFFFFFF => Ok(Length(4)),
0x1000000..=MAX_U32 => Ok(Length(5)),
_ => Err(ErrorKind::Overflow.into()),
}
}
fn encode(&self, writer: &mut dyn Writer) -> Result<()> {
match self.initial_octet() {
Some(tag_byte) => {
writer.write_byte(tag_byte)?;
match self.0.to_be_bytes() {
[0, 0, 0, byte] => writer.write_byte(byte),
[0, 0, bytes @ ..] => writer.write(&bytes),
[0, bytes @ ..] => writer.write(&bytes),
bytes => writer.write(&bytes),
}
}
#[allow(clippy::cast_possible_truncation)]
None => writer.write_byte(self.0 as u8),
}
}
}
impl DerOrd for Length {
fn der_cmp(&self, other: &Self) -> Result<Ordering> {
let mut buf1 = [0u8; MAX_DER_OCTETS];
let mut buf2 = [0u8; MAX_DER_OCTETS];
let mut encoder1 = SliceWriter::new(&mut buf1);
encoder1.encode(self)?;
let mut encoder2 = SliceWriter::new(&mut buf2);
encoder2.encode(other)?;
Ok(encoder1.finish()?.cmp(encoder2.finish()?))
}
}
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::{Decode, DerOrd, Encode, ErrorKind};
use core::cmp::Ordering;
#[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)
);
}
#[test]
fn der_ord() {
assert_eq!(Length::ONE.der_cmp(&Length::MAX).unwrap(), Ordering::Less);
}
}