206 lines · 7.9 KB · Rust
RawDownload
// SPDX-License-Identifier: GPL-2.0 //! Generic implementation of device IDs.//!//! Each bus / subsystem that matches device and driver through a bus / subsystem specific ID is//! expected to implement [`RawDeviceId`]. use core::mem::MaybeUninit; /// Marker trait to indicate a Rust device ID type represents a corresponding C device ID type.////// This is meant to be implemented by buses/subsystems so that they can use [`IdTable`] to/// guarantee (at compile-time) zero-termination of device id tables provided by drivers.////// # Safety////// Implementers must ensure that `Self` is layout-compatible with [`RawDeviceId::RawType`];/// i.e. it's safe to transmute to `RawType`.////// This requirement is needed so `IdArray::new` can convert `Self` to `RawType` when building/// the ID table.////// Ideally, this should be achieved using a const function that does conversion instead of/// transmute; however, const trait functions relies on `const_trait_impl` unstable feature,/// which is broken/gone in Rust 1.73.pub unsafe trait RawDeviceId {    /// The raw type that holds the device id.    ///    /// Id tables created from [`Self`] are going to hold this type in its zero-terminated array.    type RawType: Copy;} /// Extension trait for [`RawDeviceId`] for devices that embed an index or context value.////// This is typically used when the device ID struct includes a field like `driver_data`/// that is used to store a pointer-sized value (e.g., an index or context pointer).////// # Safety////// Implementers must ensure that `DRIVER_DATA_OFFSET` is the correct offset (in bytes) to/// the context/data field (e.g., the `driver_data` field) within the raw device ID structure./// This field must be correctly sized to hold a `usize`.////// Ideally, the data should be added during `Self` to `RawType` conversion,/// but there's currently no way to do it when using traits in const.pub unsafe trait RawDeviceIdIndex: RawDeviceId {    /// The offset (in bytes) to the context/data field in the raw device ID.    const DRIVER_DATA_OFFSET: usize;     /// The index stored at `DRIVER_DATA_OFFSET` of the implementor of the [`RawDeviceIdIndex`]    /// trait.    fn index(&self) -> usize;} /// A zero-terminated device id array.#[repr(C)]pub struct RawIdArray<T: RawDeviceId, const N: usize> {    ids: [T::RawType; N],    sentinel: MaybeUninit<T::RawType>,} impl<T: RawDeviceId, const N: usize> RawIdArray<T, N> {    #[doc(hidden)]    pub const fn size(&self) -> usize {        core::mem::size_of::<Self>()    }} /// A zero-terminated device id array, followed by context data.#[repr(C)]pub struct IdArray<T: RawDeviceId, U, const N: usize> {    raw_ids: RawIdArray<T, N>,    id_infos: [U; N],} impl<T: RawDeviceId, U, const N: usize> IdArray<T, U, N> {    /// Creates a new instance of the array.    ///    /// The contents are derived from the given identifiers and context information.    ///    /// # Safety    ///    /// `data_offset` as `None` is always safe.    /// If `data_offset` is `Some(data_offset)`, then:    /// - `data_offset` must be the correct offset (in bytes) to the context/data field    ///   (e.g., the `driver_data` field) within the raw device ID structure.    /// - The field at `data_offset` must be correctly sized to hold a `usize`.    const unsafe fn build(ids: [(T, U); N], data_offset: Option<usize>) -> Self {        let mut raw_ids = [const { MaybeUninit::<T::RawType>::uninit() }; N];        let mut infos = [const { MaybeUninit::uninit() }; N];         let mut i = 0usize;        while i < N {            // SAFETY: by the safety requirement of `RawDeviceId`, we're guaranteed that `T` is            // layout-wise compatible with `RawType`.            raw_ids[i] = unsafe { core::mem::transmute_copy(&ids[i].0) };            if let Some(data_offset) = data_offset {                // SAFETY: by the safety requirement of this function, this would be effectively                // `raw_ids[i].driver_data = i;`.                unsafe {                    raw_ids[i]                        .as_mut_ptr()                        .byte_add(data_offset)                        .cast::<usize>()                        .write(i);                }            }             // SAFETY: this is effectively a move: `infos[i] = ids[i].1`. We make a copy here but            // later forget `ids`.            infos[i] = MaybeUninit::new(unsafe { core::ptr::read(&ids[i].1) });            i += 1;        }         core::mem::forget(ids);         Self {            raw_ids: RawIdArray {                // SAFETY: this is effectively `array_assume_init`, which is unstable, so we use                // `transmute_copy` instead. We have initialized all elements of `raw_ids` so this                // `array_assume_init` is safe.                ids: unsafe { core::mem::transmute_copy(&raw_ids) },                sentinel: MaybeUninit::zeroed(),            },            // SAFETY: We have initialized all elements of `infos` so this `array_assume_init` is            // safe.            id_infos: unsafe { core::mem::transmute_copy(&infos) },        }    }     /// Creates a new instance of the array without writing index values.    ///    /// The contents are derived from the given identifiers and context information.    /// If the device implements [`RawDeviceIdIndex`], consider using [`IdArray::new`] instead.    pub const fn new_without_index(ids: [(T, U); N]) -> Self {        // SAFETY: Calling `Self::build` with `offset = None` is always safe,        // because no raw memory writes are performed in this case.        unsafe { Self::build(ids, None) }    }     /// Reference to the contained [`RawIdArray`].    pub const fn raw_ids(&self) -> &RawIdArray<T, N> {        &self.raw_ids    }} impl<T: RawDeviceId + RawDeviceIdIndex, U, const N: usize> IdArray<T, U, N> {    /// Creates a new instance of the array.    ///    /// The contents are derived from the given identifiers and context information.    pub const fn new(ids: [(T, U); N]) -> Self {        // SAFETY: by the safety requirement of `RawDeviceIdIndex`,        // `T::DRIVER_DATA_OFFSET` is guaranteed to be the correct offset (in bytes) to        // a field within `T::RawType`.        unsafe { Self::build(ids, Some(T::DRIVER_DATA_OFFSET)) }    }} /// A device id table.////// This trait is only implemented by `IdArray`.////// The purpose of this trait is to allow `&'static dyn IdArray<T, U>` to be in context when `N` in/// `IdArray` doesn't matter.pub trait IdTable<T: RawDeviceId, U> {    /// Obtain the pointer to the ID table.    fn as_ptr(&self) -> *const T::RawType;     /// Obtain the pointer to the bus specific device ID from an index.    fn id(&self, index: usize) -> &T::RawType;     /// Obtain the pointer to the driver-specific information from an index.    fn info(&self, index: usize) -> &U;} impl<T: RawDeviceId, U, const N: usize> IdTable<T, U> for IdArray<T, U, N> {    fn as_ptr(&self) -> *const T::RawType {        // This cannot be `self.ids.as_ptr()`, as the return pointer must have correct provenance        // to access the sentinel.        core::ptr::from_ref(self).cast()    }     fn id(&self, index: usize) -> &T::RawType {        &self.raw_ids.ids[index]    }     fn info(&self, index: usize) -> &U {        &self.id_infos[index]    }} /// Create device table alias for modpost.#[macro_export]macro_rules! module_device_table {    ($table_type: literal, $module_table_name:ident, $table_name:ident) => {        #[rustfmt::skip]        #[export_name =            concat!("__mod_device_table__", line!(),                    "__kmod_", module_path!(),                    "__", $table_type,                    "__", stringify!($table_name))        ]        static $module_table_name: [::core::mem::MaybeUninit<u8>; $table_name.raw_ids().size()] =            unsafe { ::core::mem::transmute_copy($table_name.raw_ids()) };    };}