206 lines
		
	
	
		
			6.4 KiB
		
	
	
	
		
			Rust
		
	
	
	
	
	
			
		
		
	
	
			206 lines
		
	
	
		
			6.4 KiB
		
	
	
	
		
			Rust
		
	
	
	
	
	
#![no_std]
 | 
						|
#![doc = include_str!("../README.md")]
 | 
						|
#![warn(missing_docs)]
 | 
						|
 | 
						|
use core::fmt::Write as _;
 | 
						|
 | 
						|
use embassy_futures::join::join;
 | 
						|
use embassy_sync::pipe::Pipe;
 | 
						|
use embassy_usb::class::cdc_acm::{CdcAcmClass, Receiver, Sender, State};
 | 
						|
use embassy_usb::driver::Driver;
 | 
						|
use embassy_usb::{Builder, Config};
 | 
						|
use log::{Metadata, Record};
 | 
						|
 | 
						|
type CS = embassy_sync::blocking_mutex::raw::CriticalSectionRawMutex;
 | 
						|
 | 
						|
/// The logger state containing buffers that must live as long as the USB peripheral.
 | 
						|
pub struct LoggerState<'d> {
 | 
						|
    state: State<'d>,
 | 
						|
    device_descriptor: [u8; 32],
 | 
						|
    config_descriptor: [u8; 128],
 | 
						|
    bos_descriptor: [u8; 16],
 | 
						|
    msos_descriptor: [u8; 256],
 | 
						|
    control_buf: [u8; 64],
 | 
						|
}
 | 
						|
 | 
						|
