mcproto-codec 0.2.0

use std::io::{Read, Write};

use crate::error::{CodecError, CodecKind, InvalidEncodingReason};
use crate::io::{read_exact_counted, write_all_counted};

pub trait VarIntWrite: Write {
    #[inline]
    fn write_varint(&mut self, value: i32) -> Result<(), CodecError> {
        self.write_varint_with_size(value).map(|_| ())
    }

    #[inline]
    fn write_varint_with_size(&mut self, value: i32) -> Result<usize, CodecError> {
        let mut value = value as u32;
        let mut bytes_processed = 0;

        loop {
            let byte = (value & 0x7F) as u8;
            value >>= 7;
            let has_next = value != 0;
            let byte = if has_next { byte | 0x80 } else { byte };

            write_all_counted(self, &[byte], CodecKind::VarInt, bytes_processed)?;
            bytes_processed += 1;

            if !has_next {
                return Ok(bytes_processed);
            }
        }
    }
}

pub trait VarIntRead: Read {
    #[inline]
    fn read_varint(&mut self) -> Result<i32, CodecError> {
        self.read_varint_with_size().map(|(value, _)| value)
    }

    #[inline]
    fn read_varint_with_size(&mut self) -> Result<(i32, usize), CodecError> {
        let mut result = 0u32;
        let mut shift = 0;

        for i in 0..5 {
            let mut buf = [0u8; 1];
            read_exact_counted(self, &mut buf, CodecKind::VarInt, i)?;
            let byte = buf[0];

            if i == 4 {
                if (byte & 0x80) != 0 {
                    return Err(CodecError::invalid_encoding(
                        CodecKind::VarInt,
                        i + 1,
                        InvalidEncodingReason::TooLong { max_bytes: 5 },
                    ));
                }
                if (byte & !0x0F) != 0 {
                    return Err(CodecError::invalid_encoding(
                        CodecKind::VarInt,
                        i + 1,
                        InvalidEncodingReason::ValueOutOfRange {
                            terminal_byte: byte,
                            allowed_mask: 0x0F,
                        },
                    ));
                }
            }

            let value = (byte & 0x7F) as u32;
            result |= value << shift;

            if (byte & 0x80) == 0 {
                return Ok((result as i32, i + 1));
            }

            shift += 7;
        }

        unreachable!("the fifth VarInt byte always terminates or returns an error")
    }
}

impl<R: Read> VarIntRead for R {}
impl<W: Write> VarIntWrite for W {}