176 lines
5.8 KiB
Rust
176 lines
5.8 KiB
Rust
use futures::{future::poll_fn, task::Poll};
|
|
use libasync::{smoltcp::TcpStream, task};
|
|
use libboard_zynq::smoltcp;
|
|
use core::cell::RefCell;
|
|
use alloc::rc::Rc;
|
|
use log::{self, info, warn, LevelFilter};
|
|
|
|
use crate::logger::{BufferLogger, LogBufferRef};
|
|
use crate::proto_async::*;
|
|
use num_derive::FromPrimitive;
|
|
use num_traits::FromPrimitive;
|
|
|
|
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
|
|
pub enum Error {
|
|
NetworkError(smoltcp::Error),
|
|
UnknownLogLevel(u8),
|
|
UnexpectedPattern,
|
|
UnrecognizedPacket,
|
|
}
|
|
|
|
type Result<T> = core::result::Result<T, Error>;
|
|
|
|
impl core::fmt::Display for Error {
|
|
fn fmt(&self, f: &mut core::fmt::Formatter) -> core::fmt::Result {
|
|
match self {
|
|
&Error::NetworkError(error) => write!(f, "network error: {}", error),
|
|
&Error::UnknownLogLevel(lvl) => write!(f, "unknown log level {}", lvl),
|
|
&Error::UnexpectedPattern => write!(f, "unexpected pattern"),
|
|
&Error::UnrecognizedPacket => write!(f, "unrecognized packet"),
|
|
}
|
|
}
|
|
}
|
|
|
|
impl From<smoltcp::Error> for Error {
|
|
fn from(error: smoltcp::Error) -> Self {
|
|
Error::NetworkError(error)
|
|
}
|
|
}
|
|
|
|
#[derive(Debug, FromPrimitive)]
|
|
pub enum Request {
|
|
GetLog = 1,
|
|
ClearLog = 2,
|
|
PullLog = 7,
|
|
SetLogFilter = 3,
|
|
SetUartLogFilter = 6,
|
|
}
|
|
|
|
#[repr(i8)]
|
|
pub enum Reply {
|
|
Success = 1,
|
|
LogContent = 2,
|
|
}
|
|
|
|
async fn read_log_level_filter(stream: &mut TcpStream) -> Result<log::LevelFilter> {
|
|
Ok(match read_i8(stream).await? {
|
|
0 => log::LevelFilter::Off,
|
|
1 => log::LevelFilter::Error,
|
|
2 => log::LevelFilter::Warn,
|
|
3 => log::LevelFilter::Info,
|
|
4 => log::LevelFilter::Debug,
|
|
5 => log::LevelFilter::Trace,
|
|
lv => return Err(Error::UnknownLogLevel(lv as u8)),
|
|
})
|
|
}
|
|
|
|
async fn get_logger_buffer_pred<F>(f: F) -> LogBufferRef<'static>
|
|
where
|
|
F: Fn(&LogBufferRef) -> bool,
|
|
{
|
|
poll_fn(|ctx| {
|
|
let logger = unsafe { BufferLogger::get_logger().as_mut().unwrap() };
|
|
match logger.buffer() {
|
|
Some(buffer) if f(&buffer) => Poll::Ready(buffer),
|
|
_ => {
|
|
ctx.waker().wake_by_ref();
|
|
Poll::Pending
|
|
}
|
|
}
|
|
})
|
|
.await
|
|
}
|
|
|
|
async fn get_logger_buffer() -> LogBufferRef<'static> {
|
|
get_logger_buffer_pred(|_| true).await
|
|
}
|
|
|
|
async fn handle_connection(stream: &mut TcpStream, pull_id: Rc<RefCell<u32>>) -> Result<()> {
|
|
if !expect(&stream, b"ARTIQ management\n").await? {
|
|
return Err(Error::UnexpectedPattern);
|
|
}
|
|
|
|
loop {
|
|
let msg = read_i8(stream).await;
|
|
if let Err(smoltcp::Error::Illegal) = msg {
|
|
return Ok(());
|
|
}
|
|
let msg: Request = FromPrimitive::from_i8(msg?).ok_or(Error::UnrecognizedPacket)?;
|
|
match msg {
|
|
Request::GetLog => {
|
|
let mut buffer = get_logger_buffer().await;
|
|
write_i8(stream, Reply::LogContent as i8).await?;
|
|
write_chunk(stream, buffer.extract().as_bytes()).await?;
|
|
}
|
|
Request::ClearLog => {
|
|
let mut buffer = get_logger_buffer().await;
|
|
buffer.clear();
|
|
write_i8(stream, Reply::Success as i8).await?;
|
|
}
|
|
Request::PullLog => {
|
|
let id = {
|
|
let mut guard = pull_id.borrow_mut();
|
|
*guard += 1;
|
|
*guard
|
|
};
|
|
loop {
|
|
let mut buffer = get_logger_buffer_pred(|b| !b.is_empty()).await;
|
|
let bytes = buffer.extract().as_bytes();
|
|
if id != *pull_id.borrow() {
|
|
// another connection attempts to pull the log...
|
|
// abort this connection...
|
|
break;
|
|
}
|
|
write_chunk(stream, bytes).await?;
|
|
if log::max_level() == LevelFilter::Trace {
|
|
// Hold exclusive access over the logger until we get positive
|
|
// acknowledgement; otherwise we get an infinite loop of network
|
|
// trace messages being transmitted and causing more network
|
|
// trace messages to be emitted.
|
|
//
|
|
// Any messages unrelated to this management socket that arrive
|
|
// while it is flushed are lost, but such is life.
|
|
stream.flush().await?;
|
|
}
|
|
buffer.clear();
|
|
}
|
|
},
|
|
Request::SetLogFilter => {
|
|
let lvl = read_log_level_filter(stream).await?;
|
|
info!("Changing log level to {}", lvl);
|
|
log::set_max_level(lvl);
|
|
write_i8(stream, Reply::Success as i8).await?;
|
|
}
|
|
Request::SetUartLogFilter => {
|
|
let lvl = read_log_level_filter(stream).await?;
|
|
info!("Changing UART log level to {}", lvl);
|
|
unsafe {
|
|
BufferLogger::get_logger()
|
|
.as_ref()
|
|
.unwrap()
|
|
.set_uart_log_level(lvl);
|
|
}
|
|
write_i8(stream, Reply::Success as i8).await?;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
pub fn start() {
|
|
task::spawn(async move {
|
|
let pull_id = Rc::new(RefCell::new(0u32));
|
|
loop {
|
|
let mut stream = TcpStream::accept(1380, 2048, 2048).await.unwrap();
|
|
let pull_id = pull_id.clone();
|
|
task::spawn(async move {
|
|
info!("received connection");
|
|
let _ = handle_connection(&mut stream, pull_id)
|
|
.await
|
|
.map_err(|e| warn!("connection terminated: {:?}", e));
|
|
let _ = stream.flush().await;
|
|
let _ = stream.abort().await;
|
|
});
|
|
}
|
|
});
|
|
}
|