From: Fabien Parent <fabien.parent@xxxxxxxxxx>
The regulator API offer many helpers to help simplifies drivers that
use the regmap API. This commit adds partial support for it, only the
function needed by the NCV6336 driver were added.
Signed-off-by: Fabien Parent <fabien.parent@xxxxxxxxxx>
---
rust/kernel/regulator/driver.rs | 141 ++++++++++++++++++++++++++++++++++++++++
1 file changed, 141 insertions(+)
diff --git a/rust/kernel/regulator/driver.rs b/rust/kernel/regulator/driver.rs
index 8079ea28fd5bf7b6871a0b1d2cea7a6fffcb43ca..e79e93122b094e5e086780f18ecdac5105d07153 100644
--- a/rust/kernel/regulator/driver.rs
+++ b/rust/kernel/regulator/driver.rs
@@ -37,13 +37,27 @@
device,
error::{code::*, from_err_ptr, from_result, Error, Result},
macros::vtable,
+ private::Sealed,
regulator::Mode,
str::CStr,
+ sync::Arc,
types::ForeignOwnable,
ThisModule,
};
+#[cfg(CONFIG_REGMAP)]
+use crate::{error::to_result, regmap::Regmap};
use core::{marker::PhantomData, mem::ManuallyDrop, ptr::NonNull};
+#[cfg(not(CONFIG_REGMAP))]
+struct Regmap;
+
+#[cfg(not(CONFIG_REGMAP))]
+impl Regmap {
+ pub fn as_raw(&self) -> *mut bindings::regmap {
+ core::ptr::null_mut()
+ }
+}
+
/// [`Device`]'s status
#[derive(Eq, PartialEq)]
pub enum Status {
@@ -357,6 +371,7 @@ unsafe impl Sync for Desc {}
pub struct Config<T: ForeignOwnable + Send + Sync = ()> {
cfg: bindings::regulator_config,
data: T,
+ regmap: Option<Arc<Regmap>>,
}
impl<T: ForeignOwnable + Send + Sync> Config<T> {
@@ -368,8 +383,16 @@ pub fn new(dev: &device::Device, data: T) -> Self {
..Default::default()
},
data,
+ regmap: None,
}
}
+
+ /// Assign a regmap device to the config
+ #[cfg(CONFIG_REGMAP)]
+ pub fn with_regmap(mut self, regmap: Arc<Regmap>) -> Self {
+ self.regmap = Some(regmap);
+ self
+ }
}
/// Regulator device
@@ -384,6 +407,9 @@ pub fn new(dev: &device::Device, data: T) -> Self {
pub struct Device<T: ForeignOwnable + Send + Sync> {
rdev: NonNull<bindings::regulator_dev>,
_data_type: PhantomData<T>,
+ // The C regmap API does not keep reference count. Keep a reference to the regmap pointer that
+ // is shared to the C regulator API.
+ _regmap: Option<Arc<Regmap>>,
}
impl<T: ForeignOwnable + Send + Sync> Device<T> {
@@ -396,6 +422,7 @@ unsafe fn from_raw(rdev: *mut bindings::regulator_dev) -> ManuallyDrop<Self> {
// valid..
rdev: unsafe { NonNull::new_unchecked(rdev) },
_data_type: PhantomData::<T>,
+ _regmap: None,
})
}
@@ -407,6 +434,11 @@ pub fn register(
) -> Result<Self> {
config.cfg.driver_data = config.data.into_foreign() as _;
+ let regmap = config.regmap.take();
+ if let Some(regmap) = ®map {
+ config.cfg.regmap = regmap.as_raw() 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.
@@ -417,6 +449,7 @@ pub fn register(
Ok(Self {
rdev: NonNull::new(rdev).ok_or(EINVAL)?,
_data_type: PhantomData::<T>,
+ _regmap: regmap,
})
}
@@ -472,6 +505,114 @@ unsafe impl<T: ForeignOwnable + Send + Sync> Send for Device<T> {}
// the C code is insuring proper synchronization of `self.rdev`.
unsafe impl<T: ForeignOwnable + Send + Sync> Sync for Device<T> {}
+impl<T: ForeignOwnable + Send + Sync> Sealed for Device<T> {}
+
+/// Helper functions to implement some of the [`Driver`] trait methods using [`Regmap`].
+///
+/// This trait is implemented by [`Device`] and is Sealed to prevent
+/// to be implemented by anyone else.
+#[cfg(CONFIG_REGMAP)]
+pub trait RegmapHelpers: Sealed {
+ /// Implementation of [`Driver::get_voltage_sel`] using [`Regmap`].
+ fn get_voltage_sel_regmap(&self) -> Result<i32>;
+ /// Implementation of [`Driver::set_voltage_sel`] using [`Regmap`].
+ fn set_voltage_sel_regmap(&self, sel: u32) -> Result;
+
+ /// Implementation of [`Driver::is_enabled`] using [`Regmap`].
+ ///
+ /// [`Desc::with_enable`] or [`Desc::with_inverted_enable`] must have been called
+ /// to setup the fields required by regmap.
+ fn is_enabled_regmap(&self) -> Result<bool>;
+ /// Implementation of [`Driver::enable`] using [`Regmap`].
+ ///
+ /// [`Desc::with_enable`] or [`Desc::with_inverted_enable`] must have been called
+ /// to setup the fields required by regmap.
+ fn enable_regmap(&self) -> Result;
+ /// Implementation of [`Driver::disable`] using [`Regmap`].
+ ///
+ /// [`Desc::with_enable`] or [`Desc::with_inverted_enable`] must have been called
+ /// to setup the fields required by regmap.
+ fn disable_regmap(&self) -> Result;
+
+ /// Implementation of [`Driver::set_active_discharge`] using [`Regmap`].
+ ///
+ /// [`Desc::with_active_discharge`] must have been called to setup the fields required
+ /// by regmap.
+ fn set_active_discharge_regmap(&self, enable: bool) -> Result;
+
+ /// Implementation of [`Driver::set_current_limit`] using [`Regmap`].
+ fn set_current_limit_regmap(&self, min_ua: i32, max_ua: i32) -> Result;
+ /// Implementation of [`Driver::get_current_limit`] using [`Regmap`].
+ fn get_current_limit_regmap(&self) -> Result<i32>;
+}
+
+#[cfg(CONFIG_REGMAP)]
+impl<T: ForeignOwnable + Send + Sync> RegmapHelpers for Device<T> {
+ fn get_voltage_sel_regmap(&self) -> Result<i32> {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ let ret = unsafe { bindings::regulator_get_voltage_sel_regmap(self.rdev.as_ptr()) };
+ if ret < 0 {
+ return Err(Error::from_errno(ret));
+ }
+ Ok(ret)
+ }
+
+ fn set_voltage_sel_regmap(&self, sel: u32) -> Result {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ to_result(unsafe { bindings::regulator_set_voltage_sel_regmap(self.rdev.as_ptr(), sel) })
+ }
+
+ fn is_enabled_regmap(&self) -> Result<bool> {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ let ret = unsafe { bindings::regulator_is_enabled_regmap(self.rdev.as_ptr()) };
+ if ret < 0 {
+ return Err(Error::from_errno(ret));
+ }
+ Ok(ret > 0)
+ }
+
+ fn enable_regmap(&self) -> Result {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ to_result(unsafe { bindings::regulator_enable_regmap(self.rdev.as_ptr()) })
+ }
+
+ fn disable_regmap(&self) -> Result {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ to_result(unsafe { bindings::regulator_disable_regmap(self.rdev.as_ptr()) })
+ }
+
+ fn set_active_discharge_regmap(&self, enable: bool) -> Result {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ to_result(unsafe {
+ bindings::regulator_set_active_discharge_regmap(self.rdev.as_ptr(), enable)
+ })
+ }
+
+ fn set_current_limit_regmap(&self, min_ua: i32, max_ua: i32) -> Result {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ to_result(unsafe {
+ bindings::regulator_set_current_limit_regmap(self.rdev.as_ptr(), min_ua, max_ua)
+ })
+ }
+
+ fn get_current_limit_regmap(&self) -> Result<i32> {
+ // SAFETY: The type invariants guarantee that `self.rdev` is valid and non-null,
+ // so it is safe to perform the FFI call.
+ let ret = unsafe { bindings::regulator_get_current_limit_regmap(self.rdev.as_ptr()) };
+ if ret < 0 {
+ return Err(Error::from_errno(ret));
+ }
+ Ok(ret)
+ }
+}
+
/// [`Device`] type
pub enum Type {
/// Voltage regulator
--
2.45.2
