On Wed, Dec 18, 2024 at 03:36:35PM -0800, Fabien Parent wrote: > From: Fabien Parent <fabien.parent@xxxxxxxxxx> > > This commit adds a Rust abstraction to write Regulator drivers. Only > the features used by the NCV6336 driver were added to this abstraction. > > Signed-off-by: Fabien Parent <fabien.parent@xxxxxxxxxx> > --- > MAINTAINERS | 1 + > rust/bindings/bindings_helper.h | 1 + > rust/kernel/regulator.rs | 4 +- > rust/kernel/regulator/driver.rs | 850 ++++++++++++++++++++++++++++++++++++++++ > 4 files changed, 855 insertions(+), 1 deletion(-) > > diff --git a/MAINTAINERS b/MAINTAINERS > index 90c231f0aa7381aa8d206fb94c5d1f013dfcae41..87da43251bf0f20d2b5831345778ead592c407dc 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -25160,6 +25160,7 @@ F: drivers/regulator/ > F: include/dt-bindings/regulator/ > F: include/linux/regulator/ > F: rust/kernel/regulator.rs > +F: rust/kernel/regulator/ > K: regulator_get_optional > > VOLTAGE AND CURRENT REGULATOR IRQ HELPERS > diff --git a/rust/bindings/bindings_helper.h b/rust/bindings/bindings_helper.h > index b18d772bc3a0e78d749cc9e5ae81a4237a57f8c5..124129daea73c143c919d05814fc02bb4460ddfd 100644 > --- a/rust/bindings/bindings_helper.h > +++ b/rust/bindings/bindings_helper.h > @@ -30,6 +30,7 @@ > #include <linux/refcount.h> > #include <linux/regmap.h> > #include <linux/regulator/consumer.h> > +#include <linux/regulator/driver.h> > #include <linux/sched.h> > #include <linux/security.h> > #include <linux/slab.h> > diff --git a/rust/kernel/regulator.rs b/rust/kernel/regulator.rs > index d695ac955193efcfda62770784a92d70d606b93d..bd8202fe5702b944201e76553b9496e1d42cb429 100644 > --- a/rust/kernel/regulator.rs > +++ b/rust/kernel/regulator.rs > @@ -2,12 +2,14 @@ > > //! SoC Regulators Why "SoC", could be a regulator for anything else too, right? > > +pub mod driver; > + > use crate::{ > bindings, > error::{code::*, Error, Result}, > }; > > -/// Regulators operating modes > +/// [`driver::Device`] operating modes > #[derive(Copy, Clone)] > #[repr(u32)] > pub enum Mode { > diff --git a/rust/kernel/regulator/driver.rs b/rust/kernel/regulator/driver.rs > new file mode 100644 > index 0000000000000000000000000000000000000000..8079ea28fd5bf7b6871a0b1d2cea7a6fffcb43ca > --- /dev/null > +++ b/rust/kernel/regulator/driver.rs > @@ -0,0 +1,850 @@ > +// SPDX-License-Identifier: GPL-2.0 > + > +//! SoC Device Driver Interface Should rather be "Regulator Device Driver Interface". > +//! > +//! C header: [`include/linux/regulator/driver.h`](srctree/include/linux/regulator/driver.h) > +//! > +//! # Examples > +//! > +//! ``` > +//! use kernel::regulator::driver::{Config, Desc, Device, Driver, Type}; > +//! > +//! static DESC: Desc = > +//! Desc::new::<MyDeviceDriver>(kernel::c_str!("my-regulator-driver"), Type::Voltage); > +//! > +//! struct MyDeviceDriver; > +//! > +//! #[vtable] > +//! impl Driver for MyDeviceDriver { I usually prefer to keep the module prefix for the `Driver` traits, i.e. `impl regulator::Driver for ...`, this makes things a bit more obvious. > +//! type Data = (); > +//! > +//! // Implement supported `Driver`'s operations here. > +//! > +//! // Example: > +//! fn is_enabled(reg: &mut Device<Self::Data>) -> Result<bool> { > +//! Ok(true) > +//! } > +//! } > +//! > +//! impl MyDeviceDriver { > +//! fn probe(dev: &mut kernel::device::Device) { > +//! let _ = Device::register(dev, &DESC, Config::<<Self as Driver>::Data>::new(dev, ())); Like below, this is confusing, the device is immediately unregistered again. > +//! } > +//! } > +//! ``` > + > +use crate::{ > + device, > + error::{code::*, from_err_ptr, from_result, Error, Result}, > + macros::vtable, > + regulator::Mode, > + str::CStr, > + types::ForeignOwnable, > + ThisModule, > +}; > +use core::{marker::PhantomData, mem::ManuallyDrop, ptr::NonNull}; > + > +/// [`Device`]'s status > +#[derive(Eq, PartialEq)] > +pub enum Status { > + /// Device is off > + Off, > + /// Device is on > + On, > + /// Device is in an error state > + Error, > + /// Device is on and in Fast mode > + Fast, > + /// Device is on and in Normal mode > + Normal, > + /// Device is on and in Idle mode > + Idle, > + /// Device is on and in Standby mode > + Standby, > + /// Device is enabled but not regulating > + Bypass, > + /// Device is any other status > + Undefined, > +} > + > +impl TryFrom<core::ffi::c_uint> for Status { > + type Error = Error; > + > + fn try_from(status: core::ffi::c_uint) -> Result<Self> { > + match status { > + bindings::regulator_status_REGULATOR_STATUS_OFF => Ok(Self::Off), > + bindings::regulator_status_REGULATOR_STATUS_ON => Ok(Self::On), > + bindings::regulator_status_REGULATOR_STATUS_ERROR => Ok(Self::Error), > + bindings::regulator_status_REGULATOR_STATUS_FAST => Ok(Self::Fast), > + bindings::regulator_status_REGULATOR_STATUS_NORMAL => Ok(Self::Normal), > + bindings::regulator_status_REGULATOR_STATUS_IDLE => Ok(Self::Idle), > + bindings::regulator_status_REGULATOR_STATUS_STANDBY => Ok(Self::Standby), > + bindings::regulator_status_REGULATOR_STATUS_BYPASS => Ok(Self::Bypass), > + bindings::regulator_status_REGULATOR_STATUS_UNDEFINED => Ok(Self::Undefined), > + _ => Err(EINVAL), > + } > + } > +} > + > +impl From<Mode> for Status { > + fn from(mode: Mode) -> Self { > + // SAFETY: `regulator_mode_to_status` is a `pure function` that is only doing integer > + // to integer conversion, hence this function call is safe. > + let status = unsafe { bindings::regulator_mode_to_status(mode as _) }; > + > + if status < 0 { > + Self::Undefined > + } else { > + Self::try_from(status as core::ffi::c_uint).unwrap_or(Self::Undefined) > + } > + } > +} > + > +/// [`Device`]'s operations > +#[vtable] > +pub trait Driver { > + /// User data that will be accessible to all operations > + type Data: ForeignOwnable + Send + Sync; > + > + /// Return one of the supported voltages, in microvolt; zero if the selector indicates a > + /// voltage that is unusable by the system; or negative errno. Selectors range from zero to one > + /// less than the number of voltages supported by the system. > + fn list_voltage(_rdev: &mut Device<Self::Data>, _selector: u32) -> Result<i32> { > + Err(ENOTSUPP) > + } > + > + /// Set the voltage for the regulator within the range specified. The driver should select the > + /// voltage closest to `min_uv`. > + fn set_voltage(_rdev: &mut Device<Self::Data>, _min_uv: i32, _max_uv: i32) -> Result<i32> { > + Err(ENOTSUPP) > + } > + > + /// Set the voltage for the regulator using the specified selector. > + fn set_voltage_sel(_rdev: &mut Device<Self::Data>, _selector: u32) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Convert a voltage into a selector. > + fn map_voltage(_rdev: &mut Device<Self::Data>, _min_uv: i32, _max_uv: i32) -> Result<i32> { > + Err(ENOTSUPP) > + } > + > + /// Get the currently configured voltage for the regulator; Returns > + /// [`ENOTRECOVERABLE`] if the regulator can't be read at bootup and hasn't been > + /// set yet. > + fn get_voltage(_rdev: &mut Device<Self::Data>) -> Result<i32> { > + Err(ENOTSUPP) > + } > + > + /// Get the currently configured voltage selector for the regulator; Returns > + /// [`ENOTRECOVERABLE`] if the regulator can't be read at bootup and hasn't been > + /// set yet. > + fn get_voltage_sel(_rdev: &mut Device<Self::Data>) -> Result<i32> { > + Err(ENOTSUPP) > + } > + > + /// Configure a limit for a current-limited regulator. > + /// > + /// The driver should select the current closest to `max_ua`. > + fn set_current_limit(_rdev: &mut Device<Self::Data>, _min_ua: i32, _max_ua: i32) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Get the configured limit for a current-limited regulator. > + fn get_current_limit(_rdev: &mut Device<Self::Data>) -> Result<i32> { > + Err(ENOTSUPP) > + } > + > + /// Enable or disable the active discharge of the regulator. > + fn set_active_discharge(_rdev: &mut Device<Self::Data>, _enable: bool) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Configure the regulator as enabled. > + fn enable(_rdev: &mut Device<Self::Data>) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Configure the regulator as disabled. > + fn disable(_rdev: &mut Device<Self::Data>) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Returns enablement state of the regulator. > + fn is_enabled(_rdev: &mut Device<Self::Data>) -> Result<bool> { > + Err(ENOTSUPP) > + } > + > + /// Set the configured operating [`Mode`] for the regulator. > + fn set_mode(_rdev: &mut Device<Self::Data>, _mode: Mode) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Get the configured operating [`Mode`] for the regulator. > + fn get_mode(_rdev: &mut Device<Self::Data>) -> Mode { > + Mode::Invalid > + } > + > + /// Report the regulator [`Status`]. > + fn get_status(_rdev: &mut Device<Self::Data>) -> Result<Status> { > + Err(ENOTSUPP) > + } > + > + /// Set the voltage for the regaultor when the system is suspended. > + fn set_suspend_voltage(_rdev: &mut Device<Self::Data>, _uv: i32) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Mark the regulator as enabled when the system is suspended. > + fn set_suspend_enable(_rdev: &mut Device<Self::Data>) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Mark the regulator as disabled when the system is suspended. > + fn set_suspend_disable(_rdev: &mut Device<Self::Data>) -> Result { > + Err(ENOTSUPP) > + } > + > + /// Set the operating mode for the regulator when the system is suspended. > + fn set_suspend_mode(_rdev: &mut Device<Self::Data>, _mode: Mode) -> Result { > + Err(ENOTSUPP) > + } > +} > + > +/// [`Device`]'s descriptor > +/// > +/// # Examples > +/// > +/// ``` > +/// use kernel::{ > +/// c_str, > +/// device, > +/// regulator::driver::{Config, Desc, Device, Driver, Type}, > +/// types::ForeignOwnable, > +/// }; > +/// > +/// struct MyDeviceDriver; > +/// > +/// #[vtable] > +/// impl Driver for MyDeviceDriver { > +/// type Data = (); > +/// } This seems incomplete. > +/// > +/// static BUCK_DESC: Desc = Desc::new::<MyDeviceDriver>(c_str!("my_driver"), Type::Voltage) > +/// .with_of_match(c_str!("buck")) > +/// .with_enable(0x24, 0x1, 0x1, 0); > +/// > +/// fn example(dev: &mut device::Device, mut config: Config<<MyDeviceDriver as Driver>::Data>) { > +/// let _ = Device::register(dev, &BUCK_DESC, config); > +/// } `example`? This should be within a driver trait with `probe` instead. > +/// ``` > +/// > +/// # Invariants > +/// > +/// `self.0` has always valid data. > +pub struct Desc(bindings::regulator_desc); I think this needs `#[repr(transparent)]`. > +impl Desc { > + /// Create a new [`Device`] descriptor > + pub const fn new<T: Driver>(name: &'static CStr, reg_type: Type) -> Self { > + // SAFETY: `bindings::regulator_desc" is safe to initialize with 0s. > + let mut desc: bindings::regulator_desc = unsafe { core::mem::zeroed() }; > + desc.name = name.as_char_ptr(); > + desc.type_ = match reg_type { > + Type::Voltage => bindings::regulator_type_REGULATOR_VOLTAGE, > + Type::Current => bindings::regulator_type_REGULATOR_CURRENT, > + }; > + desc.ops = Adapter::<T>::build(); > + Self(desc) > + } > + > + /// Setup the register address, mask, and {en,dis}able values > + pub const fn with_enable(mut self, reg: u32, mask: u32, en_val: u32, dis_val: u32) -> Self { > + self.0.enable_reg = reg; > + self.0.enable_mask = mask; > + self.0.enable_val = en_val; > + self.0.disable_val = dis_val; > + self > + } > + > + /// Setup the register address, mask, and {en,dis}able values. {En,Dis}able values are > + /// inverted, i.e. `dis_val` will be use to enable the regulator while `en_val` will be used > + /// to disable the regulator. > + pub const fn with_inverted_enable( > + mut self, > + reg: u32, > + mask: u32, > + en_val: u32, > + dis_val: u32, > + ) -> Self { > + self.0.enable_is_inverted = true; > + self.with_enable(reg, mask, en_val, dis_val) > + } > + > + /// Setup the active discharge regiter address, mask, on/off values. > + pub const fn with_active_discharge(mut self, reg: u32, mask: u32, on: u32, off: u32) -> Self { > + self.0.active_discharge_on = on; > + self.0.active_discharge_off = off; > + self.0.active_discharge_reg = reg; > + self.0.active_discharge_mask = mask; > + self > + } > + > + /// Setup the current selection register address, mask, and current table > + pub const fn with_csel(mut self, reg: u32, mask: u32, table: &'static [u32]) -> Self { > + self.0.csel_reg = reg; > + self.0.csel_mask = mask; > + self.0.curr_table = table.as_ptr(); > + self > + } > + > + /// Voltages are a linear mapping > + pub const fn with_linear_mapping( > + mut self, > + reg: u32, > + mask: u32, > + min_uv: u32, > + uv_step: u32, > + n_voltages: u32, > + linear_min_sel: u32, > + ) -> Self { > + self.0.vsel_reg = reg; > + self.0.vsel_mask = mask; > + self.0.n_voltages = n_voltages; > + self.0.min_uV = min_uv; > + self.0.uV_step = uv_step; > + self.0.linear_min_sel = linear_min_sel; > + self > + } > + > + /// Set the regulator owner > + pub const fn with_owner(mut self, owner: &'static ThisModule) -> Self { > + self.0.owner = owner.as_ptr(); > + self > + } > + > + /// Set the name used to identify the regulator in the DT. > + pub const fn with_of_match(mut self, of_match: &'static CStr) -> Self { > + self.0.of_match = of_match.as_char_ptr(); > + self > + } > +} > + > +// SAFETY: `Desc` cannot be modified after its declaration and owns its data, hence it is safe > +// to share references between threads. > +unsafe impl Sync for Desc {} > + > +/// [`Device`]'s Config > +/// > +/// # Examples > +/// > +/// ``` > +/// use kernel::regulator::driver::Config; > +/// # use kernel::regulator::driver::{Desc, Device}; > +/// # use kernel::{device, sync::Arc}; > +/// > +/// struct DriverData(u32); > +/// > +/// # fn probe(dev: &device::Device, desc: &'static Desc) -> Result { > +/// let config = Config::<Arc<DriverData>>::new(dev, Arc::new(DriverData(128), GFP_KERNEL)?); Why does this need reference counting? > +/// let reg = Device::register(dev, desc, config)?; > +/// # Ok(()) > +/// # } I think this example is a bit misleading, the regulator device is immediately unregistered after probe() returns. Here you have to rely on the driver to keep `reg` alive until the device is dropped. Instead you can use `Devres::new_foreign_owned`, like I do in [1]. [1] https://cgit.freedesktop.org/drm/drm-misc/tree/rust/kernel/drm/drv.rs?h=topic/rust-drm#n173 > +/// ``` > +/// > +/// # Invariants > +/// > +/// `self.cfg` always hold valid data. > +pub struct Config<T: ForeignOwnable + Send + Sync = ()> { > + cfg: bindings::regulator_config, > + data: T, > +} > + > +impl<T: ForeignOwnable + Send + Sync> Config<T> { > + /// Create a [`Device`] config. > + pub fn new(dev: &device::Device, data: T) -> Self { > + Self { > + cfg: bindings::regulator_config { > + dev: dev.as_raw(), > + ..Default::default() > + }, > + data, > + } > + } > +} > + > +/// Regulator device > +/// > +/// Abstraction for `struct regulator_dev`. > +/// > +/// # Invariants > +/// > +/// * `self.rdev` is valid and non-null. > +/// * [`Self`] has owns `self.rdev` memory allocation. > +/// * [`Self`] has owns memory of type `T` that can be retrieved through `rdev_get_drvdata`. > +pub struct Device<T: ForeignOwnable + Send + Sync> { > + rdev: NonNull<bindings::regulator_dev>, > + _data_type: PhantomData<T>, > +} I think you should split this into a `regulator::Device` and a `regulator::Registration` structure instead. For regulator this seems to works as well, but it gets confusing if we do not stick to the same representations between subsystems. > + > +impl<T: ForeignOwnable + Send + Sync> Device<T> { > + /// # Safety > + /// > + /// `rdev` must be valid and non-null. > + unsafe fn from_raw(rdev: *mut bindings::regulator_dev) -> ManuallyDrop<Self> { > + ManuallyDrop::new(Self { > + // SAFETY: The caller of `Self::from_raw` must garantee that `rdev` is non-null and > + // valid.. > + rdev: unsafe { NonNull::new_unchecked(rdev) }, > + _data_type: PhantomData::<T>, > + }) > + } > + > + /// register a Regulator driver > + pub fn register( > + dev: &device::Device, > + desc: &'static Desc, > + mut config: Config<T>, > + ) -> Result<Self> { > + config.cfg.driver_data = config.data.into_foreign() as _; > + > + // SAFETY: By the type invariants, we know that `dev.as_ref().as_raw()` is always > + // valid and non-null, and the descriptor and config are guaranteed to be valid values, > + // hence it is safe to perform the FFI call. > + let rdev = from_err_ptr(unsafe { > + bindings::regulator_register(dev.as_raw(), &desc.0, &config.cfg) > + })?; > + > + Ok(Self { > + rdev: NonNull::new(rdev).ok_or(EINVAL)?, > + _data_type: PhantomData::<T>, > + }) > + } > + > + /// List voltages when the regulator is using linear mapping > + pub fn list_voltage_linear(&self, selector: u32) -> Result<i32> { > + // SAFETY: By the type invariants, we know that `self.rdev` is always valid and non-null. > + // The C function is safe to call with any selector values. > + let ret = unsafe { bindings::regulator_list_voltage_linear(self.rdev.as_ptr(), selector) }; > + if ret < 0 { > + return Err(Error::from_errno(ret)); > + } > + Ok(ret) > + } > + > + /// Get regulator's name > + pub fn get_name(&self) -> &'static CStr { > + // SAFETY: By the type invariants, we know that `self.rdev` is always valid and non-null. > + // The C function is guaranteed to return a valid string. > + unsafe { CStr::from_char_ptr(bindings::rdev_get_name(self.rdev.as_ptr())) } > + } > + > + /// Get regulator's ID > + pub fn get_id(&self) -> i32 { > + // SAFETY: By the type invariants, we know that `self.rdev` is always valid and non-null. > + unsafe { bindings::rdev_get_id(self.rdev.as_ptr()) } > + } > + > + /// Retrieve driver data associated to `self` > + pub fn data(&self) -> T::Borrowed<'_> { > + // SAFETY: By the type invariants, we know that `self.rdev` is always valid and non-null. > + unsafe { T::borrow(bindings::rdev_get_drvdata(self.rdev.as_ptr())) } > + } > +} > + > +impl<T: ForeignOwnable + Send + Sync> Drop for Device<T> { > + fn drop(&mut self) { > + // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null, > + // so it is safe to perform the FFI call. > + unsafe { bindings::regulator_unregister(self.rdev.as_ptr()) }; > + > + // SAFETY: The type invariants garuantee that `self.rdev` is valid and non-null, and > + // that `rdev_get_drvdata` is valid memory of type `T` stored there by calling > + // `T::into_foreign`. > + unsafe { T::from_foreign(bindings::rdev_get_drvdata(self.rdev.as_ptr())) }; > + } > +} > + > +// SAFETY: `Device` has sole ownership of `self.rdev` and is never read outside of the C > +// implementation. It is safe to use it from any thread. > +unsafe impl<T: ForeignOwnable + Send + Sync> Send for Device<T> {} > + > +// SAFETY: It is OK to access `Device` through shared references from other threads because > +// the C code is insuring proper synchronization of `self.rdev`. > +unsafe impl<T: ForeignOwnable + Send + Sync> Sync for Device<T> {} > + > +/// [`Device`] type > +pub enum Type { > + /// Voltage regulator > + Voltage, > + /// Current regulator > + Current, > +} > + > +pub(crate) struct Adapter<T>(PhantomData<T>); > + > +impl<T: Driver> Adapter<T> { > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn list_voltage_callback( > + rdev: *mut bindings::regulator_dev, > + selector: core::ffi::c_uint, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| T::list_voltage(&mut rdev, selector)) > + } > + > + /// # Safety > + /// > + /// `rdev` and `selector` must be non-null and valid. > + unsafe extern "C" fn set_voltage_callback( > + rdev: *mut bindings::regulator_dev, > + min_uv: core::ffi::c_int, > + max_uv: core::ffi::c_int, > + selector: *mut core::ffi::c_uint, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + match T::set_voltage(&mut rdev, min_uv, max_uv) { > + Ok(v) => { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + unsafe { *selector = v as _ }; > + 0 > + } > + Err(e) => e.to_errno(), > + } > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn map_voltage_callback( > + rdev: *mut bindings::regulator_dev, > + min_uv: core::ffi::c_int, > + max_uv: core::ffi::c_int, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| T::map_voltage(&mut rdev, min_uv, max_uv)) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_voltage_sel_callback( > + rdev: *mut bindings::regulator_dev, > + selector: core::ffi::c_uint, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::set_voltage_sel(&mut rdev, selector)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn get_voltage_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| T::get_voltage(&mut rdev)) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn get_voltage_sel_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| T::get_voltage_sel(&mut rdev)) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_current_limit_callback( > + rdev: *mut bindings::regulator_dev, > + min_ua: core::ffi::c_int, > + max_ua: core::ffi::c_int, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::set_current_limit(&mut rdev, min_ua, max_ua)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn get_current_limit_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| T::get_current_limit(&mut rdev)) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_active_discharge_callback( > + rdev: *mut bindings::regulator_dev, > + enable: bool, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::set_active_discharge(&mut rdev, enable)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn enable_callback(rdev: *mut bindings::regulator_dev) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::enable(&mut rdev)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn disable_callback(rdev: *mut bindings::regulator_dev) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::disable(&mut rdev)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn is_enabled_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::is_enabled(&mut rdev)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_mode_callback( > + rdev: *mut bindings::regulator_dev, > + mode: core::ffi::c_uint, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + let mode = Mode::try_from(mode).unwrap_or(Mode::Invalid); > + T::set_mode(&mut rdev, mode)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn get_mode_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_uint { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + T::get_mode(&mut rdev) as _ > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn get_status_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| Ok(T::get_status(&mut rdev)? as _)) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_suspend_voltage_callback( > + rdev: *mut bindings::regulator_dev, > + uv: core::ffi::c_int, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::set_suspend_voltage(&mut rdev, uv)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_suspend_enable_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::set_suspend_enable(&mut rdev)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_suspend_disable_callback( > + rdev: *mut bindings::regulator_dev, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + T::set_suspend_disable(&mut rdev)?; > + Ok(0) > + }) > + } > + > + /// # Safety > + /// > + /// `rdev` must be non-null and valid. > + unsafe extern "C" fn set_suspend_mode_callback( > + rdev: *mut bindings::regulator_dev, > + mode: core::ffi::c_uint, > + ) -> core::ffi::c_int { > + // SAFETY: Per this function safety requirements, `rdev` is non-null and valid. > + let mut rdev = unsafe { Device::from_raw(rdev) }; > + from_result(|| { > + let mode = Mode::try_from(mode).unwrap_or(Mode::Invalid); > + T::set_suspend_mode(&mut rdev, mode)?; > + Ok(0) > + }) > + } > + > + const VTABLE: bindings::regulator_ops = bindings::regulator_ops { > + list_voltage: if T::HAS_LIST_VOLTAGE { > + Some(Adapter::<T>::list_voltage_callback) > + } else { > + None > + }, > + set_voltage: if T::HAS_SET_VOLTAGE { > + Some(Adapter::<T>::set_voltage_callback) > + } else { > + None > + }, > + map_voltage: if T::HAS_MAP_VOLTAGE { > + Some(Adapter::<T>::map_voltage_callback) > + } else { > + None > + }, > + set_voltage_sel: if T::HAS_SET_VOLTAGE_SEL { > + Some(Adapter::<T>::set_voltage_sel_callback) > + } else { > + None > + }, > + get_voltage: if T::HAS_GET_VOLTAGE { > + Some(Adapter::<T>::get_voltage_callback) > + } else { > + None > + }, > + get_voltage_sel: if T::HAS_GET_VOLTAGE_SEL { > + Some(Adapter::<T>::get_voltage_sel_callback) > + } else { > + None > + }, > + set_current_limit: if T::HAS_SET_CURRENT_LIMIT { > + Some(Adapter::<T>::set_current_limit_callback) > + } else { > + None > + }, > + get_current_limit: if T::HAS_GET_CURRENT_LIMIT { > + Some(Adapter::<T>::get_current_limit_callback) > + } else { > + None > + }, > + set_active_discharge: if T::HAS_SET_ACTIVE_DISCHARGE { > + Some(Adapter::<T>::set_active_discharge_callback) > + } else { > + None > + }, > + enable: if T::HAS_ENABLE { > + Some(Adapter::<T>::enable_callback) > + } else { > + None > + }, > + disable: if T::HAS_DISABLE { > + Some(Adapter::<T>::disable_callback) > + } else { > + None > + }, > + is_enabled: if T::HAS_IS_ENABLED { > + Some(Adapter::<T>::is_enabled_callback) > + } else { > + None > + }, > + set_mode: if T::HAS_SET_MODE { > + Some(Adapter::<T>::set_mode_callback) > + } else { > + None > + }, > + get_mode: if T::HAS_GET_MODE { > + Some(Adapter::<T>::get_mode_callback) > + } else { > + None > + }, > + get_status: if T::HAS_GET_STATUS { > + Some(Adapter::<T>::get_status_callback) > + } else { > + None > + }, > + set_suspend_voltage: if T::HAS_SET_SUSPEND_VOLTAGE { > + Some(Adapter::<T>::set_suspend_voltage_callback) > + } else { > + None > + }, > + set_suspend_enable: if T::HAS_SET_SUSPEND_ENABLE { > + Some(Adapter::<T>::set_suspend_enable_callback) > + } else { > + None > + }, > + set_suspend_disable: if T::HAS_SET_SUSPEND_DISABLE { > + Some(Adapter::<T>::set_suspend_disable_callback) > + } else { > + None > + }, > + set_suspend_mode: if T::HAS_SET_SUSPEND_MODE { > + Some(Adapter::<T>::set_suspend_mode_callback) > + } else { > + None > + }, > + // SAFETY: The rest is zeroed out to initialize `struct regulator_ops`, > + // sets `Option<&F>` to be `None`. > + ..unsafe { core::mem::zeroed() } > + }; > + > + const fn build() -> &'static bindings::regulator_ops { > + &Self::VTABLE > + } > +} > > -- > 2.45.2 > >