// SPDX-License-Identifier: MPL-2.0 use alloc::{boxed::Box, fmt::Debug, string::ToString, sync::Arc, vec::Vec}; use core::hint::spin_loop; use aster_console::{AnyConsoleDevice, ConsoleCallback}; use aster_frame::{config::PAGE_SIZE, io_mem::IoMem, sync::SpinLock, trap::TrapFrame}; use aster_util::safe_ptr::SafePtr; use log::debug; use super::{config::VirtioConsoleConfig, DEVICE_NAME}; use crate::{ device::{console::config::ConsoleFeatures, VirtioDeviceError}, queue::VirtQueue, transport::VirtioTransport, }; pub struct ConsoleDevice { config: SafePtr, transport: Box, receive_queue: SpinLock, transmit_queue: SpinLock, buffer: SpinLock>, callbacks: SpinLock>, } impl AnyConsoleDevice for ConsoleDevice { fn send(&self, value: &[u8]) { let mut transmit_queue = self.transmit_queue.lock_irq_disabled(); transmit_queue.add_buf(&[value], &[]).unwrap(); if transmit_queue.should_notify() { transmit_queue.notify(); } while !transmit_queue.can_pop() { spin_loop(); } transmit_queue.pop_used().unwrap(); } fn recv(&self, buf: &mut [u8]) -> Option { let mut receive_queue = self.receive_queue.lock_irq_disabled(); if !receive_queue.can_pop() { return None; } let (_, len) = receive_queue.pop_used().unwrap(); let mut recv_buffer = self.buffer.lock(); buf.copy_from_slice(&recv_buffer.as_ref()[..len as usize]); receive_queue.add_buf(&[], &[recv_buffer.as_mut()]).unwrap(); if receive_queue.should_notify() { receive_queue.notify(); } Some(len as usize) } fn register_callback(&self, callback: &'static (dyn Fn(&[u8]) + Send + Sync)) { self.callbacks.lock().push(callback); } fn handle_irq(&self) { let mut receive_queue = self.receive_queue.lock_irq_disabled(); if !receive_queue.can_pop() { return; } let (_, len) = receive_queue.pop_used().unwrap(); let mut recv_buffer = self.buffer.lock(); let buffer = &recv_buffer.as_ref()[..len as usize]; let lock = self.callbacks.lock(); for callback in lock.iter() { callback.call((buffer,)); } receive_queue.add_buf(&[], &[recv_buffer.as_mut()]).unwrap(); if receive_queue.should_notify() { receive_queue.notify(); } } } impl Debug for ConsoleDevice { fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result { f.debug_struct("ConsoleDevice") .field("config", &self.config) .field("transport", &self.transport) .field("receive_queue", &self.receive_queue) .field("transmit_queue", &self.transmit_queue) .finish() } } impl ConsoleDevice { pub fn negotiate_features(features: u64) -> u64 { let mut features = ConsoleFeatures::from_bits_truncate(features); // A virtio console device may have multiple ports, but we only use one port to communicate now. features.remove(ConsoleFeatures::VIRTIO_CONSOLE_F_MULTIPORT); features.bits() } pub fn init(mut transport: Box) -> Result<(), VirtioDeviceError> { let config = VirtioConsoleConfig::new(transport.as_ref()); const RECV0_QUEUE_INDEX: u16 = 0; const TRANSMIT0_QUEUE_INDEX: u16 = 1; let receive_queue = SpinLock::new(VirtQueue::new(RECV0_QUEUE_INDEX, 2, transport.as_mut()).unwrap()); let transmit_queue = SpinLock::new(VirtQueue::new(TRANSMIT0_QUEUE_INDEX, 2, transport.as_mut()).unwrap()); let mut device = Self { config, transport, receive_queue, transmit_queue, buffer: SpinLock::new(Box::new([0; PAGE_SIZE])), callbacks: SpinLock::new(Vec::new()), }; let mut receive_queue = device.receive_queue.lock(); receive_queue .add_buf(&[], &[device.buffer.lock().as_mut()]) .unwrap(); if receive_queue.should_notify() { receive_queue.notify(); } drop(receive_queue); device .transport .register_queue_callback(RECV0_QUEUE_INDEX, Box::new(handle_console_input), false) .unwrap(); device .transport .register_cfg_callback(Box::new(config_space_change)) .unwrap(); device.transport.finish_init(); aster_console::register_device(DEVICE_NAME.to_string(), Arc::new(device)); Ok(()) } } fn handle_console_input(_: &TrapFrame) { aster_console::get_device(DEVICE_NAME).unwrap().handle_irq(); } fn config_space_change(_: &TrapFrame) { debug!("Virtio-Console device configuration space change"); }