Split FirmwareUpdater into async and blocking types
This commit is contained in:
parent
311236e81e
commit
5205b5b095
@ -1,20 +1,68 @@
|
|||||||
use digest::Digest;
|
use digest::Digest;
|
||||||
use embedded_storage_async::nor_flash::NorFlash as AsyncNorFlash;
|
use embassy_embedded_hal::flash::partition::Partition;
|
||||||
|
use embassy_sync::blocking_mutex::raw::NoopRawMutex;
|
||||||
|
use embedded_storage_async::nor_flash::NorFlash;
|
||||||
|
|
||||||
use crate::{FirmwareUpdater, FirmwareUpdaterError, Partition, State, BOOT_MAGIC, SWAP_MAGIC};
|
use super::FirmwareUpdaterConfig;
|
||||||
|
use crate::{FirmwareUpdaterError, State, BOOT_MAGIC, STATE_ERASE_VALUE, SWAP_MAGIC};
|
||||||
|
|
||||||
|
/// FirmwareUpdater is an application API for interacting with the BootLoader without the ability to
|
||||||
|
/// 'mess up' the internal bootloader state
|
||||||
|
pub struct FirmwareUpdater<DFU: NorFlash, STATE: NorFlash> {
|
||||||
|
dfu: DFU,
|
||||||
|
state: STATE,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl<'a, FLASH: NorFlash>
|
||||||
|
FirmwareUpdaterConfig<Partition<'a, NoopRawMutex, FLASH>, Partition<'a, NoopRawMutex, FLASH>>
|
||||||
|
{
|
||||||
|
/// Create a firmware updater config from the flash and address symbols defined in the linkerfile
|
||||||
|
#[cfg(target_os = "none")]
|
||||||
|
pub fn from_linkerfile(flash: &'a Mutex<NoopRawMutex, FLASH>) -> Self {
|
||||||
|
use embassy_sync::mutex::Mutex;
|
||||||
|
|
||||||
|
extern "C" {
|
||||||
|
static __bootloader_state_start: u32;
|
||||||
|
static __bootloader_state_end: u32;
|
||||||
|
static __bootloader_dfu_start: u32;
|
||||||
|
static __bootloader_dfu_end: u32;
|
||||||
|
}
|
||||||
|
|
||||||
|
let dfu = unsafe {
|
||||||
|
let start = &__bootloader_dfu_start as *const u32 as u32;
|
||||||
|
let end = &__bootloader_dfu_end as *const u32 as u32;
|
||||||
|
trace!("DFU: 0x{:x} - 0x{:x}", start, end);
|
||||||
|
|
||||||
|
Partition::new(flash, start, end - start)
|
||||||
|
};
|
||||||
|
let state = unsafe {
|
||||||
|
let start = &__bootloader_state_start as *const u32 as u32;
|
||||||
|
let end = &__bootloader_state_end as *const u32 as u32;
|
||||||
|
trace!("STATE: 0x{:x} - 0x{:x}", start, end);
|
||||||
|
|
||||||
|
Partition::new(flash, start, end - start)
|
||||||
|
};
|
||||||
|
|
||||||
|
Self { dfu, state }
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl<DFU: NorFlash, STATE: NorFlash> FirmwareUpdater<DFU, STATE> {
|
||||||
|
/// Create a firmware updater instance with partition ranges for the update and state partitions.
|
||||||
|
pub fn new(config: FirmwareUpdaterConfig<DFU, STATE>) -> Self {
|
||||||
|
Self {
|
||||||
|
dfu: config.dfu,
|
||||||
|
state: config.state,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
impl FirmwareUpdater {
|
|
||||||
/// Obtain the current state.
|
/// Obtain the current state.
|
||||||
///
|
///
|
||||||
/// This is useful to check if the bootloader has just done a swap, in order
|
/// This is useful to check if the bootloader has just done a swap, in order
|
||||||
/// to do verifications and self-tests of the new image before calling
|
/// to do verifications and self-tests of the new image before calling
|
||||||
/// `mark_booted`.
|
/// `mark_booted`.
|
||||||
pub async fn get_state<F: AsyncNorFlash>(
|
pub async fn get_state(&mut self, aligned: &mut [u8]) -> Result<State, FirmwareUpdaterError> {
|
||||||
&mut self,
|
self.state.read(0, aligned).await?;
|
||||||
state_flash: &mut F,
|
|
||||||
aligned: &mut [u8],
|
|
||||||
) -> Result<State, FirmwareUpdaterError> {
|
|
||||||
self.state.read(state_flash, 0, aligned).await?;
|
|
||||||
|
|
||||||
if !aligned.iter().any(|&b| b != SWAP_MAGIC) {
|
if !aligned.iter().any(|&b| b != SWAP_MAGIC) {
|
||||||
Ok(State::Swap)
|
Ok(State::Swap)
|
||||||
@ -37,19 +85,18 @@ impl FirmwareUpdater {
|
|||||||
///
|
///
|
||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// The `_aligned` buffer must have a size of F::WRITE_SIZE, and follow the alignment rules for the flash being read from
|
/// The `_aligned` buffer must have a size of STATE::WRITE_SIZE, and follow the alignment rules for the flash being read from
|
||||||
/// and written to.
|
/// and written to.
|
||||||
#[cfg(all(feature = "_verify", feature = "nightly"))]
|
#[cfg(feature = "_verify")]
|
||||||
pub async fn verify_and_mark_updated<F: AsyncNorFlash>(
|
pub async fn verify_and_mark_updated(
|
||||||
&mut self,
|
&mut self,
|
||||||
_state_and_dfu_flash: &mut F,
|
|
||||||
_public_key: &[u8],
|
_public_key: &[u8],
|
||||||
_signature: &[u8],
|
_signature: &[u8],
|
||||||
_update_len: u32,
|
_update_len: u32,
|
||||||
_aligned: &mut [u8],
|
_aligned: &mut [u8],
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
) -> Result<(), FirmwareUpdaterError> {
|
||||||
assert_eq!(_aligned.len(), F::WRITE_SIZE);
|
assert_eq!(_aligned.len(), STATE::WRITE_SIZE);
|
||||||
assert!(_update_len <= self.dfu.size());
|
assert!(_update_len <= self.dfu.capacity() as u32);
|
||||||
|
|
||||||
#[cfg(feature = "ed25519-dalek")]
|
#[cfg(feature = "ed25519-dalek")]
|
||||||
{
|
{
|
||||||
@ -63,8 +110,7 @@ impl FirmwareUpdater {
|
|||||||
let signature = Signature::from_bytes(_signature).map_err(into_signature_error)?;
|
let signature = Signature::from_bytes(_signature).map_err(into_signature_error)?;
|
||||||
|
|
||||||
let mut message = [0; 64];
|
let mut message = [0; 64];
|
||||||
self.hash::<_, Sha512>(_state_and_dfu_flash, _update_len, _aligned, &mut message)
|
self.hash::<Sha512>(_update_len, _aligned, &mut message).await?;
|
||||||
.await?;
|
|
||||||
|
|
||||||
public_key.verify(&message, &signature).map_err(into_signature_error)?
|
public_key.verify(&message, &signature).map_err(into_signature_error)?
|
||||||
}
|
}
|
||||||
@ -85,8 +131,7 @@ impl FirmwareUpdater {
|
|||||||
let signature = Signature::try_from(&signature).map_err(into_signature_error)?;
|
let signature = Signature::try_from(&signature).map_err(into_signature_error)?;
|
||||||
|
|
||||||
let mut message = [0; 64];
|
let mut message = [0; 64];
|
||||||
self.hash::<_, Sha512>(_state_and_dfu_flash, _update_len, _aligned, &mut message)
|
self.hash::<Sha512>(_update_len, _aligned, &mut message).await?;
|
||||||
.await?;
|
|
||||||
|
|
||||||
let r = public_key.verify(&message, &signature);
|
let r = public_key.verify(&message, &signature);
|
||||||
trace!(
|
trace!(
|
||||||
@ -99,20 +144,19 @@ impl FirmwareUpdater {
|
|||||||
r.map_err(into_signature_error)?
|
r.map_err(into_signature_error)?
|
||||||
}
|
}
|
||||||
|
|
||||||
self.set_magic(_aligned, SWAP_MAGIC, _state_and_dfu_flash).await
|
self.set_magic(_aligned, SWAP_MAGIC).await
|
||||||
}
|
}
|
||||||
|
|
||||||
/// Verify the update in DFU with any digest.
|
/// Verify the update in DFU with any digest.
|
||||||
pub async fn hash<F: AsyncNorFlash, D: Digest>(
|
pub async fn hash<D: Digest>(
|
||||||
&mut self,
|
&mut self,
|
||||||
dfu_flash: &mut F,
|
|
||||||
update_len: u32,
|
update_len: u32,
|
||||||
chunk_buf: &mut [u8],
|
chunk_buf: &mut [u8],
|
||||||
output: &mut [u8],
|
output: &mut [u8],
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
) -> Result<(), FirmwareUpdaterError> {
|
||||||
let mut digest = D::new();
|
let mut digest = D::new();
|
||||||
for offset in (0..update_len).step_by(chunk_buf.len()) {
|
for offset in (0..update_len).step_by(chunk_buf.len()) {
|
||||||
self.dfu.read(dfu_flash, offset, chunk_buf).await?;
|
self.dfu.read(offset, chunk_buf).await?;
|
||||||
let len = core::cmp::min((update_len - offset) as usize, chunk_buf.len());
|
let len = core::cmp::min((update_len - offset) as usize, chunk_buf.len());
|
||||||
digest.update(&chunk_buf[..len]);
|
digest.update(&chunk_buf[..len]);
|
||||||
}
|
}
|
||||||
@ -124,60 +168,44 @@ impl FirmwareUpdater {
|
|||||||
///
|
///
|
||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// The `aligned` buffer must have a size of F::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
/// The `aligned` buffer must have a size of STATE::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
||||||
#[cfg(all(feature = "nightly", not(feature = "_verify")))]
|
#[cfg(not(feature = "_verify"))]
|
||||||
pub async fn mark_updated<F: AsyncNorFlash>(
|
pub async fn mark_updated(&mut self, aligned: &mut [u8]) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
assert_eq!(aligned.len(), STATE::WRITE_SIZE);
|
||||||
state_flash: &mut F,
|
self.set_magic(aligned, SWAP_MAGIC).await
|
||||||
aligned: &mut [u8],
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
assert_eq!(aligned.len(), F::WRITE_SIZE);
|
|
||||||
self.set_magic(aligned, SWAP_MAGIC, state_flash).await
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/// Mark firmware boot successful and stop rollback on reset.
|
/// Mark firmware boot successful and stop rollback on reset.
|
||||||
///
|
///
|
||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// The `aligned` buffer must have a size of F::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
/// The `aligned` buffer must have a size of STATE::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
||||||
pub async fn mark_booted<F: AsyncNorFlash>(
|
pub async fn mark_booted(&mut self, aligned: &mut [u8]) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
assert_eq!(aligned.len(), STATE::WRITE_SIZE);
|
||||||
state_flash: &mut F,
|
self.set_magic(aligned, BOOT_MAGIC).await
|
||||||
aligned: &mut [u8],
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
assert_eq!(aligned.len(), F::WRITE_SIZE);
|
|
||||||
self.set_magic(aligned, BOOT_MAGIC, state_flash).await
|
|
||||||
}
|
}
|
||||||
|
|
||||||
async fn set_magic<F: AsyncNorFlash>(
|
async fn set_magic(&mut self, aligned: &mut [u8], magic: u8) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
self.state.read(0, aligned).await?;
|
||||||
aligned: &mut [u8],
|
|
||||||
magic: u8,
|
|
||||||
state_flash: &mut F,
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
self.state.read(state_flash, 0, aligned).await?;
|
|
||||||
|
|
||||||
if aligned.iter().any(|&b| b != magic) {
|
if aligned.iter().any(|&b| b != magic) {
|
||||||
// Read progress validity
|
// Read progress validity
|
||||||
self.state.read(state_flash, F::WRITE_SIZE as u32, aligned).await?;
|
self.state.read(STATE::WRITE_SIZE as u32, aligned).await?;
|
||||||
|
|
||||||
// FIXME: Do not make this assumption.
|
|
||||||
const STATE_ERASE_VALUE: u8 = 0xFF;
|
|
||||||
|
|
||||||
if aligned.iter().any(|&b| b != STATE_ERASE_VALUE) {
|
if aligned.iter().any(|&b| b != STATE_ERASE_VALUE) {
|
||||||
// The current progress validity marker is invalid
|
// The current progress validity marker is invalid
|
||||||
} else {
|
} else {
|
||||||
// Invalidate progress
|
// Invalidate progress
|
||||||
aligned.fill(!STATE_ERASE_VALUE);
|
aligned.fill(!STATE_ERASE_VALUE);
|
||||||
self.state.write(state_flash, F::WRITE_SIZE as u32, aligned).await?;
|
self.state.write(STATE::WRITE_SIZE as u32, aligned).await?;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Clear magic and progress
|
// Clear magic and progress
|
||||||
self.state.wipe(state_flash).await?;
|
self.state.erase(0, self.state.capacity() as u32).await?;
|
||||||
|
|
||||||
// Set magic
|
// Set magic
|
||||||
aligned.fill(magic);
|
aligned.fill(magic);
|
||||||
self.state.write(state_flash, 0, aligned).await?;
|
self.state.write(0, aligned).await?;
|
||||||
}
|
}
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
@ -189,19 +217,12 @@ impl FirmwareUpdater {
|
|||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// Failing to meet alignment and size requirements may result in a panic.
|
/// Failing to meet alignment and size requirements may result in a panic.
|
||||||
pub async fn write_firmware<F: AsyncNorFlash>(
|
pub async fn write_firmware(&mut self, offset: usize, data: &[u8]) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
assert!(data.len() >= DFU::ERASE_SIZE);
|
||||||
offset: usize,
|
|
||||||
data: &[u8],
|
|
||||||
dfu_flash: &mut F,
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
assert!(data.len() >= F::ERASE_SIZE);
|
|
||||||
|
|
||||||
self.dfu
|
self.dfu.erase(offset as u32, (offset + data.len()) as u32).await?;
|
||||||
.erase(dfu_flash, offset as u32, (offset + data.len()) as u32)
|
|
||||||
.await?;
|
|
||||||
|
|
||||||
self.dfu.write(dfu_flash, offset as u32, data).await?;
|
self.dfu.write(offset as u32, data).await?;
|
||||||
|
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
@ -211,18 +232,18 @@ impl FirmwareUpdater {
|
|||||||
///
|
///
|
||||||
/// Using this instead of `write_firmware` allows for an optimized API in
|
/// Using this instead of `write_firmware` allows for an optimized API in
|
||||||
/// exchange for added complexity.
|
/// exchange for added complexity.
|
||||||
pub async fn prepare_update<F: AsyncNorFlash>(
|
pub async fn prepare_update(&mut self) -> Result<&mut DFU, FirmwareUpdaterError> {
|
||||||
&mut self,
|
self.dfu.erase(0, self.dfu.capacity() as u32).await?;
|
||||||
dfu_flash: &mut F,
|
|
||||||
) -> Result<Partition, FirmwareUpdaterError> {
|
|
||||||
self.dfu.wipe(dfu_flash).await?;
|
|
||||||
|
|
||||||
Ok(self.dfu)
|
Ok(&mut self.dfu)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#[cfg(test)]
|
#[cfg(test)]
|
||||||
mod tests {
|
mod tests {
|
||||||
|
use embassy_embedded_hal::flash::partition::Partition;
|
||||||
|
use embassy_sync::blocking_mutex::raw::NoopRawMutex;
|
||||||
|
use embassy_sync::mutex::Mutex;
|
||||||
use futures::executor::block_on;
|
use futures::executor::block_on;
|
||||||
use sha1::{Digest, Sha1};
|
use sha1::{Digest, Sha1};
|
||||||
|
|
||||||
@ -231,20 +252,19 @@ mod tests {
|
|||||||
|
|
||||||
#[test]
|
#[test]
|
||||||
fn can_verify_sha1() {
|
fn can_verify_sha1() {
|
||||||
const STATE: Partition = Partition::new(0, 4096);
|
let flash = Mutex::<NoopRawMutex, _>::new(MemFlash::<131072, 4096, 8>::default());
|
||||||
const DFU: Partition = Partition::new(65536, 131072);
|
let state = Partition::new(&flash, 0, 4096);
|
||||||
|
let dfu = Partition::new(&flash, 65536, 65536);
|
||||||
let mut flash = MemFlash::<131072, 4096, 8>::default();
|
|
||||||
|
|
||||||
let update = [0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66];
|
let update = [0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66];
|
||||||
let mut to_write = [0; 4096];
|
let mut to_write = [0; 4096];
|
||||||
to_write[..7].copy_from_slice(update.as_slice());
|
to_write[..7].copy_from_slice(update.as_slice());
|
||||||
|
|
||||||
let mut updater = FirmwareUpdater::new(DFU, STATE);
|
let mut updater = FirmwareUpdater::new(FirmwareUpdaterConfig { dfu, state });
|
||||||
block_on(updater.write_firmware(0, to_write.as_slice(), &mut flash)).unwrap();
|
block_on(updater.write_firmware(0, to_write.as_slice())).unwrap();
|
||||||
let mut chunk_buf = [0; 2];
|
let mut chunk_buf = [0; 2];
|
||||||
let mut hash = [0; 20];
|
let mut hash = [0; 20];
|
||||||
block_on(updater.hash::<_, Sha1>(&mut flash, update.len() as u32, &mut chunk_buf, &mut hash)).unwrap();
|
block_on(updater.hash::<Sha1>(update.len() as u32, &mut chunk_buf, &mut hash)).unwrap();
|
||||||
|
|
||||||
assert_eq!(Sha1::digest(update).as_slice(), hash);
|
assert_eq!(Sha1::digest(update).as_slice(), hash);
|
||||||
}
|
}
|
||||||
|
@ -1,25 +1,70 @@
|
|||||||
use digest::Digest;
|
use digest::Digest;
|
||||||
|
use embassy_embedded_hal::flash::partition::BlockingPartition;
|
||||||
|
use embassy_sync::blocking_mutex::raw::NoopRawMutex;
|
||||||
use embedded_storage::nor_flash::NorFlash;
|
use embedded_storage::nor_flash::NorFlash;
|
||||||
|
|
||||||
use crate::{FirmwareUpdater, FirmwareUpdaterError, Partition, State, BOOT_MAGIC, SWAP_MAGIC};
|
use super::FirmwareUpdaterConfig;
|
||||||
|
use crate::{FirmwareUpdaterError, State, BOOT_MAGIC, STATE_ERASE_VALUE, SWAP_MAGIC};
|
||||||
|
|
||||||
|
/// Blocking FirmwareUpdater is an application API for interacting with the BootLoader without the ability to
|
||||||
|
/// 'mess up' the internal bootloader state
|
||||||
|
pub struct BlockingFirmwareUpdater<DFU: NorFlash, STATE: NorFlash> {
|
||||||
|
dfu: DFU,
|
||||||
|
state: STATE,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl<'a, FLASH: NorFlash>
|
||||||
|
FirmwareUpdaterConfig<BlockingPartition<'a, NoopRawMutex, FLASH>, BlockingPartition<'a, NoopRawMutex, FLASH>>
|
||||||
|
{
|
||||||
|
/// Create a firmware updater config from the flash and address symbols defined in the linkerfile
|
||||||
|
#[cfg(target_os = "none")]
|
||||||
|
pub fn from_linkerfile_blocking(flash: &'a Mutex<NoopRawMutex, RefCell<FLASH>>) -> Self {
|
||||||
|
use core::cell::RefCell;
|
||||||
|
|
||||||
|
use embassy_sync::blocking_mutex::Mutex;
|
||||||
|
|
||||||
|
extern "C" {
|
||||||
|
static __bootloader_state_start: u32;
|
||||||
|
static __bootloader_state_end: u32;
|
||||||
|
static __bootloader_dfu_start: u32;
|
||||||
|
static __bootloader_dfu_end: u32;
|
||||||
|
}
|
||||||
|
|
||||||
|
let dfu = unsafe {
|
||||||
|
let start = &__bootloader_dfu_start as *const u32 as u32;
|
||||||
|
let end = &__bootloader_dfu_end as *const u32 as u32;
|
||||||
|
trace!("DFU: 0x{:x} - 0x{:x}", start, end);
|
||||||
|
|
||||||
|
BlockingPartition::new(flash, start, end - start)
|
||||||
|
};
|
||||||
|
let state = unsafe {
|
||||||
|
let start = &__bootloader_state_start as *const u32 as u32;
|
||||||
|
let end = &__bootloader_state_end as *const u32 as u32;
|
||||||
|
trace!("STATE: 0x{:x} - 0x{:x}", start, end);
|
||||||
|
|
||||||
|
BlockingPartition::new(flash, start, end - start)
|
||||||
|
};
|
||||||
|
|
||||||
impl FirmwareUpdater {
|
|
||||||
/// Create a firmware updater instance with partition ranges for the update and state partitions.
|
|
||||||
pub const fn new(dfu: Partition, state: Partition) -> Self {
|
|
||||||
Self { dfu, state }
|
Self { dfu, state }
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl<DFU: NorFlash, STATE: NorFlash> BlockingFirmwareUpdater<DFU, STATE> {
|
||||||
|
/// Create a firmware updater instance with partition ranges for the update and state partitions.
|
||||||
|
pub fn new(config: FirmwareUpdaterConfig<DFU, STATE>) -> Self {
|
||||||
|
Self {
|
||||||
|
dfu: config.dfu,
|
||||||
|
state: config.state,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
/// Obtain the current state.
|
/// Obtain the current state.
|
||||||
///
|
///
|
||||||
/// This is useful to check if the bootloader has just done a swap, in order
|
/// This is useful to check if the bootloader has just done a swap, in order
|
||||||
/// to do verifications and self-tests of the new image before calling
|
/// to do verifications and self-tests of the new image before calling
|
||||||
/// `mark_booted`.
|
/// `mark_booted`.
|
||||||
pub fn get_state_blocking<F: NorFlash>(
|
pub fn get_state(&mut self, aligned: &mut [u8]) -> Result<State, FirmwareUpdaterError> {
|
||||||
&mut self,
|
self.state.read(0, aligned)?;
|
||||||
state_flash: &mut F,
|
|
||||||
aligned: &mut [u8],
|
|
||||||
) -> Result<State, FirmwareUpdaterError> {
|
|
||||||
self.state.read_blocking(state_flash, 0, aligned)?;
|
|
||||||
|
|
||||||
if !aligned.iter().any(|&b| b != SWAP_MAGIC) {
|
if !aligned.iter().any(|&b| b != SWAP_MAGIC) {
|
||||||
Ok(State::Swap)
|
Ok(State::Swap)
|
||||||
@ -42,19 +87,18 @@ impl FirmwareUpdater {
|
|||||||
///
|
///
|
||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// The `_aligned` buffer must have a size of F::WRITE_SIZE, and follow the alignment rules for the flash being read from
|
/// The `_aligned` buffer must have a size of STATE::WRITE_SIZE, and follow the alignment rules for the flash being read from
|
||||||
/// and written to.
|
/// and written to.
|
||||||
#[cfg(feature = "_verify")]
|
#[cfg(feature = "_verify")]
|
||||||
pub fn verify_and_mark_updated_blocking<F: NorFlash>(
|
pub fn verify_and_mark_updated(
|
||||||
&mut self,
|
&mut self,
|
||||||
_state_and_dfu_flash: &mut F,
|
|
||||||
_public_key: &[u8],
|
_public_key: &[u8],
|
||||||
_signature: &[u8],
|
_signature: &[u8],
|
||||||
_update_len: u32,
|
_update_len: u32,
|
||||||
_aligned: &mut [u8],
|
_aligned: &mut [u8],
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
) -> Result<(), FirmwareUpdaterError> {
|
||||||
assert_eq!(_aligned.len(), F::WRITE_SIZE);
|
assert_eq!(_aligned.len(), STATE::WRITE_SIZE);
|
||||||
assert!(_update_len <= self.dfu.size());
|
assert!(_update_len <= self.dfu.capacity() as u32);
|
||||||
|
|
||||||
#[cfg(feature = "ed25519-dalek")]
|
#[cfg(feature = "ed25519-dalek")]
|
||||||
{
|
{
|
||||||
@ -68,7 +112,7 @@ impl FirmwareUpdater {
|
|||||||
let signature = Signature::from_bytes(_signature).map_err(into_signature_error)?;
|
let signature = Signature::from_bytes(_signature).map_err(into_signature_error)?;
|
||||||
|
|
||||||
let mut message = [0; 64];
|
let mut message = [0; 64];
|
||||||
self.hash_blocking::<_, Sha512>(_state_and_dfu_flash, _update_len, _aligned, &mut message)?;
|
self.hash::<Sha512>(_update_len, _aligned, &mut message)?;
|
||||||
|
|
||||||
public_key.verify(&message, &signature).map_err(into_signature_error)?
|
public_key.verify(&message, &signature).map_err(into_signature_error)?
|
||||||
}
|
}
|
||||||
@ -89,7 +133,7 @@ impl FirmwareUpdater {
|
|||||||
let signature = Signature::try_from(&signature).map_err(into_signature_error)?;
|
let signature = Signature::try_from(&signature).map_err(into_signature_error)?;
|
||||||
|
|
||||||
let mut message = [0; 64];
|
let mut message = [0; 64];
|
||||||
self.hash_blocking::<_, Sha512>(_state_and_dfu_flash, _update_len, _aligned, &mut message)?;
|
self.hash::<Sha512>(_update_len, _aligned, &mut message)?;
|
||||||
|
|
||||||
let r = public_key.verify(&message, &signature);
|
let r = public_key.verify(&message, &signature);
|
||||||
trace!(
|
trace!(
|
||||||
@ -102,20 +146,19 @@ impl FirmwareUpdater {
|
|||||||
r.map_err(into_signature_error)?
|
r.map_err(into_signature_error)?
|
||||||
}
|
}
|
||||||
|
|
||||||
self.set_magic_blocking(_aligned, SWAP_MAGIC, _state_and_dfu_flash)
|
self.set_magic(_aligned, SWAP_MAGIC)
|
||||||
}
|
}
|
||||||
|
|
||||||
/// Verify the update in DFU with any digest.
|
/// Verify the update in DFU with any digest.
|
||||||
pub fn hash_blocking<F: NorFlash, D: Digest>(
|
pub fn hash<D: Digest>(
|
||||||
&mut self,
|
&mut self,
|
||||||
dfu_flash: &mut F,
|
|
||||||
update_len: u32,
|
update_len: u32,
|
||||||
chunk_buf: &mut [u8],
|
chunk_buf: &mut [u8],
|
||||||
output: &mut [u8],
|
output: &mut [u8],
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
) -> Result<(), FirmwareUpdaterError> {
|
||||||
let mut digest = D::new();
|
let mut digest = D::new();
|
||||||
for offset in (0..update_len).step_by(chunk_buf.len()) {
|
for offset in (0..update_len).step_by(chunk_buf.len()) {
|
||||||
self.dfu.read_blocking(dfu_flash, offset, chunk_buf)?;
|
self.dfu.read(offset, chunk_buf)?;
|
||||||
let len = core::cmp::min((update_len - offset) as usize, chunk_buf.len());
|
let len = core::cmp::min((update_len - offset) as usize, chunk_buf.len());
|
||||||
digest.update(&chunk_buf[..len]);
|
digest.update(&chunk_buf[..len]);
|
||||||
}
|
}
|
||||||
@ -127,60 +170,44 @@ impl FirmwareUpdater {
|
|||||||
///
|
///
|
||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// The `aligned` buffer must have a size of F::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
/// The `aligned` buffer must have a size of STATE::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
||||||
#[cfg(not(feature = "_verify"))]
|
#[cfg(not(feature = "_verify"))]
|
||||||
pub fn mark_updated_blocking<F: NorFlash>(
|
pub fn mark_updated(&mut self, aligned: &mut [u8]) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
assert_eq!(aligned.len(), STATE::WRITE_SIZE);
|
||||||
state_flash: &mut F,
|
self.set_magic(aligned, SWAP_MAGIC)
|
||||||
aligned: &mut [u8],
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
assert_eq!(aligned.len(), F::WRITE_SIZE);
|
|
||||||
self.set_magic_blocking(aligned, SWAP_MAGIC, state_flash)
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/// Mark firmware boot successful and stop rollback on reset.
|
/// Mark firmware boot successful and stop rollback on reset.
|
||||||
///
|
///
|
||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// The `aligned` buffer must have a size of F::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
/// The `aligned` buffer must have a size of STATE::WRITE_SIZE, and follow the alignment rules for the flash being written to.
|
||||||
pub fn mark_booted_blocking<F: NorFlash>(
|
pub fn mark_booted(&mut self, aligned: &mut [u8]) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
assert_eq!(aligned.len(), STATE::WRITE_SIZE);
|
||||||
state_flash: &mut F,
|
self.set_magic(aligned, BOOT_MAGIC)
|
||||||
aligned: &mut [u8],
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
assert_eq!(aligned.len(), F::WRITE_SIZE);
|
|
||||||
self.set_magic_blocking(aligned, BOOT_MAGIC, state_flash)
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn set_magic_blocking<F: NorFlash>(
|
fn set_magic(&mut self, aligned: &mut [u8], magic: u8) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
self.state.read(0, aligned)?;
|
||||||
aligned: &mut [u8],
|
|
||||||
magic: u8,
|
|
||||||
state_flash: &mut F,
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
self.state.read_blocking(state_flash, 0, aligned)?;
|
|
||||||
|
|
||||||
if aligned.iter().any(|&b| b != magic) {
|
if aligned.iter().any(|&b| b != magic) {
|
||||||
// Read progress validity
|
// Read progress validity
|
||||||
self.state.read_blocking(state_flash, F::WRITE_SIZE as u32, aligned)?;
|
self.state.read(STATE::WRITE_SIZE as u32, aligned)?;
|
||||||
|
|
||||||
// FIXME: Do not make this assumption.
|
|
||||||
const STATE_ERASE_VALUE: u8 = 0xFF;
|
|
||||||
|
|
||||||
if aligned.iter().any(|&b| b != STATE_ERASE_VALUE) {
|
if aligned.iter().any(|&b| b != STATE_ERASE_VALUE) {
|
||||||
// The current progress validity marker is invalid
|
// The current progress validity marker is invalid
|
||||||
} else {
|
} else {
|
||||||
// Invalidate progress
|
// Invalidate progress
|
||||||
aligned.fill(!STATE_ERASE_VALUE);
|
aligned.fill(!STATE_ERASE_VALUE);
|
||||||
self.state.write_blocking(state_flash, F::WRITE_SIZE as u32, aligned)?;
|
self.state.write(STATE::WRITE_SIZE as u32, aligned)?;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Clear magic and progress
|
// Clear magic and progress
|
||||||
self.state.wipe_blocking(state_flash)?;
|
self.state.erase(0, self.state.capacity() as u32)?;
|
||||||
|
|
||||||
// Set magic
|
// Set magic
|
||||||
aligned.fill(magic);
|
aligned.fill(magic);
|
||||||
self.state.write_blocking(state_flash, 0, aligned)?;
|
self.state.write(0, aligned)?;
|
||||||
}
|
}
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
@ -192,18 +219,12 @@ impl FirmwareUpdater {
|
|||||||
/// # Safety
|
/// # Safety
|
||||||
///
|
///
|
||||||
/// Failing to meet alignment and size requirements may result in a panic.
|
/// Failing to meet alignment and size requirements may result in a panic.
|
||||||
pub fn write_firmware_blocking<F: NorFlash>(
|
pub fn write_firmware(&mut self, offset: usize, data: &[u8]) -> Result<(), FirmwareUpdaterError> {
|
||||||
&mut self,
|
assert!(data.len() >= DFU::ERASE_SIZE);
|
||||||
offset: usize,
|
|
||||||
data: &[u8],
|
|
||||||
dfu_flash: &mut F,
|
|
||||||
) -> Result<(), FirmwareUpdaterError> {
|
|
||||||
assert!(data.len() >= F::ERASE_SIZE);
|
|
||||||
|
|
||||||
self.dfu
|
self.dfu.erase(offset as u32, (offset + data.len()) as u32)?;
|
||||||
.erase_blocking(dfu_flash, offset as u32, (offset + data.len()) as u32)?;
|
|
||||||
|
|
||||||
self.dfu.write_blocking(dfu_flash, offset as u32, data)?;
|
self.dfu.write(offset as u32, data)?;
|
||||||
|
|
||||||
Ok(())
|
Ok(())
|
||||||
}
|
}
|
||||||
@ -211,11 +232,45 @@ impl FirmwareUpdater {
|
|||||||
/// Prepare for an incoming DFU update by erasing the entire DFU area and
|
/// Prepare for an incoming DFU update by erasing the entire DFU area and
|
||||||
/// returning its `Partition`.
|
/// returning its `Partition`.
|
||||||
///
|
///
|
||||||
/// Using this instead of `write_firmware_blocking` allows for an optimized
|
/// Using this instead of `write_firmware` allows for an optimized API in
|
||||||
/// API in exchange for added complexity.
|
/// exchange for added complexity.
|
||||||
pub fn prepare_update_blocking<F: NorFlash>(&mut self, flash: &mut F) -> Result<Partition, FirmwareUpdaterError> {
|
pub fn prepare_update(&mut self) -> Result<&mut DFU, FirmwareUpdaterError> {
|
||||||
self.dfu.wipe_blocking(flash)?;
|
self.dfu.erase(0, self.dfu.capacity() as u32)?;
|
||||||
|
|
||||||
Ok(self.dfu)
|
Ok(&mut self.dfu)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use core::cell::RefCell;
|
||||||
|
|
||||||
|
use embassy_embedded_hal::flash::partition::BlockingPartition;
|
||||||
|
use embassy_sync::blocking_mutex::raw::NoopRawMutex;
|
||||||
|
use embassy_sync::blocking_mutex::Mutex;
|
||||||
|
use sha1::{Digest, Sha1};
|
||||||
|
|
||||||
|
use super::*;
|
||||||
|
use crate::mem_flash::MemFlash;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn can_verify_sha1() {
|
||||||
|
let flash = Mutex::<NoopRawMutex, _>::new(RefCell::new(MemFlash::<131072, 4096, 8>::default()));
|
||||||
|
let state = BlockingPartition::new(&flash, 0, 4096);
|
||||||
|
let dfu = BlockingPartition::new(&flash, 65536, 65536);
|
||||||
|
|
||||||
|
let update = [0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66];
|
||||||
|
let mut to_write = [0; 4096];
|
||||||
|
to_write[..7].copy_from_slice(update.as_slice());
|
||||||
|
|
||||||
|
let mut updater = BlockingFirmwareUpdater::new(FirmwareUpdaterConfig { dfu, state });
|
||||||
|
updater.write_firmware(0, to_write.as_slice()).unwrap();
|
||||||
|
let mut chunk_buf = [0; 2];
|
||||||
|
let mut hash = [0; 20];
|
||||||
|
updater
|
||||||
|
.hash::<Sha1>(update.len() as u32, &mut chunk_buf, &mut hash)
|
||||||
|
.unwrap();
|
||||||
|
|
||||||
|
assert_eq!(Sha1::digest(update).as_slice(), hash);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -2,9 +2,22 @@
|
|||||||
mod asynch;
|
mod asynch;
|
||||||
mod blocking;
|
mod blocking;
|
||||||
|
|
||||||
|
#[cfg(feature = "nightly")]
|
||||||
|
pub use asynch::FirmwareUpdater;
|
||||||
|
pub use blocking::BlockingFirmwareUpdater;
|
||||||
use embedded_storage::nor_flash::{NorFlashError, NorFlashErrorKind};
|
use embedded_storage::nor_flash::{NorFlashError, NorFlashErrorKind};
|
||||||
|
|
||||||
use crate::Partition;
|
/// Firmware updater flash configuration holding the two flashes used by the updater
|
||||||
|
///
|
||||||
|
/// If only a single flash is actually used, then that flash should be partitioned into two partitions before use.
|
||||||
|
/// The easiest way to do this is to use [`FirmwareUpdaterConfig::from_linkerfile`] or [`FirmwareUpdaterConfig::from_linkerfile_blocking`] which will partition
|
||||||
|
/// the provided flash according to symbols defined in the linkerfile.
|
||||||
|
pub struct FirmwareUpdaterConfig<DFU, STATE> {
|
||||||
|
/// The dfu flash partition
|
||||||
|
pub dfu: DFU,
|
||||||
|
/// The state flash partition
|
||||||
|
pub state: STATE,
|
||||||
|
}
|
||||||
|
|
||||||
/// Errors returned by FirmwareUpdater
|
/// Errors returned by FirmwareUpdater
|
||||||
#[derive(Debug)]
|
#[derive(Debug)]
|
||||||
@ -33,39 +46,3 @@ where
|
|||||||
FirmwareUpdaterError::Flash(error.kind())
|
FirmwareUpdaterError::Flash(error.kind())
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/// FirmwareUpdater is an application API for interacting with the BootLoader without the ability to
|
|
||||||
/// 'mess up' the internal bootloader state
|
|
||||||
pub struct FirmwareUpdater {
|
|
||||||
state: Partition,
|
|
||||||
dfu: Partition,
|
|
||||||
}
|
|
||||||
|
|
||||||
#[cfg(target_os = "none")]
|
|
||||||
impl Default for FirmwareUpdater {
|
|
||||||
fn default() -> Self {
|
|
||||||
extern "C" {
|
|
||||||
static __bootloader_state_start: u32;
|
|
||||||
static __bootloader_state_end: u32;
|
|
||||||
static __bootloader_dfu_start: u32;
|
|
||||||
static __bootloader_dfu_end: u32;
|
|
||||||
}
|
|
||||||
|
|
||||||
let dfu = unsafe {
|
|
||||||
Partition::new(
|
|
||||||
&__bootloader_dfu_start as *const u32 as u32,
|
|
||||||
&__bootloader_dfu_end as *const u32 as u32,
|
|
||||||
)
|
|
||||||
};
|
|
||||||
let state = unsafe {
|
|
||||||
Partition::new(
|
|
||||||
&__bootloader_state_start as *const u32 as u32,
|
|
||||||
&__bootloader_state_end as *const u32 as u32,
|
|
||||||
)
|
|
||||||
};
|
|
||||||
|
|
||||||
trace!("DFU: 0x{:x} - 0x{:x}", dfu.from, dfu.to);
|
|
||||||
trace!("STATE: 0x{:x} - 0x{:x}", state.from, state.to);
|
|
||||||
FirmwareUpdater::new(dfu, state)
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
@ -11,8 +11,10 @@ mod mem_flash;
|
|||||||
mod partition;
|
mod partition;
|
||||||
|
|
||||||
pub use boot_loader::{BootError, BootFlash, BootLoader, FlashConfig, MultiFlashConfig, SingleFlashConfig};
|
pub use boot_loader::{BootError, BootFlash, BootLoader, FlashConfig, MultiFlashConfig, SingleFlashConfig};
|
||||||
pub use firmware_updater::{FirmwareUpdater, FirmwareUpdaterError};
|
|
||||||
pub use partition::Partition;
|
pub use partition::Partition;
|
||||||
|
#[cfg(feature = "nightly")]
|
||||||
|
pub use firmware_updater::FirmwareUpdater;
|
||||||
|
pub use firmware_updater::{BlockingFirmwareUpdater, FirmwareUpdaterConfig, FirmwareUpdaterError};
|
||||||
|
|
||||||
pub(crate) const BOOT_MAGIC: u8 = 0xD0;
|
pub(crate) const BOOT_MAGIC: u8 = 0xD0;
|
||||||
pub(crate) const SWAP_MAGIC: u8 = 0xF0;
|
pub(crate) const SWAP_MAGIC: u8 = 0xF0;
|
||||||
|
Loading…
Reference in New Issue
Block a user