use linuxcnc_hal_sys::{rtapi_get_msg_level, rtapi_print_msg};
use log::{Level, Metadata, Record};
use std::ffi::CString;
use log::{LevelFilter, SetLoggerError};
#[derive(Debug, Copy, Clone)]
enum RtapiLogLevel {
#[allow(unused)]
None = 0,
Err = 1,
Warn = 2,
Info = 3,
Dbg = 4,
All = 5,
}
impl From<Level> for RtapiLogLevel {
fn from(other: Level) -> Self {
match other {
Level::Error => Self::Err,
Level::Warn => Self::Warn,
Level::Info => Self::Info,
Level::Debug => Self::Dbg,
Level::Trace => Self::All,
}
}
}
static LOGGER: RtapiLogger = RtapiLogger;
pub fn init() -> Result<(), SetLoggerError> {
let _rtapi_level = unsafe { rtapi_get_msg_level() };
log::set_logger(&LOGGER).map(|()| log::set_max_level(LevelFilter::Trace))
}
pub struct RtapiLogger;
impl log::Log for RtapiLogger {
fn enabled(&self, _metadata: &Metadata) -> bool {
true
}
fn log(&self, record: &Record) {
if self.enabled(record.metadata()) {
let out = format!("{}\n", record.args());
let level = RtapiLogLevel::Err;
if let Ok(f) = CString::new(out) {
unsafe { rtapi_print_msg(level as u32, f.as_ptr()) };
} else {
let fail = CString::new("failed to build log message string").unwrap();
unsafe { rtapi_print_msg(level as u32, fail.as_ptr()) }
}
}
}
fn flush(&self) {}
}