use alloc::{ string::{String, ToString}, sync::{Arc, Weak}, }; use ida::IdAllocator; use intertrait::cast::CastArc; use log::error; use system_error::SystemError; use unified_init::macros::unified_init; use crate::{ driver::{ base::{ device::{ bus::{bus_manager, Bus}, device_manager, driver::{driver_manager, Driver}, Device, }, kobject::KObject, subsys::SubSysPrivate, }, virtio::irq::{virtio_irq_manager, DefaultVirtioIrqHandler}, }, exception::{irqdesc::IrqHandleFlags, manage::irq_manager}, filesystem::{ sysfs::{ file::sysfs_emit_str, Attribute, AttributeGroup, SysFSOpsSupport, SYSFS_ATTR_MODE_RO, }, vfs::syscall::ModeType, }, init::initcall::INITCALL_CORE, }; use super::{VirtIODevice, VirtIODeviceIndex, VirtIODriver, VIRTIO_DEV_ANY_ID}; static mut VIRTIO_BUS: Option> = None; #[inline(always)] pub fn virtio_bus() -> Arc { unsafe { VIRTIO_BUS.as_ref().unwrap().clone() } } #[derive(Debug)] pub struct VirtIOBus { private: SubSysPrivate, } impl VirtIOBus { pub fn new() -> Arc { let w: Weak = Weak::new(); let private = SubSysPrivate::new("virtio".to_string(), Some(w), None, &[]); let bus = Arc::new(Self { private }); bus.subsystem() .set_bus(Some(Arc::downgrade(&(bus.clone() as Arc)))); return bus; } } impl Bus for VirtIOBus { fn name(&self) -> String { self.private.name() } fn dev_name(&self) -> String { return self.name(); } fn dev_groups(&self) -> &'static [&'static dyn AttributeGroup] { // todo: VirtIODeviceAttrGroup return &[]; } fn subsystem(&self) -> &SubSysPrivate { return &self.private; } fn probe(&self, device: &Arc) -> Result<(), SystemError> { let drv = device.driver().ok_or(SystemError::EINVAL)?; let virtio_drv = drv.cast::().map_err(|_| { error!( "VirtIOBus::probe() failed: device.driver() is not a VirtioDriver. Device: '{:?}'", device.name() ); SystemError::EINVAL })?; let virtio_dev = device.clone().cast::().map_err(|_| { error!( "VirtIOBus::probe() failed: device is not a VirtIODevice. Device: '{:?}'", device.name() ); SystemError::EINVAL })?; return virtio_drv.probe(&virtio_dev); } fn remove(&self, _device: &Arc) -> Result<(), SystemError> { todo!() } fn sync_state(&self, _device: &Arc) { todo!() } fn shutdown(&self, _device: &Arc) { todo!() } fn resume(&self, _device: &Arc) -> Result<(), SystemError> { todo!() } // 参考:https://code.dragonos.org.cn/xref/linux-6.6.21/drivers/virtio/virtio.c#85 fn match_device( &self, _device: &Arc, _driver: &Arc, ) -> Result { let virtio_device = _device.clone().cast::().map_err(|_| { error!( "VirtIOBus::match_device() failed: device is not a VirtIODevice. Device: '{:?}'", _device.name() ); SystemError::EINVAL })?; let virtio_driver = _driver.clone().cast::().map_err(|_| { error!( "VirtIOBus::match_device() failed: driver is not a VirtioDriver. Driver: '{:?}'", _driver.name() ); SystemError::EINVAL })?; let ids = virtio_driver.virtio_id_table(); for id in &ids { if id.device != virtio_device.device_type_id() && id.vendor != VIRTIO_DEV_ANY_ID { continue; } if id.vendor == VIRTIO_DEV_ANY_ID || id.vendor == virtio_device.vendor() { return Ok(true); } } return Ok(false); } } #[unified_init(INITCALL_CORE)] fn virtio_init() -> Result<(), SystemError> { let bus = VirtIOBus::new(); unsafe { VIRTIO_BUS = Some(bus.clone()); } bus_manager() .register(bus) .expect("Failed to register virtio bus!"); Ok(()) } #[inline(always)] pub fn virtio_driver_manager() -> &'static VirtIODriverManager { &VirtIODriverManager } pub struct VirtIODriverManager; impl VirtIODriverManager { pub fn register(&self, driver: Arc) -> Result<(), SystemError> { driver.set_bus(Some(Arc::downgrade(&(virtio_bus() as Arc)))); return driver_manager().register(driver as Arc); } #[allow(dead_code)] pub fn unregister(&self, driver: &Arc) { driver_manager().unregister(&(driver.clone() as Arc)); } } #[inline(always)] pub fn virtio_device_manager() -> &'static VirtIODeviceManager { &VirtIODeviceManager } pub struct VirtIODeviceManager; impl VirtIODeviceManager { pub fn device_add(&self, dev: Arc) -> Result<(), SystemError> { dev.set_bus(Some(Arc::downgrade(&(virtio_bus() as Arc)))); device_manager().device_default_initialize(&(dev.clone() as Arc)); let virtio_index = VIRTIO_DEVICE_INDEX_MANAGER.alloc(); dev.set_virtio_device_index(virtio_index); dev.set_device_name(format!("virtio{}", virtio_index.data())); device_manager().add_device(dev.clone() as Arc)?; let r = device_manager() .add_groups(&(dev.clone() as Arc), &[&VirtIODeviceAttrGroup]); self.setup_irq(&dev).ok(); return r; } /// # setup_irq - 设置中断 /// /// 为virtio设备设置中断。 fn setup_irq(&self, dev: &Arc) -> Result<(), SystemError> { let irq = dev.irq().ok_or(SystemError::EINVAL)?; if let Err(e) = irq_manager().request_irq( irq, dev.device_name(), &DefaultVirtioIrqHandler, IrqHandleFlags::IRQF_SHARED, Some(dev.dev_id().clone()), ) { error!( "Failed to request irq for virtio device '{}': irq: {:?}, error {:?}", dev.device_name(), irq, e ); return Err(e); } virtio_irq_manager() .register_device(dev.clone()) .map_err(|e| { error!( "Failed to register virtio device's irq, dev: '{}', irq: {:?}, error {:?}", dev.device_name(), irq, e ); e })?; return Ok(()); } #[allow(dead_code)] pub fn device_remove(&self, dev: &Arc) -> Result<(), SystemError> { device_manager().remove(&(dev.clone() as Arc)); return Ok(()); } } static VIRTIO_DEVICE_INDEX_MANAGER: VirtIODeviceIndexManager = VirtIODeviceIndexManager::new(); /// VirtIO设备索引管理器 /// /// VirtIO设备索引管理器用于分配和管理VirtIO设备的唯一索引。 pub struct VirtIODeviceIndexManager { // ID分配器 /// /// ID分配器用于分配唯一的索引给VirtIO设备。 ida: IdAllocator, } // VirtIO设备索引管理器的新建实例 impl VirtIODeviceIndexManager { /// 创建新的VirtIO设备索引管理器实例 /// /// 创建一个新的VirtIO设备索引管理器实例,初始时分配器从0开始,直到最大usize值。 const fn new() -> Self { Self { ida: IdAllocator::new(0, usize::MAX), } } /// 分配一个新的VirtIO设备索引 /// /// 分配一个唯一的索引给VirtIO设备。 pub fn alloc(&self) -> VirtIODeviceIndex { VirtIODeviceIndex(self.ida.alloc().unwrap()) } // 释放一个VirtIO设备索引 /// /// 释放之前分配的VirtIO设备索引,使其可以被重新使用。 #[allow(dead_code)] pub fn free(&self, index: VirtIODeviceIndex) { self.ida.free(index.0); } } /// VirtIO设备属性组 /// /// 参考 https://code.dragonos.org.cn/xref/linux-6.6.21/drivers/virtio/virtio.c#64 #[derive(Debug)] pub struct VirtIODeviceAttrGroup; impl AttributeGroup for VirtIODeviceAttrGroup { fn name(&self) -> Option<&str> { None } fn attrs(&self) -> &[&'static dyn Attribute] { &[&AttrDevice, &AttrVendor] } } #[derive(Debug)] struct AttrDevice; impl Attribute for AttrDevice { fn name(&self) -> &str { "device" } fn mode(&self) -> ModeType { SYSFS_ATTR_MODE_RO } fn support(&self) -> SysFSOpsSupport { SysFSOpsSupport::ATTR_SHOW } fn show(&self, kobj: Arc, buf: &mut [u8]) -> Result { let dev = kobj.cast::().map_err(|_| { error!("AttrDevice::show() failed: kobj is not a VirtIODevice"); SystemError::EINVAL })?; let device_type_id = dev.device_type_id(); return sysfs_emit_str(buf, &format!("0x{:04x}\n", device_type_id)); } } #[derive(Debug)] struct AttrVendor; impl Attribute for AttrVendor { fn name(&self) -> &str { "vendor" } fn mode(&self) -> ModeType { SYSFS_ATTR_MODE_RO } fn support(&self) -> SysFSOpsSupport { SysFSOpsSupport::ATTR_SHOW } fn show(&self, kobj: Arc, buf: &mut [u8]) -> Result { let dev = kobj.cast::().map_err(|_| { error!("AttrVendor::show() failed: kobj is not a VirtIODevice"); SystemError::EINVAL })?; let vendor = dev.vendor(); return sysfs_emit_str(buf, &format!("0x{:04x}\n", vendor)); } }