Add HAL for SubGhz peripheral for STM32 WL series
Based on the HAL from stm32wl, the peripheral driver has been modified to fit into embassy, using the embassy APIs, providing operation of the radio peripheral. The initial version does not offer any async APIs, but the example shows how the radio IRQ can be used to perform async TX of the radio.
This commit is contained in:
138
embassy-stm32/src/subghz/rf_frequency.rs
Normal file
138
embassy-stm32/src/subghz/rf_frequency.rs
Normal file
@ -0,0 +1,138 @@
|
||||
/// RF frequency structure.
|
||||
///
|
||||
/// Argument of [`set_rf_frequency`].
|
||||
///
|
||||
/// [`set_rf_frequency`]: crate::subghz::SubGhz::set_rf_frequency
|
||||
#[derive(Debug, PartialEq, Eq, Clone, Copy, PartialOrd, Ord)]
|
||||
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
|
||||
pub struct RfFreq {
|
||||
buf: [u8; 5],
|
||||
}
|
||||
|
||||
impl RfFreq {
|
||||
/// 915MHz, often used in Australia and North America.
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// assert_eq!(RfFreq::F915.freq(), 915_000_000);
|
||||
/// ```
|
||||
pub const F915: RfFreq = RfFreq::from_raw(0x39_30_00_00);
|
||||
|
||||
/// 868MHz, often used in Europe.
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// assert_eq!(RfFreq::F868.freq(), 868_000_000);
|
||||
/// ```
|
||||
pub const F868: RfFreq = RfFreq::from_raw(0x36_40_00_00);
|
||||
|
||||
/// 433MHz, often used in Europe.
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// assert_eq!(RfFreq::F433.freq(), 433_000_000);
|
||||
/// ```
|
||||
pub const F433: RfFreq = RfFreq::from_raw(0x1B_10_00_00);
|
||||
|
||||
/// Create a new `RfFreq` from a raw bit value.
|
||||
///
|
||||
/// The equation used to get the PLL frequency from the raw bits is:
|
||||
///
|
||||
/// RF<sub>PLL</sub> = 32e6 × bits / 2<sup>25</sup>
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// const FREQ: RfFreq = RfFreq::from_raw(0x39300000);
|
||||
/// assert_eq!(FREQ, RfFreq::F915);
|
||||
/// ```
|
||||
pub const fn from_raw(bits: u32) -> RfFreq {
|
||||
RfFreq {
|
||||
buf: [
|
||||
super::OpCode::SetRfFrequency as u8,
|
||||
((bits >> 24) & 0xFF) as u8,
|
||||
((bits >> 16) & 0xFF) as u8,
|
||||
((bits >> 8) & 0xFF) as u8,
|
||||
(bits & 0xFF) as u8,
|
||||
],
|
||||
}
|
||||
}
|
||||
|
||||
/// Create a new `RfFreq` from a PLL frequency.
|
||||
///
|
||||
/// The equation used to get the raw bits from the PLL frequency is:
|
||||
///
|
||||
/// bits = RF<sub>PLL</sub> * 2<sup>25</sup> / 32e6
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// const FREQ: RfFreq = RfFreq::from_frequency(915_000_000);
|
||||
/// assert_eq!(FREQ, RfFreq::F915);
|
||||
/// ```
|
||||
pub const fn from_frequency(freq: u32) -> RfFreq {
|
||||
Self::from_raw((((freq as u64) * (1 << 25)) / 32_000_000) as u32)
|
||||
}
|
||||
|
||||
// Get the frequency bit value.
|
||||
const fn as_bits(&self) -> u32 {
|
||||
((self.buf[1] as u32) << 24)
|
||||
| ((self.buf[2] as u32) << 16)
|
||||
| ((self.buf[3] as u32) << 8)
|
||||
| (self.buf[4] as u32)
|
||||
}
|
||||
|
||||
/// Get the actual frequency.
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// assert_eq!(RfFreq::from_raw(0x39300000).freq(), 915_000_000);
|
||||
/// ```
|
||||
pub fn freq(&self) -> u32 {
|
||||
(32_000_000 * (self.as_bits() as u64) / (1 << 25)) as u32
|
||||
}
|
||||
|
||||
/// Extracts a slice containing the packet.
|
||||
///
|
||||
/// # Example
|
||||
///
|
||||
/// ```
|
||||
/// use stm32wl_hal::subghz::RfFreq;
|
||||
///
|
||||
/// assert_eq!(RfFreq::F915.as_slice(), &[0x86, 0x39, 0x30, 0x00, 0x00]);
|
||||
/// ```
|
||||
pub const fn as_slice(&self) -> &[u8] {
|
||||
&self.buf
|
||||
}
|
||||
}
|
||||
|
||||
#[cfg(test)]
|
||||
mod test {
|
||||
use super::RfFreq;
|
||||
|
||||
#[test]
|
||||
fn max() {
|
||||
assert_eq!(RfFreq::from_raw(u32::MAX).freq(), 4_095_999_999);
|
||||
}
|
||||
|
||||
#[test]
|
||||
fn min() {
|
||||
assert_eq!(RfFreq::from_raw(u32::MIN).freq(), 0);
|
||||
}
|
||||
}
|
Reference in New Issue
Block a user