[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-ID: <Z2P00_DCL5H6Zwor@pollux.localdomain>
Date: Thu, 19 Dec 2024 11:26:27 +0100
From: Danilo Krummrich <dakr@...nel.org>
To: Fabien Parent <parent.f@...il.com>
Cc: Rob Herring <robh@...nel.org>, Saravana Kannan <saravanak@...gle.com>,
Miguel Ojeda <ojeda@...nel.org>,
Alex Gaynor <alex.gaynor@...il.com>,
Boqun Feng <boqun.feng@...il.com>, Gary Guo <gary@...yguo.net>,
Björn Roy Baron <bjorn3_gh@...tonmail.com>,
Benno Lossin <benno.lossin@...ton.me>,
Andreas Hindborg <a.hindborg@...nel.org>,
Alice Ryhl <aliceryhl@...gle.com>, Trevor Gross <tmgross@...ch.edu>,
Greg Kroah-Hartman <gregkh@...uxfoundation.org>,
"Rafael J. Wysocki" <rafael@...nel.org>,
Wolfram Sang <wsa+renesas@...g-engineering.com>,
Mark Brown <broonie@...nel.org>,
Liam Girdwood <lgirdwood@...il.com>,
Krzysztof Kozlowski <krzk+dt@...nel.org>,
Conor Dooley <conor+dt@...nel.org>,
Bjorn Andersson <andersson@...nel.org>,
Konrad Dybcio <konradybcio@...nel.org>, devicetree@...r.kernel.org,
rust-for-linux@...r.kernel.org, linux-kernel@...r.kernel.org,
linux-i2c@...r.kernel.org, linux-arm-msm@...r.kernel.org,
vinod.koul@...aro.org, Fabien Parent <fabien.parent@...aro.org>
Subject: Re: [PATCH 5/9] rust: regulator: add Regulator Driver abstraction
On Wed, Dec 18, 2024 at 03:36:35PM -0800, Fabien Parent wrote:
> From: Fabien Parent <fabien.parent@...aro.org>
>
> 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@...aro.org>
> ---
> 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
>
>
Powered by blists - more mailing lists