xref: /linux/rust/kernel/opp.rs (revision 976aa630da5b5508c278487db31b873ddf6bae8f)
1 // SPDX-License-Identifier: GPL-2.0
2 
3 //! Operating performance points.
4 //!
5 //! This module provides rust abstractions for interacting with the OPP subsystem.
6 //!
7 //! C header: [`include/linux/pm_opp.h`](srctree/include/linux/pm_opp.h)
8 //!
9 //! Reference: <https://docs.kernel.org/power/opp.html>
10 
11 use crate::{
12     clk::Hertz,
13     cpumask::{Cpumask, CpumaskVar},
14     device::Device,
15     error::{code::*, from_err_ptr, from_result, to_result, Error, Result, VTABLE_DEFAULT_ERROR},
16     ffi::c_ulong,
17     prelude::*,
18     str::CString,
19     types::{ARef, AlwaysRefCounted, Opaque},
20 };
21 
22 #[cfg(CONFIG_CPU_FREQ)]
23 /// Frequency table implementation.
24 mod freq {
25     use super::*;
26     use crate::cpufreq;
27     use core::ops::Deref;
28 
29     /// OPP frequency table.
30     ///
31     /// A [`cpufreq::Table`] created from [`Table`].
32     pub struct FreqTable {
33         dev: ARef<Device>,
34         ptr: *mut bindings::cpufreq_frequency_table,
35     }
36 
37     impl FreqTable {
38         /// Creates a new instance of [`FreqTable`] from [`Table`].
new(table: &Table) -> Result<Self>39         pub(crate) fn new(table: &Table) -> Result<Self> {
40             let mut ptr: *mut bindings::cpufreq_frequency_table = ptr::null_mut();
41 
42             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
43             // requirements.
44             to_result(unsafe {
45                 bindings::dev_pm_opp_init_cpufreq_table(table.dev.as_raw(), &mut ptr)
46             })?;
47 
48             Ok(Self {
49                 dev: table.dev.clone(),
50                 ptr,
51             })
52         }
53 
54         /// Returns a reference to the underlying [`cpufreq::Table`].
55         #[inline]
table(&self) -> &cpufreq::Table56         fn table(&self) -> &cpufreq::Table {
57             // SAFETY: The `ptr` is guaranteed by the C code to be valid.
58             unsafe { cpufreq::Table::from_raw(self.ptr) }
59         }
60     }
61 
62     impl Deref for FreqTable {
63         type Target = cpufreq::Table;
64 
65         #[inline]
deref(&self) -> &Self::Target66         fn deref(&self) -> &Self::Target {
67             self.table()
68         }
69     }
70 
71     impl Drop for FreqTable {
drop(&mut self)72         fn drop(&mut self) {
73             // SAFETY: The pointer was created via `dev_pm_opp_init_cpufreq_table`, and is only
74             // freed here.
75             unsafe {
76                 bindings::dev_pm_opp_free_cpufreq_table(self.dev.as_raw(), &mut self.as_raw())
77             };
78         }
79     }
80 }
81 
82 #[cfg(CONFIG_CPU_FREQ)]
83 pub use freq::FreqTable;
84 
85 use core::{marker::PhantomData, ptr};
86 
87 use macros::vtable;
88 
89 /// Creates a null-terminated slice of pointers to [`Cstring`]s.
to_c_str_array(names: &[CString]) -> Result<KVec<*const u8>>90 fn to_c_str_array(names: &[CString]) -> Result<KVec<*const u8>> {
91     // Allocated a null-terminated vector of pointers.
92     let mut list = KVec::with_capacity(names.len() + 1, GFP_KERNEL)?;
93 
94     for name in names.iter() {
95         list.push(name.as_ptr() as _, GFP_KERNEL)?;
96     }
97 
98     list.push(ptr::null(), GFP_KERNEL)?;
99     Ok(list)
100 }
101 
102 /// The voltage unit.
103 ///
104 /// Represents voltage in microvolts, wrapping a [`c_ulong`] value.
105 ///
106 /// ## Examples
107 ///
108 /// ```
109 /// use kernel::opp::MicroVolt;
110 ///
111 /// let raw = 90500;
112 /// let volt = MicroVolt(raw);
113 ///
114 /// assert_eq!(usize::from(volt), raw);
115 /// assert_eq!(volt, MicroVolt(raw));
116 /// ```
117 #[derive(Copy, Clone, PartialEq, Eq, Debug)]
118 pub struct MicroVolt(pub c_ulong);
119 
120 impl From<MicroVolt> for c_ulong {
121     #[inline]
from(volt: MicroVolt) -> Self122     fn from(volt: MicroVolt) -> Self {
123         volt.0
124     }
125 }
126 
127 /// The power unit.
128 ///
129 /// Represents power in microwatts, wrapping a [`c_ulong`] value.
130 ///
131 /// ## Examples
132 ///
133 /// ```
134 /// use kernel::opp::MicroWatt;
135 ///
136 /// let raw = 1000000;
137 /// let power = MicroWatt(raw);
138 ///
139 /// assert_eq!(usize::from(power), raw);
140 /// assert_eq!(power, MicroWatt(raw));
141 /// ```
142 #[derive(Copy, Clone, PartialEq, Eq, Debug)]
143 pub struct MicroWatt(pub c_ulong);
144 
145 impl From<MicroWatt> for c_ulong {
146     #[inline]
from(power: MicroWatt) -> Self147     fn from(power: MicroWatt) -> Self {
148         power.0
149     }
150 }
151 
152 /// Handle for a dynamically created [`OPP`].
153 ///
154 /// The associated [`OPP`] is automatically removed when the [`Token`] is dropped.
155 ///
156 /// ## Examples
157 ///
158 /// The following example demonstrates how to create an [`OPP`] dynamically.
159 ///
160 /// ```
161 /// use kernel::clk::Hertz;
162 /// use kernel::device::Device;
163 /// use kernel::error::Result;
164 /// use kernel::opp::{Data, MicroVolt, Token};
165 /// use kernel::types::ARef;
166 ///
167 /// fn create_opp(dev: &ARef<Device>, freq: Hertz, volt: MicroVolt, level: u32) -> Result<Token> {
168 ///     let data = Data::new(freq, volt, level, false);
169 ///
170 ///     // OPP is removed once token goes out of scope.
171 ///     data.add_opp(dev)
172 /// }
173 /// ```
174 pub struct Token {
175     dev: ARef<Device>,
176     freq: Hertz,
177 }
178 
179 impl Token {
180     /// Dynamically adds an [`OPP`] and returns a [`Token`] that removes it on drop.
new(dev: &ARef<Device>, mut data: Data) -> Result<Self>181     fn new(dev: &ARef<Device>, mut data: Data) -> Result<Self> {
182         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
183         // requirements.
184         to_result(unsafe { bindings::dev_pm_opp_add_dynamic(dev.as_raw(), &mut data.0) })?;
185         Ok(Self {
186             dev: dev.clone(),
187             freq: data.freq(),
188         })
189     }
190 }
191 
192 impl Drop for Token {
drop(&mut self)193     fn drop(&mut self) {
194         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
195         // requirements.
196         unsafe { bindings::dev_pm_opp_remove(self.dev.as_raw(), self.freq.into()) };
197     }
198 }
199 
200 /// OPP data.
201 ///
202 /// Rust abstraction for the C `struct dev_pm_opp_data`, used to define operating performance
203 /// points (OPPs) dynamically.
204 ///
205 /// ## Examples
206 ///
207 /// The following example demonstrates how to create an [`OPP`] with [`Data`].
208 ///
209 /// ```
210 /// use kernel::clk::Hertz;
211 /// use kernel::device::Device;
212 /// use kernel::error::Result;
213 /// use kernel::opp::{Data, MicroVolt, Token};
214 /// use kernel::types::ARef;
215 ///
216 /// fn create_opp(dev: &ARef<Device>, freq: Hertz, volt: MicroVolt, level: u32) -> Result<Token> {
217 ///     let data = Data::new(freq, volt, level, false);
218 ///
219 ///     // OPP is removed once token goes out of scope.
220 ///     data.add_opp(dev)
221 /// }
222 /// ```
223 #[repr(transparent)]
224 pub struct Data(bindings::dev_pm_opp_data);
225 
226 impl Data {
227     /// Creates a new instance of [`Data`].
228     ///
229     /// This can be used to define a dynamic OPP to be added to a device.
new(freq: Hertz, volt: MicroVolt, level: u32, turbo: bool) -> Self230     pub fn new(freq: Hertz, volt: MicroVolt, level: u32, turbo: bool) -> Self {
231         Self(bindings::dev_pm_opp_data {
232             turbo,
233             freq: freq.into(),
234             u_volt: volt.into(),
235             level,
236         })
237     }
238 
239     /// Adds an [`OPP`] dynamically.
240     ///
241     /// Returns a [`Token`] that ensures the OPP is automatically removed
242     /// when it goes out of scope.
243     #[inline]
add_opp(self, dev: &ARef<Device>) -> Result<Token>244     pub fn add_opp(self, dev: &ARef<Device>) -> Result<Token> {
245         Token::new(dev, self)
246     }
247 
248     /// Returns the frequency associated with this OPP data.
249     #[inline]
freq(&self) -> Hertz250     fn freq(&self) -> Hertz {
251         Hertz(self.0.freq)
252     }
253 }
254 
255 /// [`OPP`] search options.
256 ///
257 /// ## Examples
258 ///
259 /// Defines how to search for an [`OPP`] in a [`Table`] relative to a frequency.
260 ///
261 /// ```
262 /// use kernel::clk::Hertz;
263 /// use kernel::error::Result;
264 /// use kernel::opp::{OPP, SearchType, Table};
265 /// use kernel::types::ARef;
266 ///
267 /// fn find_opp(table: &Table, freq: Hertz) -> Result<ARef<OPP>> {
268 ///     let opp = table.opp_from_freq(freq, Some(true), None, SearchType::Exact)?;
269 ///
270 ///     pr_info!("OPP frequency is: {:?}\n", opp.freq(None));
271 ///     pr_info!("OPP voltage is: {:?}\n", opp.voltage());
272 ///     pr_info!("OPP level is: {}\n", opp.level());
273 ///     pr_info!("OPP power is: {:?}\n", opp.power());
274 ///
275 ///     Ok(opp)
276 /// }
277 /// ```
278 #[derive(Copy, Clone, Debug, Eq, PartialEq)]
279 pub enum SearchType {
280     /// Match the exact frequency.
281     Exact,
282     /// Find the highest frequency less than or equal to the given value.
283     Floor,
284     /// Find the lowest frequency greater than or equal to the given value.
285     Ceil,
286 }
287 
288 /// OPP configuration callbacks.
289 ///
290 /// Implement this trait to customize OPP clock and regulator setup for your device.
291 #[vtable]
292 pub trait ConfigOps {
293     /// This is typically used to scale clocks when transitioning between OPPs.
294     #[inline]
config_clks(_dev: &Device, _table: &Table, _opp: &OPP, _scaling_down: bool) -> Result295     fn config_clks(_dev: &Device, _table: &Table, _opp: &OPP, _scaling_down: bool) -> Result {
296         build_error!(VTABLE_DEFAULT_ERROR)
297     }
298 
299     /// This provides access to the old and new OPPs, allowing for safe regulator adjustments.
300     #[inline]
config_regulators( _dev: &Device, _opp_old: &OPP, _opp_new: &OPP, _data: *mut *mut bindings::regulator, _count: u32, ) -> Result301     fn config_regulators(
302         _dev: &Device,
303         _opp_old: &OPP,
304         _opp_new: &OPP,
305         _data: *mut *mut bindings::regulator,
306         _count: u32,
307     ) -> Result {
308         build_error!(VTABLE_DEFAULT_ERROR)
309     }
310 }
311 
312 /// OPP configuration token.
313 ///
314 /// Returned by the OPP core when configuration is applied to a [`Device`]. The associated
315 /// configuration is automatically cleared when the token is dropped.
316 pub struct ConfigToken(i32);
317 
318 impl Drop for ConfigToken {
drop(&mut self)319     fn drop(&mut self) {
320         // SAFETY: This is the same token value returned by the C code via `dev_pm_opp_set_config`.
321         unsafe { bindings::dev_pm_opp_clear_config(self.0) };
322     }
323 }
324 
325 /// OPP configurations.
326 ///
327 /// Rust abstraction for the C `struct dev_pm_opp_config`.
328 ///
329 /// ## Examples
330 ///
331 /// The following example demonstrates how to set OPP property-name configuration for a [`Device`].
332 ///
333 /// ```
334 /// use kernel::device::Device;
335 /// use kernel::error::Result;
336 /// use kernel::opp::{Config, ConfigOps, ConfigToken};
337 /// use kernel::str::CString;
338 /// use kernel::types::ARef;
339 /// use kernel::macros::vtable;
340 ///
341 /// #[derive(Default)]
342 /// struct Driver;
343 ///
344 /// #[vtable]
345 /// impl ConfigOps for Driver {}
346 ///
347 /// fn configure(dev: &ARef<Device>) -> Result<ConfigToken> {
348 ///     let name = CString::try_from_fmt(fmt!("{}", "slow"))?;
349 ///
350 ///     // The OPP configuration is cleared once the [`ConfigToken`] goes out of scope.
351 ///     Config::<Driver>::new()
352 ///         .set_prop_name(name)?
353 ///         .set(dev)
354 /// }
355 /// ```
356 #[derive(Default)]
357 pub struct Config<T: ConfigOps>
358 where
359     T: Default,
360 {
361     clk_names: Option<KVec<CString>>,
362     prop_name: Option<CString>,
363     regulator_names: Option<KVec<CString>>,
364     supported_hw: Option<KVec<u32>>,
365 
366     // Tuple containing (required device, index)
367     required_dev: Option<(ARef<Device>, u32)>,
368     _data: PhantomData<T>,
369 }
370 
371 impl<T: ConfigOps + Default> Config<T> {
372     /// Creates a new instance of [`Config`].
373     #[inline]
new() -> Self374     pub fn new() -> Self {
375         Self::default()
376     }
377 
378     /// Initializes clock names.
set_clk_names(mut self, names: KVec<CString>) -> Result<Self>379     pub fn set_clk_names(mut self, names: KVec<CString>) -> Result<Self> {
380         if self.clk_names.is_some() {
381             return Err(EBUSY);
382         }
383 
384         if names.is_empty() {
385             return Err(EINVAL);
386         }
387 
388         self.clk_names = Some(names);
389         Ok(self)
390     }
391 
392     /// Initializes property name.
set_prop_name(mut self, name: CString) -> Result<Self>393     pub fn set_prop_name(mut self, name: CString) -> Result<Self> {
394         if self.prop_name.is_some() {
395             return Err(EBUSY);
396         }
397 
398         self.prop_name = Some(name);
399         Ok(self)
400     }
401 
402     /// Initializes regulator names.
set_regulator_names(mut self, names: KVec<CString>) -> Result<Self>403     pub fn set_regulator_names(mut self, names: KVec<CString>) -> Result<Self> {
404         if self.regulator_names.is_some() {
405             return Err(EBUSY);
406         }
407 
408         if names.is_empty() {
409             return Err(EINVAL);
410         }
411 
412         self.regulator_names = Some(names);
413 
414         Ok(self)
415     }
416 
417     /// Initializes required devices.
set_required_dev(mut self, dev: ARef<Device>, index: u32) -> Result<Self>418     pub fn set_required_dev(mut self, dev: ARef<Device>, index: u32) -> Result<Self> {
419         if self.required_dev.is_some() {
420             return Err(EBUSY);
421         }
422 
423         self.required_dev = Some((dev, index));
424         Ok(self)
425     }
426 
427     /// Initializes supported hardware.
set_supported_hw(mut self, hw: KVec<u32>) -> Result<Self>428     pub fn set_supported_hw(mut self, hw: KVec<u32>) -> Result<Self> {
429         if self.supported_hw.is_some() {
430             return Err(EBUSY);
431         }
432 
433         if hw.is_empty() {
434             return Err(EINVAL);
435         }
436 
437         self.supported_hw = Some(hw);
438         Ok(self)
439     }
440 
441     /// Sets the configuration with the OPP core.
442     ///
443     /// The returned [`ConfigToken`] will remove the configuration when dropped.
set(self, dev: &Device) -> Result<ConfigToken>444     pub fn set(self, dev: &Device) -> Result<ConfigToken> {
445         let (_clk_list, clk_names) = match &self.clk_names {
446             Some(x) => {
447                 let list = to_c_str_array(x)?;
448                 let ptr = list.as_ptr();
449                 (Some(list), ptr)
450             }
451             None => (None, ptr::null()),
452         };
453 
454         let (_regulator_list, regulator_names) = match &self.regulator_names {
455             Some(x) => {
456                 let list = to_c_str_array(x)?;
457                 let ptr = list.as_ptr();
458                 (Some(list), ptr)
459             }
460             None => (None, ptr::null()),
461         };
462 
463         let prop_name = self
464             .prop_name
465             .as_ref()
466             .map_or(ptr::null(), |p| p.as_char_ptr());
467 
468         let (supported_hw, supported_hw_count) = self
469             .supported_hw
470             .as_ref()
471             .map_or((ptr::null(), 0), |hw| (hw.as_ptr(), hw.len() as u32));
472 
473         let (required_dev, required_dev_index) = self
474             .required_dev
475             .as_ref()
476             .map_or((ptr::null_mut(), 0), |(dev, idx)| (dev.as_raw(), *idx));
477 
478         let mut config = bindings::dev_pm_opp_config {
479             clk_names,
480             config_clks: if T::HAS_CONFIG_CLKS {
481                 Some(Self::config_clks)
482             } else {
483                 None
484             },
485             prop_name,
486             regulator_names,
487             config_regulators: if T::HAS_CONFIG_REGULATORS {
488                 Some(Self::config_regulators)
489             } else {
490                 None
491             },
492             supported_hw,
493             supported_hw_count,
494 
495             required_dev,
496             required_dev_index,
497         };
498 
499         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
500         // requirements. The OPP core guarantees not to access fields of [`Config`] after this call
501         // and so we don't need to save a copy of them for future use.
502         let ret = unsafe { bindings::dev_pm_opp_set_config(dev.as_raw(), &mut config) };
503         if ret < 0 {
504             Err(Error::from_errno(ret))
505         } else {
506             Ok(ConfigToken(ret))
507         }
508     }
509 
510     /// Config's clk callback.
511     ///
512     /// SAFETY: Called from C. Inputs must be valid pointers.
config_clks( dev: *mut bindings::device, opp_table: *mut bindings::opp_table, opp: *mut bindings::dev_pm_opp, _data: *mut kernel::ffi::c_void, scaling_down: bool, ) -> kernel::ffi::c_int513     extern "C" fn config_clks(
514         dev: *mut bindings::device,
515         opp_table: *mut bindings::opp_table,
516         opp: *mut bindings::dev_pm_opp,
517         _data: *mut kernel::ffi::c_void,
518         scaling_down: bool,
519     ) -> kernel::ffi::c_int {
520         from_result(|| {
521             // SAFETY: 'dev' is guaranteed by the C code to be valid.
522             let dev = unsafe { Device::get_device(dev) };
523             T::config_clks(
524                 &dev,
525                 // SAFETY: 'opp_table' is guaranteed by the C code to be valid.
526                 &unsafe { Table::from_raw_table(opp_table, &dev) },
527                 // SAFETY: 'opp' is guaranteed by the C code to be valid.
528                 unsafe { OPP::from_raw_opp(opp)? },
529                 scaling_down,
530             )
531             .map(|()| 0)
532         })
533     }
534 
535     /// Config's regulator callback.
536     ///
537     /// SAFETY: Called from C. Inputs must be valid pointers.
config_regulators( dev: *mut bindings::device, old_opp: *mut bindings::dev_pm_opp, new_opp: *mut bindings::dev_pm_opp, regulators: *mut *mut bindings::regulator, count: kernel::ffi::c_uint, ) -> kernel::ffi::c_int538     extern "C" fn config_regulators(
539         dev: *mut bindings::device,
540         old_opp: *mut bindings::dev_pm_opp,
541         new_opp: *mut bindings::dev_pm_opp,
542         regulators: *mut *mut bindings::regulator,
543         count: kernel::ffi::c_uint,
544     ) -> kernel::ffi::c_int {
545         from_result(|| {
546             // SAFETY: 'dev' is guaranteed by the C code to be valid.
547             let dev = unsafe { Device::get_device(dev) };
548             T::config_regulators(
549                 &dev,
550                 // SAFETY: 'old_opp' is guaranteed by the C code to be valid.
551                 unsafe { OPP::from_raw_opp(old_opp)? },
552                 // SAFETY: 'new_opp' is guaranteed by the C code to be valid.
553                 unsafe { OPP::from_raw_opp(new_opp)? },
554                 regulators,
555                 count,
556             )
557             .map(|()| 0)
558         })
559     }
560 }
561 
562 /// A reference-counted OPP table.
563 ///
564 /// Rust abstraction for the C `struct opp_table`.
565 ///
566 /// # Invariants
567 ///
568 /// The pointer stored in `Self` is non-null and valid for the lifetime of the [`Table`].
569 ///
570 /// Instances of this type are reference-counted.
571 ///
572 /// ## Examples
573 ///
574 /// The following example demonstrates how to get OPP [`Table`] for a [`Cpumask`] and set its
575 /// frequency.
576 ///
577 /// ```
578 /// # #![cfg(CONFIG_OF)]
579 /// use kernel::clk::Hertz;
580 /// use kernel::cpumask::Cpumask;
581 /// use kernel::device::Device;
582 /// use kernel::error::Result;
583 /// use kernel::opp::Table;
584 /// use kernel::types::ARef;
585 ///
586 /// fn get_table(dev: &ARef<Device>, mask: &mut Cpumask, freq: Hertz) -> Result<Table> {
587 ///     let mut opp_table = Table::from_of_cpumask(dev, mask)?;
588 ///
589 ///     if opp_table.opp_count()? == 0 {
590 ///         return Err(EINVAL);
591 ///     }
592 ///
593 ///     pr_info!("Max transition latency is: {} ns\n", opp_table.max_transition_latency_ns());
594 ///     pr_info!("Suspend frequency is: {:?}\n", opp_table.suspend_freq());
595 ///
596 ///     opp_table.set_rate(freq)?;
597 ///     Ok(opp_table)
598 /// }
599 /// ```
600 pub struct Table {
601     ptr: *mut bindings::opp_table,
602     dev: ARef<Device>,
603     #[allow(dead_code)]
604     em: bool,
605     #[allow(dead_code)]
606     of: bool,
607     cpus: Option<CpumaskVar>,
608 }
609 
610 /// SAFETY: It is okay to send ownership of [`Table`] across thread boundaries.
611 unsafe impl Send for Table {}
612 
613 /// SAFETY: It is okay to access [`Table`] through shared references from other threads because
614 /// we're either accessing properties that don't change or that are properly synchronised by C code.
615 unsafe impl Sync for Table {}
616 
617 impl Table {
618     /// Creates a new reference-counted [`Table`] from a raw pointer.
619     ///
620     /// # Safety
621     ///
622     /// Callers must ensure that `ptr` is valid and non-null.
from_raw_table(ptr: *mut bindings::opp_table, dev: &ARef<Device>) -> Self623     unsafe fn from_raw_table(ptr: *mut bindings::opp_table, dev: &ARef<Device>) -> Self {
624         // SAFETY: By the safety requirements, ptr is valid and its refcount will be incremented.
625         //
626         // INVARIANT: The reference-count is decremented when [`Table`] goes out of scope.
627         unsafe { bindings::dev_pm_opp_get_opp_table_ref(ptr) };
628 
629         Self {
630             ptr,
631             dev: dev.clone(),
632             em: false,
633             of: false,
634             cpus: None,
635         }
636     }
637 
638     /// Creates a new reference-counted [`Table`] instance for a [`Device`].
from_dev(dev: &Device) -> Result<Self>639     pub fn from_dev(dev: &Device) -> Result<Self> {
640         // SAFETY: The requirements are satisfied by the existence of the [`Device`] and its safety
641         // requirements.
642         //
643         // INVARIANT: The reference-count is incremented by the C code and is decremented when
644         // [`Table`] goes out of scope.
645         let ptr = from_err_ptr(unsafe { bindings::dev_pm_opp_get_opp_table(dev.as_raw()) })?;
646 
647         Ok(Self {
648             ptr,
649             dev: dev.into(),
650             em: false,
651             of: false,
652             cpus: None,
653         })
654     }
655 
656     /// Creates a new reference-counted [`Table`] instance for a [`Device`] based on device tree
657     /// entries.
658     #[cfg(CONFIG_OF)]
from_of(dev: &ARef<Device>, index: i32) -> Result<Self>659     pub fn from_of(dev: &ARef<Device>, index: i32) -> Result<Self> {
660         // SAFETY: The requirements are satisfied by the existence of the [`Device`] and its safety
661         // requirements.
662         //
663         // INVARIANT: The reference-count is incremented by the C code and is decremented when
664         // [`Table`] goes out of scope.
665         to_result(unsafe { bindings::dev_pm_opp_of_add_table_indexed(dev.as_raw(), index) })?;
666 
667         // Get the newly created [`Table`].
668         let mut table = Self::from_dev(dev)?;
669         table.of = true;
670 
671         Ok(table)
672     }
673 
674     /// Remove device tree based [`Table`].
675     #[cfg(CONFIG_OF)]
676     #[inline]
remove_of(&self)677     fn remove_of(&self) {
678         // SAFETY: The requirements are satisfied by the existence of the [`Device`] and its safety
679         // requirements. We took the reference from [`from_of`] earlier, it is safe to drop the
680         // same now.
681         unsafe { bindings::dev_pm_opp_of_remove_table(self.dev.as_raw()) };
682     }
683 
684     /// Creates a new reference-counted [`Table`] instance for a [`Cpumask`] based on device tree
685     /// entries.
686     #[cfg(CONFIG_OF)]
from_of_cpumask(dev: &Device, cpumask: &mut Cpumask) -> Result<Self>687     pub fn from_of_cpumask(dev: &Device, cpumask: &mut Cpumask) -> Result<Self> {
688         // SAFETY: The cpumask is valid and the returned pointer will be owned by the [`Table`]
689         // instance.
690         //
691         // INVARIANT: The reference-count is incremented by the C code and is decremented when
692         // [`Table`] goes out of scope.
693         to_result(unsafe { bindings::dev_pm_opp_of_cpumask_add_table(cpumask.as_raw()) })?;
694 
695         // Fetch the newly created table.
696         let mut table = Self::from_dev(dev)?;
697         table.cpus = Some(CpumaskVar::try_clone(cpumask)?);
698 
699         Ok(table)
700     }
701 
702     /// Remove device tree based [`Table`] for a [`Cpumask`].
703     #[cfg(CONFIG_OF)]
704     #[inline]
remove_of_cpumask(&self, cpumask: &Cpumask)705     fn remove_of_cpumask(&self, cpumask: &Cpumask) {
706         // SAFETY: The cpumask is valid and we took the reference from [`from_of_cpumask`] earlier,
707         // it is safe to drop the same now.
708         unsafe { bindings::dev_pm_opp_of_cpumask_remove_table(cpumask.as_raw()) };
709     }
710 
711     /// Returns the number of [`OPP`]s in the [`Table`].
opp_count(&self) -> Result<u32>712     pub fn opp_count(&self) -> Result<u32> {
713         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
714         // requirements.
715         let ret = unsafe { bindings::dev_pm_opp_get_opp_count(self.dev.as_raw()) };
716         if ret < 0 {
717             Err(Error::from_errno(ret))
718         } else {
719             Ok(ret as u32)
720         }
721     }
722 
723     /// Returns max clock latency (in nanoseconds) of the [`OPP`]s in the [`Table`].
724     #[inline]
max_clock_latency_ns(&self) -> usize725     pub fn max_clock_latency_ns(&self) -> usize {
726         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
727         // requirements.
728         unsafe { bindings::dev_pm_opp_get_max_clock_latency(self.dev.as_raw()) }
729     }
730 
731     /// Returns max volt latency (in nanoseconds) of the [`OPP`]s in the [`Table`].
732     #[inline]
max_volt_latency_ns(&self) -> usize733     pub fn max_volt_latency_ns(&self) -> usize {
734         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
735         // requirements.
736         unsafe { bindings::dev_pm_opp_get_max_volt_latency(self.dev.as_raw()) }
737     }
738 
739     /// Returns max transition latency (in nanoseconds) of the [`OPP`]s in the [`Table`].
740     #[inline]
max_transition_latency_ns(&self) -> usize741     pub fn max_transition_latency_ns(&self) -> usize {
742         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
743         // requirements.
744         unsafe { bindings::dev_pm_opp_get_max_transition_latency(self.dev.as_raw()) }
745     }
746 
747     /// Returns the suspend [`OPP`]'s frequency.
748     #[inline]
suspend_freq(&self) -> Hertz749     pub fn suspend_freq(&self) -> Hertz {
750         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
751         // requirements.
752         Hertz(unsafe { bindings::dev_pm_opp_get_suspend_opp_freq(self.dev.as_raw()) })
753     }
754 
755     /// Synchronizes regulators used by the [`Table`].
756     #[inline]
sync_regulators(&self) -> Result757     pub fn sync_regulators(&self) -> Result {
758         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
759         // requirements.
760         to_result(unsafe { bindings::dev_pm_opp_sync_regulators(self.dev.as_raw()) })
761     }
762 
763     /// Gets sharing CPUs.
764     #[inline]
sharing_cpus(dev: &Device, cpumask: &mut Cpumask) -> Result765     pub fn sharing_cpus(dev: &Device, cpumask: &mut Cpumask) -> Result {
766         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
767         // requirements.
768         to_result(unsafe { bindings::dev_pm_opp_get_sharing_cpus(dev.as_raw(), cpumask.as_raw()) })
769     }
770 
771     /// Sets sharing CPUs.
set_sharing_cpus(&mut self, cpumask: &mut Cpumask) -> Result772     pub fn set_sharing_cpus(&mut self, cpumask: &mut Cpumask) -> Result {
773         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
774         // requirements.
775         to_result(unsafe {
776             bindings::dev_pm_opp_set_sharing_cpus(self.dev.as_raw(), cpumask.as_raw())
777         })?;
778 
779         if let Some(mask) = self.cpus.as_mut() {
780             // Update the cpumask as this will be used while removing the table.
781             cpumask.copy(mask);
782         }
783 
784         Ok(())
785     }
786 
787     /// Gets sharing CPUs from device tree.
788     #[cfg(CONFIG_OF)]
789     #[inline]
of_sharing_cpus(dev: &Device, cpumask: &mut Cpumask) -> Result790     pub fn of_sharing_cpus(dev: &Device, cpumask: &mut Cpumask) -> Result {
791         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
792         // requirements.
793         to_result(unsafe {
794             bindings::dev_pm_opp_of_get_sharing_cpus(dev.as_raw(), cpumask.as_raw())
795         })
796     }
797 
798     /// Updates the voltage value for an [`OPP`].
799     #[inline]
adjust_voltage( &self, freq: Hertz, volt: MicroVolt, volt_min: MicroVolt, volt_max: MicroVolt, ) -> Result800     pub fn adjust_voltage(
801         &self,
802         freq: Hertz,
803         volt: MicroVolt,
804         volt_min: MicroVolt,
805         volt_max: MicroVolt,
806     ) -> Result {
807         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
808         // requirements.
809         to_result(unsafe {
810             bindings::dev_pm_opp_adjust_voltage(
811                 self.dev.as_raw(),
812                 freq.into(),
813                 volt.into(),
814                 volt_min.into(),
815                 volt_max.into(),
816             )
817         })
818     }
819 
820     /// Creates [`FreqTable`] from [`Table`].
821     #[cfg(CONFIG_CPU_FREQ)]
822     #[inline]
cpufreq_table(&mut self) -> Result<FreqTable>823     pub fn cpufreq_table(&mut self) -> Result<FreqTable> {
824         FreqTable::new(self)
825     }
826 
827     /// Configures device with [`OPP`] matching the frequency value.
828     #[inline]
set_rate(&self, freq: Hertz) -> Result829     pub fn set_rate(&self, freq: Hertz) -> Result {
830         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
831         // requirements.
832         to_result(unsafe { bindings::dev_pm_opp_set_rate(self.dev.as_raw(), freq.into()) })
833     }
834 
835     /// Configures device with [`OPP`].
836     #[inline]
set_opp(&self, opp: &OPP) -> Result837     pub fn set_opp(&self, opp: &OPP) -> Result {
838         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
839         // requirements.
840         to_result(unsafe { bindings::dev_pm_opp_set_opp(self.dev.as_raw(), opp.as_raw()) })
841     }
842 
843     /// Finds [`OPP`] based on frequency.
opp_from_freq( &self, freq: Hertz, available: Option<bool>, index: Option<u32>, stype: SearchType, ) -> Result<ARef<OPP>>844     pub fn opp_from_freq(
845         &self,
846         freq: Hertz,
847         available: Option<bool>,
848         index: Option<u32>,
849         stype: SearchType,
850     ) -> Result<ARef<OPP>> {
851         let raw_dev = self.dev.as_raw();
852         let index = index.unwrap_or(0);
853         let mut rate = freq.into();
854 
855         let ptr = from_err_ptr(match stype {
856             SearchType::Exact => {
857                 if let Some(available) = available {
858                     // SAFETY: The requirements are satisfied by the existence of [`Device`] and
859                     // its safety requirements. The returned pointer will be owned by the new
860                     // [`OPP`] instance.
861                     unsafe {
862                         bindings::dev_pm_opp_find_freq_exact_indexed(
863                             raw_dev, rate, index, available,
864                         )
865                     }
866                 } else {
867                     return Err(EINVAL);
868                 }
869             }
870 
871             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
872             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
873             SearchType::Ceil => unsafe {
874                 bindings::dev_pm_opp_find_freq_ceil_indexed(raw_dev, &mut rate, index)
875             },
876 
877             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
878             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
879             SearchType::Floor => unsafe {
880                 bindings::dev_pm_opp_find_freq_floor_indexed(raw_dev, &mut rate, index)
881             },
882         })?;
883 
884         // SAFETY: The `ptr` is guaranteed by the C code to be valid.
885         unsafe { OPP::from_raw_opp_owned(ptr) }
886     }
887 
888     /// Finds [`OPP`] based on level.
opp_from_level(&self, mut level: u32, stype: SearchType) -> Result<ARef<OPP>>889     pub fn opp_from_level(&self, mut level: u32, stype: SearchType) -> Result<ARef<OPP>> {
890         let raw_dev = self.dev.as_raw();
891 
892         let ptr = from_err_ptr(match stype {
893             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
894             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
895             SearchType::Exact => unsafe { bindings::dev_pm_opp_find_level_exact(raw_dev, level) },
896 
897             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
898             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
899             SearchType::Ceil => unsafe {
900                 bindings::dev_pm_opp_find_level_ceil(raw_dev, &mut level)
901             },
902 
903             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
904             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
905             SearchType::Floor => unsafe {
906                 bindings::dev_pm_opp_find_level_floor(raw_dev, &mut level)
907             },
908         })?;
909 
910         // SAFETY: The `ptr` is guaranteed by the C code to be valid.
911         unsafe { OPP::from_raw_opp_owned(ptr) }
912     }
913 
914     /// Finds [`OPP`] based on bandwidth.
opp_from_bw(&self, mut bw: u32, index: i32, stype: SearchType) -> Result<ARef<OPP>>915     pub fn opp_from_bw(&self, mut bw: u32, index: i32, stype: SearchType) -> Result<ARef<OPP>> {
916         let raw_dev = self.dev.as_raw();
917 
918         let ptr = from_err_ptr(match stype {
919             // The OPP core doesn't support this yet.
920             SearchType::Exact => return Err(EINVAL),
921 
922             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
923             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
924             SearchType::Ceil => unsafe {
925                 bindings::dev_pm_opp_find_bw_ceil(raw_dev, &mut bw, index)
926             },
927 
928             // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
929             // requirements. The returned pointer will be owned by the new [`OPP`] instance.
930             SearchType::Floor => unsafe {
931                 bindings::dev_pm_opp_find_bw_floor(raw_dev, &mut bw, index)
932             },
933         })?;
934 
935         // SAFETY: The `ptr` is guaranteed by the C code to be valid.
936         unsafe { OPP::from_raw_opp_owned(ptr) }
937     }
938 
939     /// Enables the [`OPP`].
940     #[inline]
enable_opp(&self, freq: Hertz) -> Result941     pub fn enable_opp(&self, freq: Hertz) -> Result {
942         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
943         // requirements.
944         to_result(unsafe { bindings::dev_pm_opp_enable(self.dev.as_raw(), freq.into()) })
945     }
946 
947     /// Disables the [`OPP`].
948     #[inline]
disable_opp(&self, freq: Hertz) -> Result949     pub fn disable_opp(&self, freq: Hertz) -> Result {
950         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
951         // requirements.
952         to_result(unsafe { bindings::dev_pm_opp_disable(self.dev.as_raw(), freq.into()) })
953     }
954 
955     /// Registers with the Energy model.
956     #[cfg(CONFIG_OF)]
of_register_em(&mut self, cpumask: &mut Cpumask) -> Result957     pub fn of_register_em(&mut self, cpumask: &mut Cpumask) -> Result {
958         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
959         // requirements.
960         to_result(unsafe {
961             bindings::dev_pm_opp_of_register_em(self.dev.as_raw(), cpumask.as_raw())
962         })?;
963 
964         self.em = true;
965         Ok(())
966     }
967 
968     /// Unregisters with the Energy model.
969     #[cfg(all(CONFIG_OF, CONFIG_ENERGY_MODEL))]
970     #[inline]
of_unregister_em(&self)971     fn of_unregister_em(&self) {
972         // SAFETY: The requirements are satisfied by the existence of [`Device`] and its safety
973         // requirements. We registered with the EM framework earlier, it is safe to unregister now.
974         unsafe { bindings::em_dev_unregister_perf_domain(self.dev.as_raw()) };
975     }
976 }
977 
978 impl Drop for Table {
drop(&mut self)979     fn drop(&mut self) {
980         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe
981         // to relinquish it now.
982         unsafe { bindings::dev_pm_opp_put_opp_table(self.ptr) };
983 
984         #[cfg(CONFIG_OF)]
985         {
986             #[cfg(CONFIG_ENERGY_MODEL)]
987             if self.em {
988                 self.of_unregister_em();
989             }
990 
991             if self.of {
992                 self.remove_of();
993             } else if let Some(cpumask) = self.cpus.take() {
994                 self.remove_of_cpumask(&cpumask);
995             }
996         }
997     }
998 }
999 
1000 /// A reference-counted Operating performance point (OPP).
1001 ///
1002 /// Rust abstraction for the C `struct dev_pm_opp`.
1003 ///
1004 /// # Invariants
1005 ///
1006 /// The pointer stored in `Self` is non-null and valid for the lifetime of the [`OPP`].
1007 ///
1008 /// Instances of this type are reference-counted. The reference count is incremented by the
1009 /// `dev_pm_opp_get` function and decremented by `dev_pm_opp_put`. The Rust type `ARef<OPP>`
1010 /// represents a pointer that owns a reference count on the [`OPP`].
1011 ///
1012 /// A reference to the [`OPP`], &[`OPP`], isn't refcounted by the Rust code.
1013 ///
1014 /// ## Examples
1015 ///
1016 /// The following example demonstrates how to get [`OPP`] corresponding to a frequency value and
1017 /// configure the device with it.
1018 ///
1019 /// ```
1020 /// use kernel::clk::Hertz;
1021 /// use kernel::error::Result;
1022 /// use kernel::opp::{SearchType, Table};
1023 ///
1024 /// fn configure_opp(table: &Table, freq: Hertz) -> Result {
1025 ///     let opp = table.opp_from_freq(freq, Some(true), None, SearchType::Exact)?;
1026 ///
1027 ///     if opp.freq(None) != freq {
1028 ///         return Err(EINVAL);
1029 ///     }
1030 ///
1031 ///     table.set_opp(&opp)
1032 /// }
1033 /// ```
1034 #[repr(transparent)]
1035 pub struct OPP(Opaque<bindings::dev_pm_opp>);
1036 
1037 /// SAFETY: It is okay to send the ownership of [`OPP`] across thread boundaries.
1038 unsafe impl Send for OPP {}
1039 
1040 /// SAFETY: It is okay to access [`OPP`] through shared references from other threads because we're
1041 /// either accessing properties that don't change or that are properly synchronised by C code.
1042 unsafe impl Sync for OPP {}
1043 
1044 /// SAFETY: The type invariants guarantee that [`OPP`] is always refcounted.
1045 unsafe impl AlwaysRefCounted for OPP {
inc_ref(&self)1046     fn inc_ref(&self) {
1047         // SAFETY: The existence of a shared reference means that the refcount is nonzero.
1048         unsafe { bindings::dev_pm_opp_get(self.0.get()) };
1049     }
1050 
dec_ref(obj: ptr::NonNull<Self>)1051     unsafe fn dec_ref(obj: ptr::NonNull<Self>) {
1052         // SAFETY: The safety requirements guarantee that the refcount is nonzero.
1053         unsafe { bindings::dev_pm_opp_put(obj.cast().as_ptr()) }
1054     }
1055 }
1056 
1057 impl OPP {
1058     /// Creates an owned reference to a [`OPP`] from a valid pointer.
1059     ///
1060     /// The refcount is incremented by the C code and will be decremented by `dec_ref` when the
1061     /// [`ARef`] object is dropped.
1062     ///
1063     /// # Safety
1064     ///
1065     /// The caller must ensure that `ptr` is valid and the refcount of the [`OPP`] is incremented.
1066     /// The caller must also ensure that it doesn't explicitly drop the refcount of the [`OPP`], as
1067     /// the returned [`ARef`] object takes over the refcount increment on the underlying object and
1068     /// the same will be dropped along with it.
from_raw_opp_owned(ptr: *mut bindings::dev_pm_opp) -> Result<ARef<Self>>1069     pub unsafe fn from_raw_opp_owned(ptr: *mut bindings::dev_pm_opp) -> Result<ARef<Self>> {
1070         let ptr = ptr::NonNull::new(ptr).ok_or(ENODEV)?;
1071 
1072         // SAFETY: The safety requirements guarantee the validity of the pointer.
1073         //
1074         // INVARIANT: The reference-count is decremented when [`OPP`] goes out of scope.
1075         Ok(unsafe { ARef::from_raw(ptr.cast()) })
1076     }
1077 
1078     /// Creates a reference to a [`OPP`] from a valid pointer.
1079     ///
1080     /// The refcount is not updated by the Rust API unless the returned reference is converted to
1081     /// an [`ARef`] object.
1082     ///
1083     /// # Safety
1084     ///
1085     /// The caller must ensure that `ptr` is valid and remains valid for the duration of `'a`.
1086     #[inline]
from_raw_opp<'a>(ptr: *mut bindings::dev_pm_opp) -> Result<&'a Self>1087     pub unsafe fn from_raw_opp<'a>(ptr: *mut bindings::dev_pm_opp) -> Result<&'a Self> {
1088         // SAFETY: The caller guarantees that the pointer is not dangling and stays valid for the
1089         // duration of 'a. The cast is okay because [`OPP`] is `repr(transparent)`.
1090         Ok(unsafe { &*ptr.cast() })
1091     }
1092 
1093     #[inline]
as_raw(&self) -> *mut bindings::dev_pm_opp1094     fn as_raw(&self) -> *mut bindings::dev_pm_opp {
1095         self.0.get()
1096     }
1097 
1098     /// Returns the frequency of an [`OPP`].
freq(&self, index: Option<u32>) -> Hertz1099     pub fn freq(&self, index: Option<u32>) -> Hertz {
1100         let index = index.unwrap_or(0);
1101 
1102         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe to
1103         // use it.
1104         Hertz(unsafe { bindings::dev_pm_opp_get_freq_indexed(self.as_raw(), index) })
1105     }
1106 
1107     /// Returns the voltage of an [`OPP`].
1108     #[inline]
voltage(&self) -> MicroVolt1109     pub fn voltage(&self) -> MicroVolt {
1110         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe to
1111         // use it.
1112         MicroVolt(unsafe { bindings::dev_pm_opp_get_voltage(self.as_raw()) })
1113     }
1114 
1115     /// Returns the level of an [`OPP`].
1116     #[inline]
level(&self) -> u321117     pub fn level(&self) -> u32 {
1118         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe to
1119         // use it.
1120         unsafe { bindings::dev_pm_opp_get_level(self.as_raw()) }
1121     }
1122 
1123     /// Returns the power of an [`OPP`].
1124     #[inline]
power(&self) -> MicroWatt1125     pub fn power(&self) -> MicroWatt {
1126         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe to
1127         // use it.
1128         MicroWatt(unsafe { bindings::dev_pm_opp_get_power(self.as_raw()) })
1129     }
1130 
1131     /// Returns the required pstate of an [`OPP`].
1132     #[inline]
required_pstate(&self, index: u32) -> u321133     pub fn required_pstate(&self, index: u32) -> u32 {
1134         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe to
1135         // use it.
1136         unsafe { bindings::dev_pm_opp_get_required_pstate(self.as_raw(), index) }
1137     }
1138 
1139     /// Returns true if the [`OPP`] is turbo.
1140     #[inline]
is_turbo(&self) -> bool1141     pub fn is_turbo(&self) -> bool {
1142         // SAFETY: By the type invariants, we know that `self` owns a reference, so it is safe to
1143         // use it.
1144         unsafe { bindings::dev_pm_opp_is_turbo(self.as_raw()) }
1145     }
1146 }
1147