1051: Adapted nvmc so it can be used for all nrf targets r=diondokter a=diondokter

Title says it all pretty much.
It's a bit annoying with the configs though.

I've made this a draft because I haven't really tested this yet.

Co-authored-by: Dion Dokter <dion@tweedegolf.com>
Co-authored-by: Dion Dokter <diondokter@gmail.com>
This commit is contained in:
bors[bot] 2022-12-09 16:45:55 +00:00 committed by GitHub
commit e94ca0efd6
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
5 changed files with 71 additions and 12 deletions

View File

@ -213,6 +213,8 @@ pub mod pac {
pub const EASY_DMA_SIZE: usize = (1 << 16) - 1; pub const EASY_DMA_SIZE: usize = (1 << 16) - 1;
pub const FORCE_COPY_BUFFER_SIZE: usize = 1024; pub const FORCE_COPY_BUFFER_SIZE: usize = 1024;
pub const FLASH_SIZE: usize = 1024 * 1024;
embassy_hal_common::peripherals! { embassy_hal_common::peripherals! {
// USB // USB
USBD, USBD,
@ -224,6 +226,9 @@ embassy_hal_common::peripherals! {
// WDT // WDT
WDT, WDT,
// NVMC
NVMC,
// UARTE, TWI & SPI // UARTE, TWI & SPI
UARTETWISPI0, UARTETWISPI0,
UARTETWISPI1, UARTETWISPI1,

View File

@ -104,6 +104,8 @@ pub mod pac {
pub const EASY_DMA_SIZE: usize = (1 << 16) - 1; pub const EASY_DMA_SIZE: usize = (1 << 16) - 1;
pub const FORCE_COPY_BUFFER_SIZE: usize = 1024; pub const FORCE_COPY_BUFFER_SIZE: usize = 1024;
pub const FLASH_SIZE: usize = 256 * 1024;
embassy_hal_common::peripherals! { embassy_hal_common::peripherals! {
// RTC // RTC
RTC0, RTC0,
@ -112,6 +114,9 @@ embassy_hal_common::peripherals! {
// WDT // WDT
WDT, WDT,
// NVMC
NVMC,
// UARTE, TWI & SPI // UARTE, TWI & SPI
UARTETWISPI0, UARTETWISPI0,
UARTETWISPI1, UARTETWISPI1,

View File

@ -164,6 +164,8 @@ pub mod pac {
pub const EASY_DMA_SIZE: usize = (1 << 13) - 1; pub const EASY_DMA_SIZE: usize = (1 << 13) - 1;
pub const FORCE_COPY_BUFFER_SIZE: usize = 1024; pub const FORCE_COPY_BUFFER_SIZE: usize = 1024;
pub const FLASH_SIZE: usize = 1024 * 1024;
embassy_hal_common::peripherals! { embassy_hal_common::peripherals! {
// RTC // RTC
RTC0, RTC0,
@ -172,6 +174,9 @@ embassy_hal_common::peripherals! {
// WDT // WDT
WDT, WDT,
// NVMC
NVMC,
// UARTE, TWI & SPI // UARTE, TWI & SPI
UARTETWISPI0, UARTETWISPI0,
UARTETWISPI1, UARTETWISPI1,

View File

@ -80,7 +80,6 @@ pub mod gpio;
pub mod gpiote; pub mod gpiote;
#[cfg(any(feature = "nrf52832", feature = "nrf52833", feature = "nrf52840"))] #[cfg(any(feature = "nrf52832", feature = "nrf52833", feature = "nrf52840"))]
pub mod i2s; pub mod i2s;
#[cfg(not(any(feature = "_nrf5340", feature = "_nrf9160")))]
pub mod nvmc; pub mod nvmc;
#[cfg(any( #[cfg(any(
feature = "nrf52810", feature = "nrf52810",

View File

@ -10,8 +10,12 @@ use embedded_storage::nor_flash::{
use crate::peripherals::NVMC; use crate::peripherals::NVMC;
use crate::{pac, Peripheral}; use crate::{pac, Peripheral};
#[cfg(not(feature = "_nrf5340-net"))]
/// Erase size of NVMC flash in bytes. /// Erase size of NVMC flash in bytes.
pub const PAGE_SIZE: usize = 4096; pub const PAGE_SIZE: usize = 4096;
#[cfg(feature = "_nrf5340-net")]
/// Erase size of NVMC flash in bytes.
pub const PAGE_SIZE: usize = 2048;
/// Size of NVMC flash in bytes. /// Size of NVMC flash in bytes.
pub const FLASH_SIZE: usize = crate::chip::FLASH_SIZE; pub const FLASH_SIZE: usize = crate::chip::FLASH_SIZE;
@ -55,6 +59,51 @@ impl<'d> Nvmc<'d> {
let p = Self::regs(); let p = Self::regs();
while p.ready.read().ready().is_busy() {} while p.ready.read().ready().is_busy() {}
} }
#[cfg(not(any(feature = "_nrf9160", feature = "_nrf5340")))]
fn wait_ready_write(&mut self) {
self.wait_ready();
}
#[cfg(any(feature = "_nrf9160", feature = "_nrf5340"))]
fn wait_ready_write(&mut self) {
let p = Self::regs();
while p.readynext.read().readynext().is_busy() {}
}
#[cfg(not(any(feature = "_nrf9160", feature = "_nrf5340")))]
fn erase_page(&mut self, page_addr: u32) {
Self::regs().erasepage().write(|w| unsafe { w.bits(page_addr) });
}
#[cfg(any(feature = "_nrf9160", feature = "_nrf5340"))]
fn erase_page(&mut self, page_addr: u32) {
let first_page_word = page_addr as *mut u32;
unsafe {
first_page_word.write_volatile(0xFFFF_FFFF);
}
}
fn enable_erase(&self) {
#[cfg(not(any(feature = "nrf5340-app-ns", feature = "nrf9160-ns")))]
Self::regs().config.write(|w| w.wen().een());
#[cfg(any(feature = "nrf5340-app-ns", feature = "nrf9160-ns"))]
Self::regs().configns.write(|w| w.wen().een());
}
fn enable_read(&self) {
#[cfg(not(any(feature = "nrf5340-app-ns", feature = "nrf9160-ns")))]
Self::regs().config.write(|w| w.wen().ren());
#[cfg(any(feature = "nrf5340-app-ns", feature = "nrf9160-ns"))]
Self::regs().configns.write(|w| w.wen().ren());
}
fn enable_write(&self) {
#[cfg(not(any(feature = "nrf5340-app-ns", feature = "nrf9160-ns")))]
Self::regs().config.write(|w| w.wen().wen());
#[cfg(any(feature = "nrf5340-app-ns", feature = "nrf9160-ns"))]
Self::regs().configns.write(|w| w.wen().wen());
}
} }
impl<'d> MultiwriteNorFlash for Nvmc<'d> {} impl<'d> MultiwriteNorFlash for Nvmc<'d> {}
@ -93,17 +142,15 @@ impl<'d> NorFlash for Nvmc<'d> {
return Err(Error::Unaligned); return Err(Error::Unaligned);
} }
let p = Self::regs(); self.enable_erase();
p.config.write(|w| w.wen().een());
self.wait_ready(); self.wait_ready();
for page in (from..to).step_by(PAGE_SIZE) { for page_addr in (from..to).step_by(PAGE_SIZE) {
p.erasepage().write(|w| unsafe { w.bits(page) }); self.erase_page(page_addr);
self.wait_ready(); self.wait_ready();
} }
p.config.reset(); self.enable_read();
self.wait_ready(); self.wait_ready();
Ok(()) Ok(())
@ -117,9 +164,7 @@ impl<'d> NorFlash for Nvmc<'d> {
return Err(Error::Unaligned); return Err(Error::Unaligned);
} }
let p = Self::regs(); self.enable_write();
p.config.write(|w| w.wen().wen());
self.wait_ready(); self.wait_ready();
unsafe { unsafe {
@ -129,11 +174,11 @@ impl<'d> NorFlash for Nvmc<'d> {
for i in 0..words { for i in 0..words {
let w = ptr::read_unaligned(p_src.add(i)); let w = ptr::read_unaligned(p_src.add(i));
ptr::write_volatile(p_dst.add(i), w); ptr::write_volatile(p_dst.add(i), w);
self.wait_ready(); self.wait_ready_write();
} }
} }
p.config.reset(); self.enable_read();
self.wait_ready(); self.wait_ready();
Ok(()) Ok(())