2021-05-06 01:59:16 +00:00
|
|
|
#![macro_use]
|
2021-05-06 18:33:29 +00:00
|
|
|
|
2021-05-09 23:19:07 +00:00
|
|
|
use core::task::Poll;
|
2022-06-12 20:15:44 +00:00
|
|
|
|
2021-09-10 23:53:53 +00:00
|
|
|
use embassy::waitqueue::AtomicWaker;
|
2022-07-22 23:29:35 +00:00
|
|
|
use embassy_hal_common::{unborrow, Unborrowed};
|
2021-05-09 23:19:07 +00:00
|
|
|
use futures::future::poll_fn;
|
|
|
|
use rand_core::{CryptoRng, RngCore};
|
2021-05-06 18:33:29 +00:00
|
|
|
|
2022-06-12 20:15:44 +00:00
|
|
|
use crate::{pac, peripherals, Unborrow};
|
2021-05-06 18:33:29 +00:00
|
|
|
|
2021-05-13 18:28:53 +00:00
|
|
|
pub(crate) static RNG_WAKER: AtomicWaker = AtomicWaker::new();
|
2021-04-26 18:11:46 +00:00
|
|
|
|
2021-08-26 18:03:54 +00:00
|
|
|
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
|
2021-05-14 14:11:43 +00:00
|
|
|
pub enum Error {
|
|
|
|
SeedError,
|
|
|
|
ClockError,
|
|
|
|
}
|
|
|
|
|
2022-02-10 15:06:42 +00:00
|
|
|
pub struct Rng<'d, T: Instance> {
|
2022-07-22 23:29:35 +00:00
|
|
|
_inner: Unborrowed<'d, T>,
|
2021-04-26 18:11:46 +00:00
|
|
|
}
|
|
|
|
|
2022-02-10 15:06:42 +00:00
|
|
|
impl<'d, T: Instance> Rng<'d, T> {
|
|
|
|
pub fn new(inner: impl Unborrow<Target = T> + 'd) -> Self {
|
2021-06-09 11:54:53 +00:00
|
|
|
T::enable();
|
|
|
|
T::reset();
|
2021-04-26 18:11:46 +00:00
|
|
|
unborrow!(inner);
|
2022-07-22 23:29:35 +00:00
|
|
|
let mut random = Self { _inner: inner };
|
2021-05-06 20:38:53 +00:00
|
|
|
random.reset();
|
|
|
|
random
|
|
|
|
}
|
|
|
|
|
|
|
|
pub fn reset(&mut self) {
|
|
|
|
unsafe {
|
|
|
|
T::regs().cr().modify(|reg| {
|
|
|
|
reg.set_rngen(true);
|
|
|
|
reg.set_ie(true);
|
|
|
|
});
|
|
|
|
T::regs().sr().modify(|reg| {
|
|
|
|
reg.set_seis(false);
|
|
|
|
reg.set_ceis(false);
|
|
|
|
});
|
|
|
|
}
|
|
|
|
// Reference manual says to discard the first.
|
|
|
|
let _ = self.next_u32();
|
2021-04-26 18:11:46 +00:00
|
|
|
}
|
2022-01-26 23:08:02 +00:00
|
|
|
|
|
|
|
pub async fn async_fill_bytes(&mut self, dest: &mut [u8]) -> Result<(), Error> {
|
|
|
|
unsafe {
|
|
|
|
T::regs().cr().modify(|reg| {
|
|
|
|
reg.set_rngen(true);
|
|
|
|
})
|
|
|
|
}
|
|
|
|
|
|
|
|
for chunk in dest.chunks_mut(4) {
|
|
|
|
poll_fn(|cx| {
|
|
|
|
RNG_WAKER.register(cx.waker());
|
|
|
|
unsafe {
|
|
|
|
T::regs().cr().modify(|reg| {
|
|
|
|
reg.set_ie(true);
|
|
|
|
});
|
|
|
|
}
|
|
|
|
|
|
|
|
let bits = unsafe { T::regs().sr().read() };
|
|
|
|
|
|
|
|
if bits.drdy() {
|
|
|
|
Poll::Ready(Ok(()))
|
|
|
|
} else if bits.seis() {
|
|
|
|
self.reset();
|
|
|
|
Poll::Ready(Err(Error::SeedError))
|
|
|
|
} else if bits.ceis() {
|
|
|
|
self.reset();
|
|
|
|
Poll::Ready(Err(Error::ClockError))
|
|
|
|
} else {
|
|
|
|
Poll::Pending
|
|
|
|
}
|
|
|
|
})
|
|
|
|
.await?;
|
|
|
|
let random_bytes = unsafe { T::regs().dr().read() }.to_be_bytes();
|
|
|
|
for (dest, src) in chunk.iter_mut().zip(random_bytes.iter()) {
|
|
|
|
*dest = *src
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
Ok(())
|
|
|
|
}
|
2021-04-26 18:11:46 +00:00
|
|
|
}
|
|
|
|
|
2022-02-10 15:06:42 +00:00
|
|
|
impl<'d, T: Instance> RngCore for Rng<'d, T> {
|
2021-05-06 18:33:29 +00:00
|
|
|
fn next_u32(&mut self) -> u32 {
|
|
|
|
loop {
|
|
|
|
let bits = unsafe { T::regs().sr().read() };
|
|
|
|
if bits.drdy() {
|
2021-05-09 23:19:07 +00:00
|
|
|
return unsafe { T::regs().dr().read() };
|
2021-05-06 18:33:29 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
fn next_u64(&mut self) -> u64 {
|
|
|
|
let mut rand = self.next_u32() as u64;
|
|
|
|
rand |= (self.next_u32() as u64) << 32;
|
|
|
|
rand
|
|
|
|
}
|
|
|
|
|
|
|
|
fn fill_bytes(&mut self, dest: &mut [u8]) {
|
|
|
|
for chunk in dest.chunks_mut(4) {
|
|
|
|
let rand = self.next_u32();
|
|
|
|
for (slot, num) in chunk.iter_mut().zip(rand.to_be_bytes().iter()) {
|
|
|
|
*slot = *num
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
fn try_fill_bytes(&mut self, dest: &mut [u8]) -> Result<(), rand_core::Error> {
|
2021-05-09 23:19:07 +00:00
|
|
|
self.fill_bytes(dest);
|
2021-05-06 18:33:29 +00:00
|
|
|
Ok(())
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2022-02-10 15:06:42 +00:00
|
|
|
impl<'d, T: Instance> CryptoRng for Rng<'d, T> {}
|
2021-05-06 18:33:29 +00:00
|
|
|
|
2021-04-26 18:11:46 +00:00
|
|
|
pub(crate) mod sealed {
|
|
|
|
use super::*;
|
|
|
|
|
|
|
|
pub trait Instance {
|
2021-05-06 18:33:29 +00:00
|
|
|
fn regs() -> pac::rng::Rng;
|
2021-04-26 18:11:46 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-06-09 11:54:53 +00:00
|
|
|
pub trait Instance: sealed::Instance + crate::rcc::RccPeripheral {}
|
2021-04-26 18:11:46 +00:00
|
|
|
|
2022-02-26 00:40:43 +00:00
|
|
|
foreach_peripheral!(
|
2021-06-03 15:09:29 +00:00
|
|
|
(rng, $inst:ident) => {
|
|
|
|
impl Instance for peripherals::$inst {}
|
|
|
|
|
|
|
|
impl sealed::Instance for peripherals::$inst {
|
|
|
|
fn regs() -> crate::pac::rng::Rng {
|
|
|
|
crate::pac::RNG
|
|
|
|
}
|
|
|
|
}
|
|
|
|
};
|
|
|
|
);
|
|
|
|
|
|
|
|
macro_rules! irq {
|
|
|
|
($irq:ident) => {
|
|
|
|
mod rng_irq {
|
|
|
|
use crate::interrupt;
|
|
|
|
|
|
|
|
#[interrupt]
|
|
|
|
unsafe fn $irq() {
|
|
|
|
let bits = $crate::pac::RNG.sr().read();
|
|
|
|
if bits.drdy() || bits.seis() || bits.ceis() {
|
|
|
|
$crate::pac::RNG.cr().write(|reg| reg.set_ie(false));
|
|
|
|
$crate::rng::RNG_WAKER.wake();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
2022-02-26 00:40:43 +00:00
|
|
|
foreach_interrupt!(
|
2021-06-03 15:09:29 +00:00
|
|
|
(RNG) => {
|
|
|
|
irq!(RNG);
|
|
|
|
};
|
|
|
|
|
|
|
|
(RNG_LPUART1) => {
|
|
|
|
irq!(RNG_LPUART1);
|
|
|
|
};
|
|
|
|
|
|
|
|
(AES_RNG_LPUART1) => {
|
|
|
|
irq!(AES_RNG_LPUART1);
|
|
|
|
};
|
|
|
|
|
|
|
|
(AES_RNG) => {
|
|
|
|
irq!(AES_RNG);
|
|
|
|
};
|
|
|
|
|
|
|
|
(HASH_RNG) => {
|
|
|
|
irq!(HASH_RNG);
|
|
|
|
};
|
|
|
|
);
|