1use alloc::vec::Vec;
2use core::fmt::Debug;
3
4use crate::error::InvalidMessage;
5
6pub struct Reader<'a> {
13 buffer: &'a [u8],
15 cursor: usize,
17}
18
19impl<'a> Reader<'a> {
20 pub fn init(bytes: &'a [u8]) -> Self {
23 Reader {
24 buffer: bytes,
25 cursor: 0,
26 }
27 }
28
29 pub fn sub(&mut self, length: usize) -> Result<Self, InvalidMessage> {
33 match self.take(length) {
34 Some(bytes) => Ok(Reader::init(bytes)),
35 None => Err(InvalidMessage::MessageTooShort),
36 }
37 }
38
39 pub fn rest(&mut self) -> &'a [u8] {
44 let rest = &self.buffer[self.cursor..];
45 self.cursor = self.buffer.len();
46 rest
47 }
48
49 pub fn take(&mut self, length: usize) -> Option<&'a [u8]> {
54 if self.left() < length {
55 return None;
56 }
57 let current = self.cursor;
58 self.cursor += length;
59 Some(&self.buffer[current..current + length])
60 }
61
62 pub fn any_left(&self) -> bool {
65 self.cursor < self.buffer.len()
66 }
67
68 pub fn expect_empty(&self, name: &'static str) -> Result<(), InvalidMessage> {
69 match self.any_left() {
70 true => Err(InvalidMessage::TrailingData(name)),
71 false => Ok(()),
72 }
73 }
74
75 pub fn used(&self) -> usize {
78 self.cursor
79 }
80
81 pub fn left(&self) -> usize {
84 self.buffer.len() - self.cursor
85 }
86}
87
88pub trait Codec<'a>: Debug + Sized {
91 fn encode(&self, bytes: &mut Vec<u8>);
94
95 fn read(_: &mut Reader<'a>) -> Result<Self, InvalidMessage>;
99
100 fn get_encoding(&self) -> Vec<u8> {
103 let mut bytes = Vec::new();
104 self.encode(&mut bytes);
105 bytes
106 }
107
108 fn read_bytes(bytes: &'a [u8]) -> Result<Self, InvalidMessage> {
114 let mut reader = Reader::init(bytes);
115 Self::read(&mut reader).and_then(|r| {
116 reader.expect_empty("read_bytes")?;
117 Ok(r)
118 })
119 }
120}
121
122impl Codec<'_> for u8 {
123 fn encode(&self, bytes: &mut Vec<u8>) {
124 bytes.push(*self);
125 }
126
127 fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
128 match r.take(1) {
129 Some(&[byte]) => Ok(byte),
130 _ => Err(InvalidMessage::MissingData("u8")),
131 }
132 }
133}
134
135pub(crate) fn put_u16(v: u16, out: &mut [u8]) {
136 let out: &mut [u8; 2] = (&mut out[..2]).try_into().unwrap();
137 *out = u16::to_be_bytes(v);
138}
139
140impl Codec<'_> for u16 {
141 fn encode(&self, bytes: &mut Vec<u8>) {
142 let mut b16 = [0u8; 2];
143 put_u16(*self, &mut b16);
144 bytes.extend_from_slice(&b16);
145 }
146
147 fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
148 match r.take(2) {
149 Some(&[b1, b2]) => Ok(Self::from_be_bytes([b1, b2])),
150 _ => Err(InvalidMessage::MissingData("u16")),
151 }
152 }
153}
154
155#[allow(non_camel_case_types)]
157#[derive(Debug, Copy, Clone)]
158pub struct u24(pub u32);
159
160#[cfg(any(target_pointer_width = "32", target_pointer_width = "64"))]
161impl From<u24> for usize {
162 #[inline]
163 fn from(v: u24) -> Self {
164 v.0 as Self
165 }
166}
167
168impl Codec<'_> for u24 {
169 fn encode(&self, bytes: &mut Vec<u8>) {
170 let be_bytes = u32::to_be_bytes(self.0);
171 bytes.extend_from_slice(&be_bytes[1..]);
172 }
173
174 fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
175 match r.take(3) {
176 Some(&[a, b, c]) => Ok(Self(u32::from_be_bytes([0, a, b, c]))),
177 _ => Err(InvalidMessage::MissingData("u24")),
178 }
179 }
180}
181
182impl Codec<'_> for u32 {
183 fn encode(&self, bytes: &mut Vec<u8>) {
184 bytes.extend(Self::to_be_bytes(*self));
185 }
186
187 fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
188 match r.take(4) {
189 Some(&[a, b, c, d]) => Ok(Self::from_be_bytes([a, b, c, d])),
190 _ => Err(InvalidMessage::MissingData("u32")),
191 }
192 }
193}
194
195pub(crate) fn put_u64(v: u64, bytes: &mut [u8]) {
196 let bytes: &mut [u8; 8] = (&mut bytes[..8]).try_into().unwrap();
197 *bytes = u64::to_be_bytes(v);
198}
199
200impl Codec<'_> for u64 {
201 fn encode(&self, bytes: &mut Vec<u8>) {
202 let mut b64 = [0u8; 8];
203 put_u64(*self, &mut b64);
204 bytes.extend_from_slice(&b64);
205 }
206
207 fn read(r: &mut Reader<'_>) -> Result<Self, InvalidMessage> {
208 match r.take(8) {
209 Some(&[a, b, c, d, e, f, g, h]) => Ok(Self::from_be_bytes([a, b, c, d, e, f, g, h])),
210 _ => Err(InvalidMessage::MissingData("u64")),
211 }
212 }
213}
214
215impl<'a, T: Codec<'a> + TlsListElement + Debug> Codec<'a> for Vec<T> {
219 fn encode(&self, bytes: &mut Vec<u8>) {
220 let nest = LengthPrefixedBuffer::new(T::SIZE_LEN, bytes);
221
222 for i in self {
223 i.encode(nest.buf);
224 }
225 }
226
227 fn read(r: &mut Reader<'a>) -> Result<Self, InvalidMessage> {
228 let len = T::SIZE_LEN.read(r)?;
229 let mut sub = r.sub(len)?;
230 let mut ret = Self::new();
231 while sub.any_left() {
232 ret.push(T::read(&mut sub)?);
233 }
234
235 Ok(ret)
236 }
237}
238
239pub(crate) trait TlsListElement {
246 const SIZE_LEN: ListLength;
247}
248
249pub(crate) enum ListLength {
255 NonZeroU8 { empty_error: InvalidMessage },
257
258 U16,
260
261 NonZeroU16 { empty_error: InvalidMessage },
263
264 U24 { max: usize, error: InvalidMessage },
266}
267
268impl ListLength {
269 pub(crate) fn read(&self, r: &mut Reader<'_>) -> Result<usize, InvalidMessage> {
270 Ok(match self {
271 Self::NonZeroU8 { empty_error } => match usize::from(u8::read(r)?) {
272 0 => return Err(*empty_error),
273 len => len,
274 },
275 Self::U16 => usize::from(u16::read(r)?),
276 Self::NonZeroU16 { empty_error } => match usize::from(u16::read(r)?) {
277 0 => return Err(*empty_error),
278 len => len,
279 },
280 Self::U24 { max, error } => match usize::from(u24::read(r)?) {
281 len if len > *max => return Err(*error),
282 len => len,
283 },
284 })
285 }
286}
287
288pub(crate) struct LengthPrefixedBuffer<'a> {
290 pub(crate) buf: &'a mut Vec<u8>,
291 len_offset: usize,
292 size_len: ListLength,
293}
294
295impl<'a> LengthPrefixedBuffer<'a> {
296 pub(crate) fn new(size_len: ListLength, buf: &'a mut Vec<u8>) -> Self {
301 let len_offset = buf.len();
302 buf.extend(match size_len {
303 ListLength::NonZeroU8 { .. } => &[0xff][..],
304 ListLength::U16 | ListLength::NonZeroU16 { .. } => &[0xff, 0xff],
305 ListLength::U24 { .. } => &[0xff, 0xff, 0xff],
306 });
307
308 Self {
309 buf,
310 len_offset,
311 size_len,
312 }
313 }
314}
315
316impl Drop for LengthPrefixedBuffer<'_> {
317 fn drop(&mut self) {
319 match self.size_len {
320 ListLength::NonZeroU8 { .. } => {
321 let len = self.buf.len() - self.len_offset - 1;
322 debug_assert!(len <= 0xff);
323 self.buf[self.len_offset] = len as u8;
324 }
325 ListLength::U16 | ListLength::NonZeroU16 { .. } => {
326 let len = self.buf.len() - self.len_offset - 2;
327 debug_assert!(len <= 0xffff);
328 let out: &mut [u8; 2] = (&mut self.buf[self.len_offset..self.len_offset + 2])
329 .try_into()
330 .unwrap();
331 *out = u16::to_be_bytes(len as u16);
332 }
333 ListLength::U24 { .. } => {
334 let len = self.buf.len() - self.len_offset - 3;
335 debug_assert!(len <= 0xff_ffff);
336 let len_bytes = u32::to_be_bytes(len as u32);
337 let out: &mut [u8; 3] = (&mut self.buf[self.len_offset..self.len_offset + 3])
338 .try_into()
339 .unwrap();
340 out.copy_from_slice(&len_bytes[1..]);
341 }
342 }
343 }
344}
345
346#[cfg(test)]
347mod tests {
348 use std::prelude::v1::*;
349 use std::vec;
350
351 use super::*;
352
353 #[test]
354 fn interrupted_length_prefixed_buffer_leaves_maximum_length() {
355 let mut buf = Vec::new();
356 let nested = LengthPrefixedBuffer::new(ListLength::U16, &mut buf);
357 nested.buf.push(0xaa);
358 assert_eq!(nested.buf, &vec![0xff, 0xff, 0xaa]);
359 drop(nested);
364 assert_eq!(buf, vec![0x00, 0x01, 0xaa]);
365 }
366}