1use alloc::vec::Vec;
2use core::fmt::Debug;
3use core::marker::PhantomData;
4
5use crate::error::InvalidMessage;
6
7pub struct Reader<'a> {
14    buffer: &'a [u8],
16    cursor: usize,
18}
19
20impl<'a> Reader<'a> {
21    pub fn init(bytes: &'a [u8]) -> Self {
24        Reader {
25            buffer: bytes,
26            cursor: 0,
27        }
28    }
29
30    pub fn sub(&mut self, length: usize) -> Result<Self, InvalidMessage> {
34        match self.take(length) {
35            Some(bytes) => Ok(Reader::init(bytes)),
36            None => Err(InvalidMessage::MessageTooShort),
37        }
38    }
39
40    pub fn rest(&mut self) -> &'a [u8] {
45        let rest = &self.buffer[self.cursor..];
46        self.cursor = self.buffer.len();
47        rest
48    }
49
50    pub fn take(&mut self, length: usize) -> Option<&'a [u8]> {
55        if self.left() < length {
56            return None;
57        }
58        let current = self.cursor;
59        self.cursor += length;
60        Some(&self.buffer[current..current + length])
61    }
62
63    pub fn any_left(&self) -> bool {
66        self.cursor < self.buffer.len()
67    }
68
69    pub fn expect_empty(&self, name: &'static str) -> Result<(), InvalidMessage> {
70        match self.any_left() {
71            true => Err(InvalidMessage::TrailingData(name)),
72            false => Ok(()),
73        }
74    }
75
76    pub fn used(&self) -> usize {
79        self.cursor
80    }
81
82    pub fn left(&self) -> usize {
85        self.buffer.len() - self.cursor
86    }
87}
88
89pub trait Codec<'a>: Debug + Sized {
92    fn encode(&self, bytes: &mut Vec<u8>);
95
96    fn read(_: &mut Reader<'a>) -> Result<Self, InvalidMessage>;
100
101    fn get_encoding(&self) -> Vec<u8> {
104        let mut bytes = Vec::new();
105        self.encode(&mut bytes);
106        bytes
107    }
108
109    fn read_bytes(bytes: &'a [u8]) -> Result<Self, InvalidMessage> {
115        let mut reader = Reader::init(bytes);
116        Self::read(&mut reader).and_then(|r| {
117            reader.expect_empty("read_bytes")?;
118            Ok(r)
119        })
120    }
121}
122
123impl Codec<'_> for u8 {
124    fn encode(&self, bytes: &mut Vec<u8>) {
125        bytes.push(*self);
126    }
127
128    fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
129        match r.take(1) {
130            Some(&[byte]) => Ok(byte),
131            _ => Err(InvalidMessage::MissingData("u8")),
132        }
133    }
134}
135
136pub(crate) fn put_u16(v: u16, out: &mut [u8]) {
137    let out: &mut [u8; 2] = (&mut out[..2]).try_into().unwrap();
138    *out = u16::to_be_bytes(v);
139}
140
141impl Codec<'_> for u16 {
142    fn encode(&self, bytes: &mut Vec<u8>) {
143        let mut b16 = [0u8; 2];
144        put_u16(*self, &mut b16);
145        bytes.extend_from_slice(&b16);
146    }
147
148    fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
149        match r.take(2) {
150            Some(&[b1, b2]) => Ok(Self::from_be_bytes([b1, b2])),
151            _ => Err(InvalidMessage::MissingData("u16")),
152        }
153    }
154}
155
156#[allow(non_camel_case_types)]
158#[derive(Debug, Copy, Clone)]
159pub struct u24(pub u32);
160
161#[cfg(any(target_pointer_width = "32", target_pointer_width = "64"))]
162impl From<u24> for usize {
163    #[inline]
164    fn from(v: u24) -> Self {
165        v.0 as Self
166    }
167}
168
169impl Codec<'_> for u24 {
170    fn encode(&self, bytes: &mut Vec<u8>) {
171        let be_bytes = u32::to_be_bytes(self.0);
172        bytes.extend_from_slice(&be_bytes[1..]);
173    }
174
175    fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
176        match r.take(3) {
177            Some(&[a, b, c]) => Ok(Self(u32::from_be_bytes([0, a, b, c]))),
178            _ => Err(InvalidMessage::MissingData("u24")),
179        }
180    }
181}
182
183impl Codec<'_> for u32 {
184    fn encode(&self, bytes: &mut Vec<u8>) {
185        bytes.extend(Self::to_be_bytes(*self));
186    }
187
188    fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
189        match r.take(4) {
190            Some(&[a, b, c, d]) => Ok(Self::from_be_bytes([a, b, c, d])),
191            _ => Err(InvalidMessage::MissingData("u32")),
192        }
193    }
194}
195
196pub(crate) fn put_u64(v: u64, bytes: &mut [u8]) {
197    let bytes: &mut [u8; 8] = (&mut bytes[..8]).try_into().unwrap();
198    *bytes = u64::to_be_bytes(v);
199}
200
201impl Codec<'_> for u64 {
202    fn encode(&self, bytes: &mut Vec<u8>) {
203        let mut b64 = [0u8; 8];
204        put_u64(*self, &mut b64);
205        bytes.extend_from_slice(&b64);
206    }
207
208    fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
209        match r.take(8) {
210            Some(&[a, b, c, d, e, f, g, h]) => Ok(Self::from_be_bytes([a, b, c, d, e, f, g, h])),
211            _ => Err(InvalidMessage::MissingData("u64")),
212        }
213    }
214}
215
216impl<'a, T: Codec<'a> + TlsListElement + Debug> Codec<'a> for Vec<T> {
220    fn encode(&self, bytes: &mut Vec<u8>) {
221        let nest = LengthPrefixedBuffer::new(T::SIZE_LEN, bytes);
222
223        for i in self {
224            i.encode(nest.buf);
225        }
226    }
227
228    fn read(r: &mut Reader<'a>) -> Result<Self, InvalidMessage> {
229        let mut ret = Self::new();
230        for item in TlsListIter::<T>::new(r)? {
231            ret.push(item?);
232        }
233
234        Ok(ret)
235    }
236}
237
238pub(crate) struct TlsListIter<'a, T: Codec<'a> + TlsListElement + Debug> {
243    sub: Reader<'a>,
244    _t: PhantomData<T>,
245}
246
247impl<'a, T: Codec<'a> + TlsListElement + Debug> TlsListIter<'a, T> {
248    pub(crate) fn new(r: &mut Reader<'a>) -> Result<Self, InvalidMessage> {
249        let len = T::SIZE_LEN.read(r)?;
250        let sub = r.sub(len)?;
251        Ok(Self {
252            sub,
253            _t: PhantomData,
254        })
255    }
256}
257
258impl<'a, T: Codec<'a> + TlsListElement + Debug> Iterator for TlsListIter<'a, T> {
259    type Item = Result<T, InvalidMessage>;
260
261    fn next(&mut self) -> Option<Self::Item> {
262        match self.sub.any_left() {
263            true => Some(T::read(&mut self.sub)),
264            false => None,
265        }
266    }
267}
268
269impl Codec<'_> for () {
270    fn encode(&self, _: &mut Vec<u8>) {}
271
272    fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
273        r.expect_empty("Empty")
274    }
275}
276
277pub(crate) trait TlsListElement {
284    const SIZE_LEN: ListLength;
285}
286
287pub(crate) enum ListLength {
293    NonZeroU8 { empty_error: InvalidMessage },
295
296    U16,
298
299    NonZeroU16 { empty_error: InvalidMessage },
301
302    U24 { max: usize, error: InvalidMessage },
304}
305
306impl ListLength {
307    pub(crate) fn read(&self, r: &mut Reader<'_>) -> Result<usize, InvalidMessage> {
308        Ok(match self {
309            Self::NonZeroU8 { empty_error } => match usize::from(u8::read(r)?) {
310                0 => return Err(*empty_error),
311                len => len,
312            },
313            Self::U16 => usize::from(u16::read(r)?),
314            Self::NonZeroU16 { empty_error } => match usize::from(u16::read(r)?) {
315                0 => return Err(*empty_error),
316                len => len,
317            },
318            Self::U24 { max, error } => match usize::from(u24::read(r)?) {
319                len if len > *max => return Err(*error),
320                len => len,
321            },
322        })
323    }
324}
325
326pub(crate) struct LengthPrefixedBuffer<'a> {
328    pub(crate) buf: &'a mut Vec<u8>,
329    len_offset: usize,
330    size_len: ListLength,
331}
332
333impl<'a> LengthPrefixedBuffer<'a> {
334    pub(crate) fn new(size_len: ListLength, buf: &'a mut Vec<u8>) -> Self {
339        let len_offset = buf.len();
340        buf.extend(match size_len {
341            ListLength::NonZeroU8 { .. } => &[0xff][..],
342            ListLength::U16 | ListLength::NonZeroU16 { .. } => &[0xff, 0xff],
343            ListLength::U24 { .. } => &[0xff, 0xff, 0xff],
344        });
345
346        Self {
347            buf,
348            len_offset,
349            size_len,
350        }
351    }
352}
353
354impl Drop for LengthPrefixedBuffer<'_> {
355    fn drop(&mut self) {
357        match self.size_len {
358            ListLength::NonZeroU8 { .. } => {
359                let len = self.buf.len() - self.len_offset - 1;
360                debug_assert!(len <= 0xff);
361                self.buf[self.len_offset] = len as u8;
362            }
363            ListLength::U16 | ListLength::NonZeroU16 { .. } => {
364                let len = self.buf.len() - self.len_offset - 2;
365                debug_assert!(len <= 0xffff);
366                let out: &mut [u8; 2] = (&mut self.buf[self.len_offset..self.len_offset + 2])
367                    .try_into()
368                    .unwrap();
369                *out = u16::to_be_bytes(len as u16);
370            }
371            ListLength::U24 { .. } => {
372                let len = self.buf.len() - self.len_offset - 3;
373                debug_assert!(len <= 0xff_ffff);
374                let len_bytes = u32::to_be_bytes(len as u32);
375                let out: &mut [u8; 3] = (&mut self.buf[self.len_offset..self.len_offset + 3])
376                    .try_into()
377                    .unwrap();
378                out.copy_from_slice(&len_bytes[1..]);
379            }
380        }
381    }
382}
383
384#[cfg(test)]
385mod tests {
386    use std::prelude::v1::*;
387    use std::vec;
388
389    use super::*;
390
391    #[test]
392    fn interrupted_length_prefixed_buffer_leaves_maximum_length() {
393        let mut buf = Vec::new();
394        let nested = LengthPrefixedBuffer::new(ListLength::U16, &mut buf);
395        nested.buf.push(0xaa);
396        assert_eq!(nested.buf, &vec![0xff, 0xff, 0xaa]);
397        drop(nested);
402        assert_eq!(buf, vec![0x00, 0x01, 0xaa]);
403    }
404}