// SPDX-License-Identifier: GPL-3.0-only // SPDX-FileCopyrightText: 2023 Denis Drakhnia use std::fmt; use std::io::{self, Write as _}; use std::mem; use std::slice; use std::str; use super::types::Str; use super::Error; pub trait GetKeyValue<'a>: Sized { fn get_key_value(cur: &mut Cursor<'a>) -> Result; } impl<'a> GetKeyValue<'a> for &'a [u8] { fn get_key_value(cur: &mut Cursor<'a>) -> Result { cur.get_key_value_raw() } } impl<'a> GetKeyValue<'a> for Str<&'a [u8]> { fn get_key_value(cur: &mut Cursor<'a>) -> Result { cur.get_key_value_raw().map(Str) } } impl<'a> GetKeyValue<'a> for &'a str { fn get_key_value(cur: &mut Cursor<'a>) -> Result { let raw = cur.get_key_value_raw()?; str::from_utf8(raw).map_err(|_| Error::InvalidString) } } impl<'a> GetKeyValue<'a> for bool { fn get_key_value(cur: &mut Cursor<'a>) -> Result { match cur.get_key_value_raw()? { b"0" => Ok(false), b"1" => Ok(true), _ => Err(Error::InvalidPacket), } } } macro_rules! impl_get_value { ($($t:ty),+ $(,)?) => { $(impl<'a> GetKeyValue<'a> for $t { fn get_key_value(cur: &mut Cursor<'a>) -> Result { cur.get_key_value::<&str>()?.parse().map_err(|_| Error::InvalidPacket) } })+ }; } impl_get_value! { u8, u16, u32, u64, i8, i16, i32, i64, } // TODO: impl GetKeyValue for f32 and f64 #[derive(Copy, Clone)] pub struct Cursor<'a> { buffer: &'a [u8], } macro_rules! impl_get { ($($n:ident: $t:ty = $f:ident),+ $(,)?) => ( $(#[inline] pub fn $n(&mut self) -> Result<$t, Error> { const N: usize = mem::size_of::<$t>(); self.get_array::().map(<$t>::$f) })+ ); } impl<'a> Cursor<'a> { pub fn new(buffer: &'a [u8]) -> Self { Self { buffer } } pub fn end(self) -> &'a [u8] { self.buffer } #[inline(always)] pub fn remaining(&self) -> usize { self.buffer.len() } #[inline(always)] pub fn has_remaining(&self) -> bool { self.remaining() != 0 } pub fn get_bytes(&mut self, count: usize) -> Result<&'a [u8], Error> { if count <= self.remaining() { let (head, tail) = self.buffer.split_at(count); self.buffer = tail; Ok(head) } else { Err(Error::UnexpectedEnd) } } pub fn advance(&mut self, count: usize) -> Result<(), Error> { self.get_bytes(count).map(|_| ()) } pub fn get_array(&mut self) -> Result<[u8; N], Error> { self.get_bytes(N).map(|s| { let mut array = [0; N]; array.copy_from_slice(s); array }) } pub fn get_str(&mut self, n: usize) -> Result<&'a str, Error> { let mut cur = *self; let s = cur .get_bytes(n) .and_then(|s| str::from_utf8(s).map_err(|_| Error::InvalidString))?; *self = cur; Ok(s) } pub fn get_cstr(&mut self) -> Result, Error> { let pos = self .buffer .iter() .position(|&c| c == b'\0') .ok_or(Error::UnexpectedEnd)?; let (head, tail) = self.buffer.split_at(pos); self.buffer = &tail[1..]; Ok(Str(&head[..pos])) } pub fn get_cstr_as_str(&mut self) -> Result<&'a str, Error> { str::from_utf8(&self.get_cstr()?).map_err(|_| Error::InvalidString) } #[inline(always)] pub fn get_u8(&mut self) -> Result { self.get_array::<1>().map(|s| s[0]) } #[inline(always)] pub fn get_i8(&mut self) -> Result { self.get_array::<1>().map(|s| s[0] as i8) } impl_get! { get_u16_le: u16 = from_le_bytes, get_u32_le: u32 = from_le_bytes, get_u64_le: u64 = from_le_bytes, get_i16_le: i16 = from_le_bytes, get_i32_le: i32 = from_le_bytes, get_i64_le: i64 = from_le_bytes, get_f32_le: f32 = from_le_bytes, get_f64_le: f64 = from_le_bytes, get_u16_be: u16 = from_be_bytes, get_u32_be: u32 = from_be_bytes, get_u64_be: u64 = from_be_bytes, get_i16_be: i16 = from_be_bytes, get_i32_be: i32 = from_be_bytes, get_i64_be: i64 = from_be_bytes, get_f32_be: f32 = from_be_bytes, get_f64_be: f64 = from_be_bytes, get_u16_ne: u16 = from_ne_bytes, get_u32_ne: u32 = from_ne_bytes, get_u64_ne: u64 = from_ne_bytes, get_i16_ne: i16 = from_ne_bytes, get_i32_ne: i32 = from_ne_bytes, get_i64_ne: i64 = from_ne_bytes, get_f32_ne: f32 = from_ne_bytes, get_f64_ne: f64 = from_ne_bytes, } pub fn expect(&mut self, s: &[u8]) -> Result<(), Error> { if self.buffer.starts_with(s) { self.advance(s.len())?; Ok(()) } else { Err(Error::InvalidPacket) } } pub fn expect_empty(&self) -> Result<(), Error> { if self.has_remaining() { Err(Error::InvalidPacket) } else { Ok(()) } } pub fn take_while(&mut self, mut cond: F) -> Result<&'a [u8], Error> where F: FnMut(u8) -> bool, { self.buffer .iter() .position(|&i| !cond(i)) .ok_or(Error::UnexpectedEnd) .and_then(|n| self.get_bytes(n)) } pub fn take_while_or_all(&mut self, cond: F) -> &'a [u8] where F: FnMut(u8) -> bool, { self.take_while(cond).unwrap_or_else(|_| { let (head, tail) = self.buffer.split_at(self.buffer.len()); self.buffer = tail; head }) } pub fn get_key_value_raw(&mut self) -> Result<&'a [u8], Error> { let mut cur = *self; if cur.get_u8()? == b'\\' { let value = cur.take_while_or_all(|c| c != b'\\' && c != b'\n'); *self = cur; Ok(value) } else { Err(Error::InvalidPacket) } } pub fn get_key_value>(&mut self) -> Result { T::get_key_value(self) } pub fn get_key_raw(&mut self) -> Result<&'a [u8], Error> { let mut cur = *self; if cur.get_u8()? == b'\\' { let value = cur.take_while(|c| c != b'\\' && c != b'\n')?; *self = cur; Ok(value) } else { Err(Error::InvalidPacket) } } pub fn get_key>(&mut self) -> Result<(&'a [u8], T), Error> { Ok((self.get_key_raw()?, self.get_key_value()?)) } } pub trait PutKeyValue { fn put_key_value<'a, 'b>( &self, cur: &'b mut CursorMut<'a>, ) -> Result<&'b mut CursorMut<'a>, Error>; } impl PutKeyValue for &str { fn put_key_value<'a, 'b>( &self, cur: &'b mut CursorMut<'a>, ) -> Result<&'b mut CursorMut<'a>, Error> { cur.put_str(self) } } impl PutKeyValue for bool { fn put_key_value<'a, 'b>( &self, cur: &'b mut CursorMut<'a>, ) -> Result<&'b mut CursorMut<'a>, Error> { cur.put_u8(if *self { b'1' } else { b'0' }) } } macro_rules! impl_put_key_value { ($($t:ty),+ $(,)?) => { $(impl PutKeyValue for $t { fn put_key_value<'a, 'b>(&self, cur: &'b mut CursorMut<'a>) -> Result<&'b mut CursorMut<'a>, Error> { cur.put_as_str(self) } })+ }; } impl_put_key_value! { u8, u16, u32, u64, i8, i16, i32, i64, f32, f64, } pub struct CursorMut<'a> { buffer: &'a [u8], buffer_mut: &'a mut [u8], } macro_rules! impl_put { ($($n:ident: $t:ty = $f:ident),+ $(,)?) => ( $(#[inline] pub fn $n(&mut self, n: $t) -> Result<&mut Self, Error> { self.put_array(&n.$f()) })+ ); } impl<'a> CursorMut<'a> { pub fn new(buffer: &'a mut [u8]) -> Self { Self { buffer: unsafe { slice::from_raw_parts(buffer.as_ptr(), 0) }, buffer_mut: buffer, } } pub fn buffer(&self) -> &'a [u8] { self.buffer } pub fn buffer_mut<'b: 'a>(&'b mut self) -> &'a mut [u8] { self.buffer_mut } pub fn end(self) -> (&'a [u8], &'a mut [u8]) { (self.buffer, self.buffer_mut) } pub fn pos(&mut self) -> usize { self.buffer.len() } #[inline(always)] pub fn remaining(&self) -> usize { self.buffer_mut.len() } pub fn advance(&mut self, count: usize, mut f: F) -> Result<&mut Self, Error> where F: FnMut(&'a mut [u8]), { if count <= self.remaining() { let buffer_mut = mem::take(&mut self.buffer_mut); let (head, tail) = buffer_mut.split_at_mut(count); f(head); self.buffer = unsafe { slice::from_raw_parts(self.buffer.as_ptr(), self.buffer.len() + count) }; self.buffer_mut = tail; Ok(self) } else { Err(Error::UnexpectedEnd) } } pub fn put_bytes(&mut self, s: &[u8]) -> Result<&mut Self, Error> { self.advance(s.len(), |i| { i.copy_from_slice(s); }) } pub fn put_array(&mut self, s: &[u8; N]) -> Result<&mut Self, Error> { self.advance(N, |i| { i.copy_from_slice(s); }) } pub fn put_str(&mut self, s: &str) -> Result<&mut Self, Error> { self.put_bytes(s.as_bytes()) } pub fn put_cstr(&mut self, s: &str) -> Result<&mut Self, Error> { self.put_str(s)?.put_u8(0) } #[inline(always)] pub fn put_u8(&mut self, n: u8) -> Result<&mut Self, Error> { self.put_array(&[n]) } #[inline(always)] pub fn put_i8(&mut self, n: i8) -> Result<&mut Self, Error> { self.put_u8(n as u8) } impl_put! { put_u16_le: u16 = to_le_bytes, put_u32_le: u32 = to_le_bytes, put_u64_le: u64 = to_le_bytes, put_i16_le: i16 = to_le_bytes, put_i32_le: i32 = to_le_bytes, put_i64_le: i64 = to_le_bytes, put_f32_le: f32 = to_le_bytes, put_f64_le: f64 = to_le_bytes, put_u16_be: u16 = to_be_bytes, put_u32_be: u32 = to_be_bytes, put_u64_be: u64 = to_be_bytes, put_i16_be: i16 = to_be_bytes, put_i32_be: i32 = to_be_bytes, put_i64_be: i64 = to_be_bytes, put_f32_be: f32 = to_be_bytes, put_f64_be: f64 = to_be_bytes, put_u16_ne: u16 = to_ne_bytes, put_u32_ne: u32 = to_ne_bytes, put_u64_ne: u64 = to_ne_bytes, put_i16_ne: i16 = to_ne_bytes, put_i32_ne: i32 = to_ne_bytes, put_i64_ne: i64 = to_ne_bytes, put_f32_ne: f32 = to_ne_bytes, put_f64_ne: f64 = to_ne_bytes, } pub fn put_as_str(&mut self, value: T) -> Result<&mut Self, Error> { let mut cur = io::Cursor::new(mem::take(&mut self.buffer_mut)); write!(&mut cur, "{}", value).map_err(|_| Error::UnexpectedEnd)?; let n = cur.position() as usize; self.buffer_mut = cur.into_inner(); self.advance(n, |_| {}) } pub fn put_key_value(&mut self, value: T) -> Result<&mut Self, Error> { value.put_key_value(self) } pub fn put_key_raw(&mut self, key: &str, value: &[u8]) -> Result<&mut Self, Error> { self.put_u8(b'\\')? .put_str(key)? .put_u8(b'\\')? .put_bytes(value) } pub fn put_key(&mut self, key: &str, value: T) -> Result<&mut Self, Error> { self.put_u8(b'\\')? .put_str(key)? .put_u8(b'\\')? .put_key_value(value) } } #[cfg(test)] mod tests { use super::*; #[test] fn cursor() -> Result<(), Error> { let mut buf = [0; 64]; let s = CursorMut::new(&mut buf) .put_bytes(b"12345678")? .put_array(b"4321")? .put_str("abc")? .put_cstr("def")? .put_u8(0x7f)? .put_i8(-128)? .put_u32_le(0x44332211)? .buffer(); let mut cur = Cursor::new(s); assert_eq!(cur.get_bytes(8), Ok(&b"12345678"[..])); assert_eq!(cur.get_array::<4>(), Ok(*b"4321")); assert_eq!(cur.get_str(3), Ok("abc")); assert_eq!(cur.get_cstr(), Ok(Str(&b"def"[..]))); assert_eq!(cur.get_u8(), Ok(0x7f)); assert_eq!(cur.get_i8(), Ok(-128)); assert_eq!(cur.get_u32_le(), Ok(0x44332211)); assert_eq!(cur.get_u8(), Err(Error::UnexpectedEnd)); Ok(()) } #[test] fn key() -> Result<(), Error> { let mut buf = [0; 512]; let s = CursorMut::new(&mut buf) .put_key("p", 49)? .put_key("map", "crossfire")? .put_key("dm", true)? .put_key("team", false)? .put_key("coop", false)? .put_key("numcl", 4)? .put_key("maxcl", 32)? .put_key("gamedir", "valve")? .put_key("password", false)? .put_key("host", "test")? .buffer(); let mut cur = Cursor::new(s); assert_eq!(cur.get_key(), Ok((&b"p"[..], 49_u8))); assert_eq!(cur.get_key(), Ok((&b"map"[..], "crossfire"))); assert_eq!(cur.get_key(), Ok((&b"dm"[..], true))); assert_eq!(cur.get_key(), Ok((&b"team"[..], false))); assert_eq!(cur.get_key(), Ok((&b"coop"[..], false))); assert_eq!(cur.get_key(), Ok((&b"numcl"[..], 4_u8))); assert_eq!(cur.get_key(), Ok((&b"maxcl"[..], 32_u8))); assert_eq!(cur.get_key(), Ok((&b"gamedir"[..], "valve"))); assert_eq!(cur.get_key(), Ok((&b"password"[..], false))); assert_eq!(cur.get_key(), Ok((&b"host"[..], "test"))); assert_eq!(cur.get_key::<&[u8]>(), Err(Error::UnexpectedEnd)); Ok(()) } }