use zenoh_buffers::{
reader::{BacktrackableReader, DidntRead, Reader},
writer::{DidntWrite, Writer},
};
use zenoh_protocol::{
common::{iext, imsg},
core::Reliability,
transport::{
fragment::{ext, flag, Fragment, FragmentHeader, TransportSn},
id,
},
};
use crate::{common::extension, RCodec, WCodec, Zenoh080, Zenoh080Header};
impl<W> WCodec<&FragmentHeader, &mut W> for Zenoh080
where
W: Writer,
{
type Output = Result<(), DidntWrite>;
fn write(self, writer: &mut W, x: &FragmentHeader) -> Self::Output {
let FragmentHeader {
reliability,
more,
sn,
ext_qos,
} = x;
let mut header = id::FRAGMENT;
if let Reliability::Reliable = reliability {
header |= flag::R;
}
if *more {
header |= flag::M;
}
if ext_qos != &ext::QoSType::DEFAULT {
header |= flag::Z;
}
self.write(&mut *writer, header)?;
self.write(&mut *writer, sn)?;
if ext_qos != &ext::QoSType::DEFAULT {
self.write(&mut *writer, (*ext_qos, false))?;
}
Ok(())
}
}
impl<R> RCodec<FragmentHeader, &mut R> for Zenoh080
where
R: Reader,
{
type Error = DidntRead;
fn read(self, reader: &mut R) -> Result<FragmentHeader, Self::Error> {
let header: u8 = self.read(&mut *reader)?;
let codec = Zenoh080Header::new(header);
codec.read(reader)
}
}
impl<R> RCodec<FragmentHeader, &mut R> for Zenoh080Header
where
R: Reader,
{
type Error = DidntRead;
fn read(self, reader: &mut R) -> Result<FragmentHeader, Self::Error> {
if imsg::mid(self.header) != id::FRAGMENT {
return Err(DidntRead);
}
let reliability = match imsg::has_flag(self.header, flag::R) {
true => Reliability::Reliable,
false => Reliability::BestEffort,
};
let more = imsg::has_flag(self.header, flag::M);
let sn: TransportSn = self.codec.read(&mut *reader)?;
let mut ext_qos = ext::QoSType::DEFAULT;
let mut has_ext = imsg::has_flag(self.header, flag::Z);
while has_ext {
let ext: u8 = self.codec.read(&mut *reader)?;
let eodec = Zenoh080Header::new(ext);
match iext::eid(ext) {
ext::QoS::ID => {
let (q, ext): (ext::QoSType, bool) = eodec.read(&mut *reader)?;
ext_qos = q;
has_ext = ext;
}
_ => {
has_ext = extension::skip(reader, "Fragment", ext)?;
}
}
}
Ok(FragmentHeader {
reliability,
more,
sn,
ext_qos,
})
}
}
impl<W> WCodec<&Fragment, &mut W> for Zenoh080
where
W: Writer,
{
type Output = Result<(), DidntWrite>;
fn write(self, writer: &mut W, x: &Fragment) -> Self::Output {
let Fragment {
reliability,
more,
sn,
payload,
ext_qos,
} = x;
let header = FragmentHeader {
reliability: *reliability,
more: *more,
sn: *sn,
ext_qos: *ext_qos,
};
self.write(&mut *writer, &header)?;
writer.write_zslice(payload)?;
Ok(())
}
}
impl<R> RCodec<Fragment, &mut R> for Zenoh080
where
R: Reader + BacktrackableReader,
{
type Error = DidntRead;
fn read(self, reader: &mut R) -> Result<Fragment, Self::Error> {
let header: u8 = self.read(&mut *reader)?;
let codec = Zenoh080Header::new(header);
codec.read(reader)
}
}
impl<R> RCodec<Fragment, &mut R> for Zenoh080Header
where
R: Reader + BacktrackableReader,
{
type Error = DidntRead;
fn read(self, reader: &mut R) -> Result<Fragment, Self::Error> {
let header: FragmentHeader = self.read(&mut *reader)?;
let payload = reader.read_zslice(reader.remaining())?;
Ok(Fragment {
reliability: header.reliability,
more: header.more,
sn: header.sn,
ext_qos: header.ext_qos,
payload,
})
}
}