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}