use crate::option_extension::take_extension;
#[derive(Debug)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
pub enum OptItem<'a> {
Option { number: u16, data: &'a [u8] },
Payload(&'a [u8]),
Error(&'static str),
}
pub struct OptPayloadReader<'a> {
slice: &'a [u8],
option_base: u16,
}
impl<'a> OptPayloadReader<'a> {
#[must_use]
pub fn new(slice: &'a [u8]) -> Self {
Self {
slice,
option_base: 0,
}
}
pub(crate) fn new_from(slice: &'a [u8], option_base: u16) -> Self {
Self { slice, option_base }
}
pub(crate) fn destruct(self) -> (&'a [u8], u16) {
(self.slice, self.option_base)
}
}
impl<'a> Iterator for OptPayloadReader<'a> {
type Item = OptItem<'a>;
fn next(&mut self) -> Option<OptItem<'a>> {
let delta_len = *self.slice.first()?;
self.slice = &self.slice[1..];
if delta_len == 0xff {
return Some(OptItem::Payload(core::mem::take(&mut self.slice)));
}
let mut delta = u16::from(delta_len) >> 4;
let mut len = u16::from(delta_len) & 0x0f;
if take_extension(&mut delta, &mut self.slice).is_err() {
return Some(OptItem::Error("Erroneous delta"));
}
if take_extension(&mut len, &mut self.slice).is_err() {
return Some(OptItem::Error("Erroneous len"));
}
if let Some(s) = self.option_base.checked_add(delta) {
self.option_base = s;
} else {
return Some(OptItem::Error("Options wrap"));
}
let len = len.into();
if self.slice.len() < len {
return Some(OptItem::Error("Too short for option"));
}
let (retslice, tail) = self.slice.split_at(len);
self.slice = tail;
Some(OptItem::Option {
number: self.option_base,
data: retslice,
})
}
}