1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146

/*
 * Created on Sat Sep 09 2023
 *
 * Copyright (c) storycraft. Licensed under the MIT Licence.
 */

use alloc::{boxed::Box, collections::VecDeque};
use core::mem;

use arrayvec::ArrayVec;
use serde::{Deserialize, Serialize};

use crate::command::Header;

use super::Command;

#[derive(Debug)]
#[non_exhaustive]
/// IO-free loco protocol sink
pub struct LocoSink {
    /// Write buffer for sink
    pub write_buffer: VecDeque<u8>,
}

impl LocoSink {
    /// Create new [`LocoSink`]
    pub const fn new() -> Self {
        Self {
            write_buffer: VecDeque::new(),
        }
    }

    /// Write single [`Command`] to [`LocoSink::write_buffer`]
    pub fn send(&mut self, command: Command<impl AsRef<[u8]>>) {
        let data = command.data.as_ref();

        bincode::serialize_into(
            &mut self.write_buffer,
            &RawHeader {
                header: command.header,
                data_size: data.len() as u32,
            },
        )
        .unwrap();

        self.write_buffer.extend(data);
    }
}

impl Default for LocoSink {
    fn default() -> Self {
        Self::new()
    }
}

#[derive(Debug)]
/// IO-free loco protocol stream
pub struct LocoStream {
    state: StreamState,

    /// Read buffer for stream
    pub read_buffer: VecDeque<u8>,
}

impl LocoStream {
    /// Create new [`LocoStream`]
    pub const fn new() -> Self {
        Self {
            state: StreamState::Pending,
            read_buffer: VecDeque::new(),
        }
    }

    pub const fn state(&self) -> &StreamState {
        &self.state
    }

    /// Try reading single [`Command`] from [`LocoClient::read_buffer`]
    pub fn read(&mut self) -> Option<Command<Box<[u8]>>> {
        loop {
            match mem::replace(&mut self.state, StreamState::Corrupted) {
                StreamState::Pending => {
                    if self.read_buffer.len() < 22 {
                        self.state = StreamState::Pending;
                        return None;
                    }

                    let raw_header = {
                        let buf = self.read_buffer.drain(..22).collect::<ArrayVec<u8, 22>>();

                        bincode::deserialize::<RawHeader>(&buf).unwrap()
                    };

                    self.state = StreamState::Header(raw_header);
                }

                StreamState::Header(raw_header) => {
                    if self.read_buffer.len() < raw_header.data_size as usize {
                        self.state = StreamState::Header(raw_header);
                        return None;
                    }

                    let data = self
                        .read_buffer
                        .drain(..raw_header.data_size as usize)
                        .collect::<Box<[u8]>>();

                    self.state = StreamState::Pending;
                    return Some(Command {
                        header: raw_header.header,
                        data,
                    });
                }

                StreamState::Corrupted => unreachable!(),
            }
        }
    }
}

impl Default for LocoStream {
    fn default() -> Self {
        Self::new()
    }
}

#[derive(Debug, Clone, PartialEq)]
pub enum StreamState {
    /// Stream is waiting for packet
    Pending,

    /// Stream read header and wait for data
    Header(RawHeader),

    /// Client corrupted and cannot continue
    Corrupted,
}

#[derive(Debug, Clone, PartialEq, Serialize, Deserialize)]
pub struct RawHeader {
    /// Packet header
    pub header: Header,

    /// Data size
    pub data_size: u32,
}