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
use alloc::{boxed::Box, collections::VecDeque, string::String, sync::Arc};

use lock::Mutex;

use crate::scheme::{impl_event_scheme, Scheme, UartScheme};
use crate::utils::EventListener;
use crate::DeviceResult;

const BUF_CAPACITY: usize = 4096;

pub struct BufferedUart {
    inner: Arc<dyn UartScheme>,
    buf: Mutex<VecDeque<u8>>,
    listener: EventListener,
    name: String,
}

impl_event_scheme!(BufferedUart);

impl BufferedUart {
    pub fn new(uart: Arc<dyn UartScheme>) -> Arc<Self> {
        let ret = Arc::new(Self {
            inner: uart.clone(),
            name: alloc::format!("{}-buffered", uart.name()),
            buf: Mutex::new(VecDeque::with_capacity(BUF_CAPACITY)),
            listener: EventListener::new(),
        });
        let cloned = ret.clone();
        uart.subscribe(Box::new(move |_| cloned.handle_irq(0)), false);
        ret
    }
}

impl Scheme for BufferedUart {
    fn name(&self) -> &str {
        self.name.as_str()
    }

    fn handle_irq(&self, _unused: usize) {
        while let Some(c) = self.inner.try_recv().unwrap_or(None) {
            let mut buf = self.buf.lock();
            if buf.len() < BUF_CAPACITY {
                let c = if c == b'\r' { b'\n' } else { c };
                buf.push_back(c);
            }
        }
        if self.buf.lock().len() > 0 {
            self.listener.trigger(());
        }
    }
}

impl UartScheme for BufferedUart {
    fn try_recv(&self) -> DeviceResult<Option<u8>> {
        Ok(self.buf.lock().pop_front())
    }
    fn send(&self, ch: u8) -> DeviceResult {
        self.inner.send(ch)
    }
    fn write_str(&self, s: &str) -> DeviceResult {
        self.inner.write_str(s)
    }
}