Remove Pin from Flash trait
This commit is contained in:
parent
d336a4b38a
commit
5ee87cf25d
3 changed files with 66 additions and 65 deletions
|
@ -14,7 +14,6 @@ use embassy::traits::flash::Flash;
|
||||||
use embassy_nrf::Peripherals;
|
use embassy_nrf::Peripherals;
|
||||||
use embassy_nrf::{interrupt, qspi};
|
use embassy_nrf::{interrupt, qspi};
|
||||||
use example_common::*;
|
use example_common::*;
|
||||||
use futures::pin_mut;
|
|
||||||
|
|
||||||
const PAGE_SIZE: usize = 4096;
|
const PAGE_SIZE: usize = 4096;
|
||||||
|
|
||||||
|
@ -36,32 +35,22 @@ async fn main(spawner: Spawner) {
|
||||||
|
|
||||||
let config = qspi::Config::default();
|
let config = qspi::Config::default();
|
||||||
let irq = interrupt::take!(QSPI);
|
let irq = interrupt::take!(QSPI);
|
||||||
let q = qspi::Qspi::new(p.QSPI, irq, sck, csn, io0, io1, io2, io3, config);
|
let mut q = qspi::Qspi::new(p.QSPI, irq, sck, csn, io0, io1, io2, io3, config);
|
||||||
pin_mut!(q);
|
|
||||||
|
|
||||||
let mut id = [1; 3];
|
let mut id = [1; 3];
|
||||||
q.as_mut()
|
q.custom_instruction(0x9F, &[], &mut id).await.unwrap();
|
||||||
.custom_instruction(0x9F, &[], &mut id)
|
|
||||||
.await
|
|
||||||
.unwrap();
|
|
||||||
info!("id: {}", id);
|
info!("id: {}", id);
|
||||||
|
|
||||||
// Read status register
|
// Read status register
|
||||||
let mut status = [4; 1];
|
let mut status = [4; 1];
|
||||||
q.as_mut()
|
q.custom_instruction(0x05, &[], &mut status).await.unwrap();
|
||||||
.custom_instruction(0x05, &[], &mut status)
|
|
||||||
.await
|
|
||||||
.unwrap();
|
|
||||||
|
|
||||||
info!("status: {:?}", status[0]);
|
info!("status: {:?}", status[0]);
|
||||||
|
|
||||||
if status[0] & 0x40 == 0 {
|
if status[0] & 0x40 == 0 {
|
||||||
status[0] |= 0x40;
|
status[0] |= 0x40;
|
||||||
|
|
||||||
q.as_mut()
|
q.custom_instruction(0x01, &status, &mut []).await.unwrap();
|
||||||
.custom_instruction(0x01, &status, &mut [])
|
|
||||||
.await
|
|
||||||
.unwrap();
|
|
||||||
|
|
||||||
info!("enabled quad in status");
|
info!("enabled quad in status");
|
||||||
}
|
}
|
||||||
|
@ -72,19 +61,19 @@ async fn main(spawner: Spawner) {
|
||||||
|
|
||||||
for i in 0..8 {
|
for i in 0..8 {
|
||||||
info!("page {:?}: erasing... ", i);
|
info!("page {:?}: erasing... ", i);
|
||||||
q.as_mut().erase(i * PAGE_SIZE).await.unwrap();
|
q.erase(i * PAGE_SIZE).await.unwrap();
|
||||||
|
|
||||||
for j in 0..PAGE_SIZE {
|
for j in 0..PAGE_SIZE {
|
||||||
buf.0[j] = pattern((j + i * PAGE_SIZE) as u32);
|
buf.0[j] = pattern((j + i * PAGE_SIZE) as u32);
|
||||||
}
|
}
|
||||||
|
|
||||||
info!("programming...");
|
info!("programming...");
|
||||||
q.as_mut().write(i * PAGE_SIZE, &buf.0).await.unwrap();
|
q.write(i * PAGE_SIZE, &buf.0).await.unwrap();
|
||||||
}
|
}
|
||||||
|
|
||||||
for i in 0..8 {
|
for i in 0..8 {
|
||||||
info!("page {:?}: reading... ", i);
|
info!("page {:?}: reading... ", i);
|
||||||
q.as_mut().read(i * PAGE_SIZE, &mut buf.0).await.unwrap();
|
q.read(i * PAGE_SIZE, &mut buf.0).await.unwrap();
|
||||||
|
|
||||||
info!("verifying...");
|
info!("verifying...");
|
||||||
for j in 0..PAGE_SIZE {
|
for j in 0..PAGE_SIZE {
|
||||||
|
|
|
@ -1,11 +1,11 @@
|
||||||
use core::future::Future;
|
use core::future::Future;
|
||||||
use core::marker::PhantomData;
|
use core::marker::PhantomData;
|
||||||
use core::pin::Pin;
|
|
||||||
use core::task::Poll;
|
use core::task::Poll;
|
||||||
|
use embassy::interrupt::{Interrupt, InterruptExt};
|
||||||
use embassy::interrupt::Interrupt;
|
use embassy::traits::flash::{Error, Flash};
|
||||||
use embassy_extras::peripheral::{PeripheralMutex, PeripheralState};
|
use embassy::util::{AtomicWaker, DropBomb, PeripheralBorrow};
|
||||||
use embassy_extras::unborrow;
|
use embassy_extras::unborrow;
|
||||||
|
use futures::future::poll_fn;
|
||||||
|
|
||||||
use crate::fmt::{assert, assert_eq, *};
|
use crate::fmt::{assert, assert_eq, *};
|
||||||
use crate::gpio::Pin as GpioPin;
|
use crate::gpio::Pin as GpioPin;
|
||||||
|
@ -27,10 +27,6 @@ pub use crate::pac::qspi::ifconfig0::WRITEOC_A as WriteOpcode;
|
||||||
// - activate/deactivate
|
// - activate/deactivate
|
||||||
// - set gpio in high drive
|
// - set gpio in high drive
|
||||||
|
|
||||||
use embassy::traits::flash::{Error, Flash};
|
|
||||||
use embassy::util::{wake_on_interrupt, DropBomb, PeripheralBorrow, WakerRegistration};
|
|
||||||
use futures::future::poll_fn;
|
|
||||||
|
|
||||||
pub struct DeepPowerDownConfig {
|
pub struct DeepPowerDownConfig {
|
||||||
pub enter_time: u16,
|
pub enter_time: u16,
|
||||||
pub exit_time: u16,
|
pub exit_time: u16,
|
||||||
|
@ -77,7 +73,7 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
) -> Self {
|
) -> Self {
|
||||||
unborrow!(qspi, irq, sck, csn, io0, io1, io2, io3);
|
unborrow!(qspi, irq, sck, csn, io0, io1, io2, io3);
|
||||||
|
|
||||||
let r = qspi.regs();
|
let r = T::regs();
|
||||||
|
|
||||||
for cnf in &[
|
for cnf in &[
|
||||||
sck.conf(),
|
sck.conf(),
|
||||||
|
@ -137,6 +133,10 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
while r.events_ready.read().bits() == 0 {}
|
while r.events_ready.read().bits() == 0 {}
|
||||||
r.events_ready.reset();
|
r.events_ready.reset();
|
||||||
|
|
||||||
|
irq.set_handler(Self::on_interrupt);
|
||||||
|
irq.unpend();
|
||||||
|
irq.enable();
|
||||||
|
|
||||||
Self {
|
Self {
|
||||||
peri: qspi,
|
peri: qspi,
|
||||||
irq,
|
irq,
|
||||||
|
@ -144,8 +144,18 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn sleep(mut self: Pin<&mut Self>) {
|
fn on_interrupt(_: *mut ()) {
|
||||||
let r = unsafe { self.as_mut().get_unchecked_mut() }.peri.regs();
|
let r = T::regs();
|
||||||
|
let s = T::state();
|
||||||
|
|
||||||
|
if r.events_ready.read().bits() != 0 {
|
||||||
|
s.ready_waker.wake();
|
||||||
|
r.intenclr.write(|w| w.ready().clear());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn sleep(&mut self) {
|
||||||
|
let r = T::regs();
|
||||||
|
|
||||||
info!("flash: sleeping");
|
info!("flash: sleeping");
|
||||||
info!("flash: state = {:?}", r.status.read().bits());
|
info!("flash: state = {:?}", r.status.read().bits());
|
||||||
|
@ -158,7 +168,7 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
}
|
}
|
||||||
|
|
||||||
pub async fn custom_instruction(
|
pub async fn custom_instruction(
|
||||||
mut self: Pin<&mut Self>,
|
&mut self,
|
||||||
opcode: u8,
|
opcode: u8,
|
||||||
req: &[u8],
|
req: &[u8],
|
||||||
resp: &mut [u8],
|
resp: &mut [u8],
|
||||||
|
@ -184,7 +194,7 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
|
|
||||||
let len = core::cmp::max(req.len(), resp.len()) as u8;
|
let len = core::cmp::max(req.len(), resp.len()) as u8;
|
||||||
|
|
||||||
let r = unsafe { self.as_mut().get_unchecked_mut() }.peri.regs();
|
let r = T::regs();
|
||||||
r.cinstrdat0.write(|w| unsafe { w.bits(dat0) });
|
r.cinstrdat0.write(|w| unsafe { w.bits(dat0) });
|
||||||
r.cinstrdat1.write(|w| unsafe { w.bits(dat1) });
|
r.cinstrdat1.write(|w| unsafe { w.bits(dat1) });
|
||||||
|
|
||||||
|
@ -203,9 +213,9 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
w
|
w
|
||||||
});
|
});
|
||||||
|
|
||||||
self.as_mut().wait_ready().await;
|
self.wait_ready().await;
|
||||||
|
|
||||||
let r = unsafe { self.as_mut().get_unchecked_mut() }.peri.regs();
|
let r = T::regs();
|
||||||
|
|
||||||
let dat0 = r.cinstrdat0.read().bits();
|
let dat0 = r.cinstrdat0.read().bits();
|
||||||
let dat1 = r.cinstrdat1.read().bits();
|
let dat1 = r.cinstrdat1.read().bits();
|
||||||
|
@ -225,19 +235,14 @@ impl<'d, T: Instance> Qspi<'d, T> {
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
|
|
||||||
async fn wait_ready(self: Pin<&mut Self>) {
|
async fn wait_ready(&mut self) {
|
||||||
let this = unsafe { self.get_unchecked_mut() };
|
|
||||||
|
|
||||||
poll_fn(move |cx| {
|
poll_fn(move |cx| {
|
||||||
let r = this.peri.regs();
|
let r = T::regs();
|
||||||
|
let s = T::state();
|
||||||
|
s.ready_waker.register(cx.waker());
|
||||||
if r.events_ready.read().bits() != 0 {
|
if r.events_ready.read().bits() != 0 {
|
||||||
r.events_ready.reset();
|
|
||||||
return Poll::Ready(());
|
return Poll::Ready(());
|
||||||
}
|
}
|
||||||
|
|
||||||
wake_on_interrupt(&mut this.irq, cx.waker());
|
|
||||||
|
|
||||||
Poll::Pending
|
Poll::Pending
|
||||||
})
|
})
|
||||||
.await
|
.await
|
||||||
|
@ -252,11 +257,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
#[rustfmt::skip]
|
#[rustfmt::skip]
|
||||||
type ErasePageFuture<'a> where Self: 'a = impl Future<Output = Result<(), Error>> + 'a;
|
type ErasePageFuture<'a> where Self: 'a = impl Future<Output = Result<(), Error>> + 'a;
|
||||||
|
|
||||||
fn read<'a>(
|
fn read<'a>(&'a mut self, address: usize, data: &'a mut [u8]) -> Self::ReadFuture<'a> {
|
||||||
mut self: Pin<&'a mut Self>,
|
|
||||||
address: usize,
|
|
||||||
data: &'a mut [u8],
|
|
||||||
) -> Self::ReadFuture<'a> {
|
|
||||||
async move {
|
async move {
|
||||||
let bomb = DropBomb::new();
|
let bomb = DropBomb::new();
|
||||||
|
|
||||||
|
@ -264,7 +265,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
assert_eq!(data.len() as u32 % 4, 0);
|
assert_eq!(data.len() as u32 % 4, 0);
|
||||||
assert_eq!(address as u32 % 4, 0);
|
assert_eq!(address as u32 % 4, 0);
|
||||||
|
|
||||||
let r = unsafe { self.as_mut().get_unchecked_mut() }.peri.regs();
|
let r = T::regs();
|
||||||
|
|
||||||
r.read
|
r.read
|
||||||
.src
|
.src
|
||||||
|
@ -280,7 +281,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
r.intenset.write(|w| w.ready().set());
|
r.intenset.write(|w| w.ready().set());
|
||||||
r.tasks_readstart.write(|w| w.tasks_readstart().bit(true));
|
r.tasks_readstart.write(|w| w.tasks_readstart().bit(true));
|
||||||
|
|
||||||
self.as_mut().wait_ready().await;
|
self.wait_ready().await;
|
||||||
|
|
||||||
bomb.defuse();
|
bomb.defuse();
|
||||||
|
|
||||||
|
@ -288,11 +289,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
fn write<'a>(
|
fn write<'a>(&'a mut self, address: usize, data: &'a [u8]) -> Self::WriteFuture<'a> {
|
||||||
mut self: Pin<&'a mut Self>,
|
|
||||||
address: usize,
|
|
||||||
data: &'a [u8],
|
|
||||||
) -> Self::WriteFuture<'a> {
|
|
||||||
async move {
|
async move {
|
||||||
let bomb = DropBomb::new();
|
let bomb = DropBomb::new();
|
||||||
|
|
||||||
|
@ -300,7 +297,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
assert_eq!(data.len() as u32 % 4, 0);
|
assert_eq!(data.len() as u32 % 4, 0);
|
||||||
assert_eq!(address as u32 % 4, 0);
|
assert_eq!(address as u32 % 4, 0);
|
||||||
|
|
||||||
let r = unsafe { self.as_mut().get_unchecked_mut() }.peri.regs();
|
let r = T::regs();
|
||||||
r.write
|
r.write
|
||||||
.src
|
.src
|
||||||
.write(|w| unsafe { w.src().bits(data.as_ptr() as u32) });
|
.write(|w| unsafe { w.src().bits(data.as_ptr() as u32) });
|
||||||
|
@ -315,7 +312,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
r.intenset.write(|w| w.ready().set());
|
r.intenset.write(|w| w.ready().set());
|
||||||
r.tasks_writestart.write(|w| w.tasks_writestart().bit(true));
|
r.tasks_writestart.write(|w| w.tasks_writestart().bit(true));
|
||||||
|
|
||||||
self.as_mut().wait_ready().await;
|
self.wait_ready().await;
|
||||||
|
|
||||||
bomb.defuse();
|
bomb.defuse();
|
||||||
|
|
||||||
|
@ -323,13 +320,13 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
fn erase<'a>(mut self: Pin<&'a mut Self>, address: usize) -> Self::ErasePageFuture<'a> {
|
fn erase<'a>(&'a mut self, address: usize) -> Self::ErasePageFuture<'a> {
|
||||||
async move {
|
async move {
|
||||||
let bomb = DropBomb::new();
|
let bomb = DropBomb::new();
|
||||||
|
|
||||||
assert_eq!(address as u32 % 4096, 0);
|
assert_eq!(address as u32 % 4096, 0);
|
||||||
|
|
||||||
let r = unsafe { self.as_mut().get_unchecked_mut() }.peri.regs();
|
let r = T::regs();
|
||||||
r.erase
|
r.erase
|
||||||
.ptr
|
.ptr
|
||||||
.write(|w| unsafe { w.ptr().bits(address as u32) });
|
.write(|w| unsafe { w.ptr().bits(address as u32) });
|
||||||
|
@ -339,7 +336,7 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
r.intenset.write(|w| w.ready().set());
|
r.intenset.write(|w| w.ready().set());
|
||||||
r.tasks_erasestart.write(|w| w.tasks_erasestart().bit(true));
|
r.tasks_erasestart.write(|w| w.tasks_erasestart().bit(true));
|
||||||
|
|
||||||
self.as_mut().wait_ready().await;
|
self.wait_ready().await;
|
||||||
|
|
||||||
bomb.defuse();
|
bomb.defuse();
|
||||||
|
|
||||||
|
@ -367,8 +364,20 @@ impl<'d, T: Instance> Flash for Qspi<'d, T> {
|
||||||
mod sealed {
|
mod sealed {
|
||||||
use super::*;
|
use super::*;
|
||||||
|
|
||||||
|
pub struct State {
|
||||||
|
pub ready_waker: AtomicWaker,
|
||||||
|
}
|
||||||
|
impl State {
|
||||||
|
pub const fn new() -> Self {
|
||||||
|
Self {
|
||||||
|
ready_waker: AtomicWaker::new(),
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
pub trait Instance {
|
pub trait Instance {
|
||||||
fn regs(&self) -> &pac::qspi::RegisterBlock;
|
fn regs() -> &'static pac::qspi::RegisterBlock;
|
||||||
|
fn state() -> &'static State;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -379,9 +388,13 @@ pub trait Instance: sealed::Instance + 'static {
|
||||||
macro_rules! impl_instance {
|
macro_rules! impl_instance {
|
||||||
($type:ident, $irq:ident) => {
|
($type:ident, $irq:ident) => {
|
||||||
impl sealed::Instance for peripherals::$type {
|
impl sealed::Instance for peripherals::$type {
|
||||||
fn regs(&self) -> &pac::qspi::RegisterBlock {
|
fn regs() -> &'static pac::qspi::RegisterBlock {
|
||||||
unsafe { &*pac::$type::ptr() }
|
unsafe { &*pac::$type::ptr() }
|
||||||
}
|
}
|
||||||
|
fn state() -> &'static sealed::State {
|
||||||
|
static STATE: sealed::State = sealed::State::new();
|
||||||
|
&STATE
|
||||||
|
}
|
||||||
}
|
}
|
||||||
impl Instance for peripherals::$type {
|
impl Instance for peripherals::$type {
|
||||||
type Interrupt = interrupt::$irq;
|
type Interrupt = interrupt::$irq;
|
||||||
|
|
|
@ -27,19 +27,18 @@ pub trait Flash {
|
||||||
///
|
///
|
||||||
/// address must be a multiple of self.read_size().
|
/// address must be a multiple of self.read_size().
|
||||||
/// buf.len() must be a multiple of self.read_size().
|
/// buf.len() must be a multiple of self.read_size().
|
||||||
fn read<'a>(self: Pin<&'a mut Self>, address: usize, buf: &'a mut [u8])
|
fn read<'a>(&'a mut self, address: usize, buf: &'a mut [u8]) -> Self::ReadFuture<'a>;
|
||||||
-> Self::ReadFuture<'a>;
|
|
||||||
|
|
||||||
/// Writes data to the flash device.
|
/// Writes data to the flash device.
|
||||||
///
|
///
|
||||||
/// address must be a multiple of self.write_size().
|
/// address must be a multiple of self.write_size().
|
||||||
/// buf.len() must be a multiple of self.write_size().
|
/// buf.len() must be a multiple of self.write_size().
|
||||||
fn write<'a>(self: Pin<&'a mut Self>, address: usize, buf: &'a [u8]) -> Self::WriteFuture<'a>;
|
fn write<'a>(&'a mut self, address: usize, buf: &'a [u8]) -> Self::WriteFuture<'a>;
|
||||||
|
|
||||||
/// Erases a single page from the flash device.
|
/// Erases a single page from the flash device.
|
||||||
///
|
///
|
||||||
/// address must be a multiple of self.erase_size().
|
/// address must be a multiple of self.erase_size().
|
||||||
fn erase<'a>(self: Pin<&'a mut Self>, address: usize) -> Self::ErasePageFuture<'a>;
|
fn erase<'a>(&'a mut self, address: usize) -> Self::ErasePageFuture<'a>;
|
||||||
|
|
||||||
/// Returns the total size, in bytes.
|
/// Returns the total size, in bytes.
|
||||||
/// This is not guaranteed to be a power of 2.
|
/// This is not guaranteed to be a power of 2.
|
||||||
|
|
Loading…
Reference in a new issue