impl<'d> LoggerState<'d> {
 | 
						|
    /// Create a new instance of the logger state.
 | 
						|
    pub fn new() -> Self {
 | 
						|
        Self {
 | 
						|
            state: State::new(),
 | 
						|
            device_descriptor: [0; 32],
 | 
						|
            config_descriptor: [0; 128],
 | 
						|
            bos_descriptor: [0; 16],
 | 
						|
            msos_descriptor: [0; 256],
 | 
						|
            control_buf: [0; 64],
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
/// The packet size used in the usb logger, to be used with `create_future_from_class`
 | 
						|
pub const MAX_PACKET_SIZE: u8 = 64;
 | 
						|
 | 
						|
/// The logger handle, which contains a pipe with configurable size for buffering log messages.
 | 
						|
pub struct UsbLogger<const N: usize> {
 | 
						|
    buffer: Pipe<CS, N>,
 | 
						|
}
 | 
						|
 | 
						|
impl<const N: usize> UsbLogger<N> {
 | 
						|
    /// Create a new logger instance.
 | 
						|
    pub const fn new() -> Self {
 | 
						|
        Self { buffer: Pipe::new() }
 | 
						|
    }
 | 
						|
 | 
						|
    /// Run the USB logger using the state and USB driver. Never returns.
 | 
						|
    pub async fn run<'d, D>(&'d self, state: &'d mut LoggerState<'d>, driver: D) -> !
 | 
						|
    where
 | 
						|
        D: Driver<'d>,
 | 
						|
        Self: 'd,
 | 
						|
    {
 | 
						|
        let mut config = Config::new(0xc0de, 0xcafe);
 | 
						|
        config.manufacturer = Some("Embassy");
 | 
						|
        config.product = Some("USB-serial logger");
 | 
						|
        config.serial_number = None;
 | 
						|
        config.max_power = 100;
 | 
						|
        config.max_packet_size_0 = MAX_PACKET_SIZE;
 | 
						|
 | 
						|
        // Required for windows compatiblity.
 | 
						|
        // https://developer.nordicsemi.com/nRF_Connect_SDK/doc/1.9.1/kconfig/CONFIG_CDC_ACM_IAD.html#help
 | 
						|
        config.device_class = 0xEF;
 | 
						|
        config.device_sub_class = 0x02;
 | 
						|
        config.device_protocol = 0x01;
 | 
						|
        config.composite_with_iads = true;
 | 
						|
 | 
						|
        let mut builder = Builder::new(
 | 
						|
            driver,
 | 
						|
            config,
 | 
						|
            &mut state.device_descriptor,
 | 
						|
            &mut state.config_descriptor,
 | 
						|
            &mut state.bos_descriptor,
 | 
						|
            &mut state.msos_descriptor,
 | 
						|
            &mut state.control_buf,
 | 
						|
        );
 | 
						|
 | 
						|
        // Create classes on the builder.
 | 
						|
        let class = CdcAcmClass::new(&mut builder, &mut state.state, MAX_PACKET_SIZE as u16);
 | 
						|
        let (mut sender, mut receiver) = class.split();
 | 
						|
 | 
						|
        // Build the builder.
 | 
						|
        let mut device = builder.build();
 | 
						|
        loop {
 | 
						|
            let run_fut = device.run();
 | 
						|
            let class_fut = self.run_logger_class(&mut sender, &mut receiver);
 | 
						|
            join(run_fut, class_fut).await;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    async fn run_logger_class<'d, D>(&self, sender: &mut Sender<'d, D>, receiver: &mut Receiver<'d, D>)
 | 
						|
    where
 | 
						|
        D: Driver<'d>,
 | 
						|
    {
 | 
						|
        let log_fut = async {
 | 
						|
            let mut rx: [u8; MAX_PACKET_SIZE as usize] = [0; MAX_PACKET_SIZE as usize];
 | 
						|
            sender.wait_connection().await;
 | 
						|
            loop {
 | 
						|
                let len = self.buffer.read(&mut rx[..]).await;
 | 
						|
                let _ = sender.write_packet(&rx[..len]).await;
 | 
						|
                if len as u8 == MAX_PACKET_SIZE {
 | 
						|
                    let _ = sender.write_packet(&[]).await;
 | 
						|
                }
 | 
						|
            }
 | 
						|
        };
 | 
						|
        let discard_fut = async {
 | 
						|
            let mut discard_buf: [u8; MAX_PACKET_SIZE as usize] = [0; MAX_PACKET_SIZE as usize];
 | 
						|
            receiver.wait_connection().await;
 | 
						|
            loop {
 | 
						|
                let _ = receiver.read_packet(&mut discard_buf).await;
 | 
						|
            }
 | 
						|
        };
 | 
						|
 | 
						|
        join(log_fut, discard_fut).await;
 | 
						|
    }
 | 
						|
 | 
						|
    /// Creates the futures needed for the logger from a given class
 | 
						|
    /// This can be used in cases where the usb device is already in use for another connection
 | 
						|
    pub async fn create_future_from_class<'d, D>(&'d self, class: CdcAcmClass<'d, D>)
 | 
						|
    where
 | 
						|
        D: Driver<'d>,
 | 
						|
    {
 | 
						|
        let (mut sender, mut receiver) = class.split();
 | 
						|
        loop {
 | 
						|
            self.run_logger_class(&mut sender, &mut receiver).await;
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
impl<const N: usize> log::Log for UsbLogger<N> {
 | 
						|
    fn enabled(&self, _metadata: &Metadata) -> bool {
 | 
						|
        true
 | 
						|
    }
 | 
						|
 | 
						|
    fn log(&self, record: &Record) {
 | 
						|
        if self.enabled(record.metadata()) {
 | 
						|
            let _ = write!(Writer(&self.buffer), "{}\r\n", record.args());
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    fn flush(&self) {}
 | 
						|
}
 | 
						|
 | 
						|
struct Writer<'d, const N: usize>(&'d Pipe<CS, N>);
 | 
						|
 | 
						|
impl<'d, const N: usize> core::fmt::Write for Writer<'d, N> {
 | 
						|
    fn write_str(&mut self, s: &str) -> Result<(), core::fmt::Error> {
 | 
						|
        let _ = self.0.try_write(s.as_bytes());
 | 
						|
        Ok(())
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
/// Initialize and run the USB serial logger, never returns.
 | 
						|
///
 | 
						|
/// Arguments specify the buffer size, log level and the USB driver, respectively.
 | 
						|
///
 | 
						|
/// # Usage
 | 
						|
///
 | 
						|
/// ```
 | 
						|
/// embassy_usb_logger::run!(1024, log::LevelFilter::Info, driver);
 | 
						|
/// ```
 | 
						|
///
 | 
						|
/// # Safety
 | 
						|
///
 | 
						|
/// This macro should only be invoked only once since it is setting the global logging state of the application.
 | 
						|
#[macro_export]
 | 
						|
macro_rules! run {
 | 
						|
    ( $x:expr, $l:expr, $p:ident ) => {
 | 
						|
        static LOGGER: ::embassy_usb_logger::UsbLogger<$x> = ::embassy_usb_logger::UsbLogger::new();
 | 
						|
        unsafe {
 | 
						|
            let _ = ::log::set_logger_racy(&LOGGER).map(|()| log::set_max_level_racy($l));
 | 
						|
        }
 | 
						|
        let _ = LOGGER.run(&mut ::embassy_usb_logger::LoggerState::new(), $p).await;
 | 
						|
    };
 | 
						|
}
 | 
						|
 | 
						|
/// Initialize the USB serial logger from a serial class and return the future to run it.
 | 
						|
///
 | 
						|
/// Arguments specify the buffer size, log level and the serial class, respectively.
 | 
						|
///
 | 
						|
/// # Usage
 | 
						|
///
 | 
						|
/// ```
 | 
						|
/// embassy_usb_logger::with_class!(1024, log::LevelFilter::Info, class);
 | 
						|
/// ```
 | 
						|
///
 | 
						|
/// # Safety
 | 
						|
///
 | 
						|
/// This macro should only be invoked only once since it is setting the global logging state of the application.
 | 
						|
#[macro_export]
 | 
						|
macro_rules! with_class {
 | 
						|
    ( $x:expr, $l:expr, $p:ident ) => {{
 | 
						|
        static LOGGER: ::embassy_usb_logger::UsbLogger<$x> = ::embassy_usb_logger::UsbLogger::new();
 | 
						|
        unsafe {
 | 
						|
            let _ = ::log::set_logger_racy(&LOGGER).map(|()| log::set_max_level_racy($l));
 | 
						|
        }
 | 
						|
        LOGGER.create_future_from_class($p)
 | 
						|
    }};
 | 
						|
}
 |