// SPDX-License-Identifier: GPL-2.0 //! Rust auxiliary driver sample (based on a PCI driver for QEMU's `pci-testdev`). //! //! To make this driver probe, QEMU must be run with `-device pci-testdev`. use kernel::{ auxiliary, c_str, device::{Bound, Core}, devres::Devres, driver, error::Error, pci, prelude::*, InPlaceModule, }; use core::any::TypeId; use pin_init::PinInit; const MODULE_NAME: &CStr = ::NAME; const AUXILIARY_NAME: &CStr = c_str!("auxiliary"); struct AuxiliaryDriver; kernel::auxiliary_device_table!( AUX_TABLE, MODULE_AUX_TABLE, ::IdInfo, [(auxiliary::DeviceId::new(MODULE_NAME, AUXILIARY_NAME), ())] ); impl auxiliary::Driver for AuxiliaryDriver { type IdInfo = (); const ID_TABLE: auxiliary::IdTable = &AUX_TABLE; fn probe(adev: &auxiliary::Device, _info: &Self::IdInfo) -> impl PinInit { dev_info!( adev.as_ref(), "Probing auxiliary driver for auxiliary device with id={}\n", adev.id() ); ParentDriver::connect(adev)?; Ok(Self) } } #[pin_data] struct ParentDriver { private: TypeId, #[pin] _reg0: Devres, #[pin] _reg1: Devres, } kernel::pci_device_table!( PCI_TABLE, MODULE_PCI_TABLE, ::IdInfo, [(pci::DeviceId::from_id(pci::Vendor::REDHAT, 0x5), ())] ); impl pci::Driver for ParentDriver { type IdInfo = (); const ID_TABLE: pci::IdTable = &PCI_TABLE; fn probe(pdev: &pci::Device, _info: &Self::IdInfo) -> impl PinInit { try_pin_init!(Self { private: TypeId::of::(), _reg0 <- auxiliary::Registration::new(pdev.as_ref(), AUXILIARY_NAME, 0, MODULE_NAME), _reg1 <- auxiliary::Registration::new(pdev.as_ref(), AUXILIARY_NAME, 1, MODULE_NAME), }) } } impl ParentDriver { fn connect(adev: &auxiliary::Device) -> Result { let dev = adev.parent(); let pdev: &pci::Device = dev.try_into()?; let drvdata = dev.drvdata::()?; dev_info!( dev, "Connect auxiliary {} with parent: VendorID={}, DeviceID={:#x}\n", adev.id(), pdev.vendor_id(), pdev.device_id() ); dev_info!( dev, "We have access to the private data of {:?}.\n", drvdata.private ); Ok(()) } } #[pin_data] struct SampleModule { #[pin] _pci_driver: driver::Registration>, #[pin] _aux_driver: driver::Registration>, } impl InPlaceModule for SampleModule { fn init(module: &'static kernel::ThisModule) -> impl PinInit { try_pin_init!(Self { _pci_driver <- driver::Registration::new(MODULE_NAME, module), _aux_driver <- driver::Registration::new(MODULE_NAME, module), }) } } module! { type: SampleModule, name: "rust_driver_auxiliary", authors: ["Danilo Krummrich"], description: "Rust auxiliary driver", license: "GPL v2", }