| #[macro_use] extern crate log; |
| extern crate ring; |
| extern crate env_logger; |
| extern crate docopt; |
| extern crate libc; |
| extern crate pem; |
| extern crate rand; |
| #[macro_use] extern crate serde_derive; |
| extern crate serde; |
| extern crate simflash; |
| extern crate untrusted; |
| extern crate mcuboot_sys; |
| |
| use docopt::Docopt; |
| use rand::{Rng, SeedableRng, XorShiftRng}; |
| use rand::distributions::{IndependentSample, Range}; |
| use std::fmt; |
| use std::mem; |
| use std::process; |
| use std::slice; |
| |
| mod caps; |
| mod tlv; |
| pub mod testlog; |
| |
| use simflash::{Flash, SimFlash}; |
| use mcuboot_sys::{c, AreaDesc, FlashId}; |
| use caps::Caps; |
| use tlv::TlvGen; |
| |
| const USAGE: &'static str = " |
| Mcuboot simulator |
| |
| Usage: |
| bootsim sizes |
| bootsim run --device TYPE [--align SIZE] |
| bootsim runall |
| bootsim (--help | --version) |
| |
| Options: |
| -h, --help Show this message |
| --version Version |
| --device TYPE MCU to simulate |
| Valid values: stm32f4, k64f |
| --align SIZE Flash write alignment |
| "; |
| |
| #[derive(Debug, Deserialize)] |
| struct Args { |
| flag_help: bool, |
| flag_version: bool, |
| flag_device: Option<DeviceName>, |
| flag_align: Option<AlignArg>, |
| cmd_sizes: bool, |
| cmd_run: bool, |
| cmd_runall: bool, |
| } |
| |
| #[derive(Copy, Clone, Debug, Deserialize)] |
| pub enum DeviceName { Stm32f4, K64f, K64fBig, Nrf52840 } |
| |
| pub static ALL_DEVICES: &'static [DeviceName] = &[ |
| DeviceName::Stm32f4, |
| DeviceName::K64f, |
| DeviceName::K64fBig, |
| DeviceName::Nrf52840, |
| ]; |
| |
| impl fmt::Display for DeviceName { |
| fn fmt(&self, f: &mut fmt::Formatter) -> fmt::Result { |
| let name = match *self { |
| DeviceName::Stm32f4 => "stm32f4", |
| DeviceName::K64f => "k64f", |
| DeviceName::K64fBig => "k64fbig", |
| DeviceName::Nrf52840 => "nrf52840", |
| }; |
| f.write_str(name) |
| } |
| } |
| |
| #[derive(Debug)] |
| struct AlignArg(u8); |
| |
| struct AlignArgVisitor; |
| |
| impl<'de> serde::de::Visitor<'de> for AlignArgVisitor { |
| type Value = AlignArg; |
| |
| fn expecting(&self, formatter: &mut fmt::Formatter) -> fmt::Result { |
| formatter.write_str("1, 2, 4 or 8") |
| } |
| |
| fn visit_u8<E>(self, n: u8) -> Result<Self::Value, E> |
| where E: serde::de::Error |
| { |
| Ok(match n { |
| 1 | 2 | 4 | 8 => AlignArg(n), |
| n => { |
| let err = format!("Could not deserialize '{}' as alignment", n); |
| return Err(E::custom(err)); |
| } |
| }) |
| } |
| } |
| |
| impl<'de> serde::de::Deserialize<'de> for AlignArg { |
| fn deserialize<D>(d: D) -> Result<AlignArg, D::Error> |
| where D: serde::de::Deserializer<'de> |
| { |
| d.deserialize_u8(AlignArgVisitor) |
| } |
| } |
| |
| pub fn main() { |
| let args: Args = Docopt::new(USAGE) |
| .and_then(|d| d.deserialize()) |
| .unwrap_or_else(|e| e.exit()); |
| // println!("args: {:#?}", args); |
| |
| if args.cmd_sizes { |
| show_sizes(); |
| return; |
| } |
| |
| let mut status = RunStatus::new(); |
| if args.cmd_run { |
| |
| let align = args.flag_align.map(|x| x.0).unwrap_or(1); |
| |
| |
| let device = match args.flag_device { |
| None => panic!("Missing mandatory device argument"), |
| Some(dev) => dev, |
| }; |
| |
| status.run_single(device, align, 0xff); |
| } |
| |
| if args.cmd_runall { |
| for &dev in ALL_DEVICES { |
| for &align in &[1, 2, 4, 8] { |
| for &erased_val in &[0, 0xff] { |
| status.run_single(dev, align, erased_val); |
| } |
| } |
| } |
| } |
| |
| if status.failures > 0 { |
| error!("{} Tests ran with {} failures", status.failures + status.passes, status.failures); |
| process::exit(1); |
| } else { |
| error!("{} Tests ran successfully", status.passes); |
| process::exit(0); |
| } |
| } |
| |
| /// A test run, intended to be run from "cargo test", so panics on failure. |
| pub struct Run { |
| flash: SimFlash, |
| areadesc: AreaDesc, |
| slots: [SlotInfo; 2], |
| align: u8, |
| erased_val: u8, |
| } |
| |
| impl Run { |
| pub fn new(device: DeviceName, align: u8, erased_val: u8) -> Run { |
| let (flash, areadesc) = make_device(device, align, erased_val); |
| |
| let (slot0_base, slot0_len) = areadesc.find(FlashId::Image0); |
| let (slot1_base, slot1_len) = areadesc.find(FlashId::Image1); |
| let (scratch_base, _) = areadesc.find(FlashId::ImageScratch); |
| |
| // The code assumes that the slots are consecutive. |
| assert_eq!(slot1_base, slot0_base + slot0_len); |
| assert_eq!(scratch_base, slot1_base + slot1_len); |
| |
| // NOTE: not accounting "swap_size" because it is not used by sim... |
| let offset_from_end = c::boot_magic_sz() + c::boot_max_align() * 2; |
| |
| // Construct a primary image. |
| let slot0 = SlotInfo { |
| base_off: slot0_base as usize, |
| trailer_off: slot1_base - offset_from_end, |
| }; |
| |
| // And an upgrade image. |
| let slot1 = SlotInfo { |
| base_off: slot1_base as usize, |
| trailer_off: scratch_base - offset_from_end, |
| }; |
| |
| Run { |
| flash: flash, |
| areadesc: areadesc, |
| slots: [slot0, slot1], |
| align: align, |
| erased_val: erased_val, |
| } |
| } |
| |
| pub fn each_device<F>(f: F) |
| where F: Fn(&mut Run) |
| { |
| for &dev in ALL_DEVICES { |
| for &align in &[1, 2, 4, 8] { |
| for &erased_val in &[0, 0xff] { |
| let mut run = Run::new(dev, align, erased_val); |
| f(&mut run); |
| } |
| } |
| } |
| } |
| |
| /// Construct an `Images` that doesn't expect an upgrade to happen. |
| pub fn make_no_upgrade_image(&self) -> Images { |
| let mut flash = self.flash.clone(); |
| let primary = install_image(&mut flash, self.slots[0].base_off, 32784, false); |
| let upgrade = install_image(&mut flash, self.slots[1].base_off, 41928, false); |
| Images { |
| flash: flash, |
| areadesc: self.areadesc.clone(), |
| slot0: self.slots[0].clone(), |
| slot1: self.slots[1].clone(), |
| primary: primary, |
| upgrade: upgrade, |
| total_count: None, |
| align: self.align, |
| erased_val: self.erased_val, |
| } |
| } |
| |
| /// Construct an `Images` for normal testing. |
| pub fn make_image(&self) -> Images { |
| let mut images = self.make_no_upgrade_image(); |
| mark_upgrade(&mut images.flash, &images.slot1); |
| |
| // upgrades without fails, counts number of flash operations |
| let total_count = match images.run_basic_upgrade() { |
| Ok(v) => v, |
| Err(_) => { |
| panic!("Unable to perform basic upgrade"); |
| }, |
| }; |
| |
| images.total_count = Some(total_count); |
| images |
| } |
| |
| pub fn make_bad_slot1_image(&self) -> Images { |
| let mut bad_flash = self.flash.clone(); |
| let primary = install_image(&mut bad_flash, self.slots[0].base_off, 32784, false); |
| let upgrade = install_image(&mut bad_flash, self.slots[1].base_off, 41928, true); |
| Images { |
| flash: bad_flash, |
| areadesc: self.areadesc.clone(), |
| slot0: self.slots[0].clone(), |
| slot1: self.slots[1].clone(), |
| primary: primary, |
| upgrade: upgrade, |
| total_count: None, |
| align: self.align, |
| erased_val: self.erased_val, |
| } |
| } |
| |
| } |
| |
| pub struct RunStatus { |
| failures: usize, |
| passes: usize, |
| } |
| |
| impl RunStatus { |
| pub fn new() -> RunStatus { |
| RunStatus { |
| failures: 0, |
| passes: 0, |
| } |
| } |
| |
| pub fn run_single(&mut self, device: DeviceName, align: u8, erased_val: u8) { |
| warn!("Running on device {} with alignment {}", device, align); |
| |
| let run = Run::new(device, align, erased_val); |
| |
| let mut failed = false; |
| |
| // Creates a badly signed image in slot1 to check that it is not |
| // upgraded to |
| let bad_slot1_image = run.make_bad_slot1_image(); |
| |
| failed |= bad_slot1_image.run_signfail_upgrade(); |
| |
| let images = run.make_no_upgrade_image(); |
| failed |= images.run_norevert_newimage(); |
| |
| let images = run.make_image(); |
| |
| failed |= images.run_basic_revert(); |
| failed |= images.run_revert_with_fails(); |
| failed |= images.run_perm_with_fails(); |
| failed |= images.run_perm_with_random_fails(5); |
| failed |= images.run_norevert(); |
| |
| failed |= images.run_with_status_fails_complete(); |
| failed |= images.run_with_status_fails_with_reset(); |
| |
| //show_flash(&flash); |
| |
| if failed { |
| self.failures += 1; |
| } else { |
| self.passes += 1; |
| } |
| } |
| |
| pub fn failures(&self) -> usize { |
| self.failures |
| } |
| } |
| |
| /// Build the Flash and area descriptor for a given device. |
| pub fn make_device(device: DeviceName, align: u8, erased_val: u8) -> (SimFlash, AreaDesc) { |
| match device { |
| DeviceName::Stm32f4 => { |
| // STM style flash. Large sectors, with a large scratch area. |
| let flash = SimFlash::new(vec![16 * 1024, 16 * 1024, 16 * 1024, 16 * 1024, |
| 64 * 1024, |
| 128 * 1024, 128 * 1024, 128 * 1024], |
| align as usize, erased_val); |
| let mut areadesc = AreaDesc::new(&flash); |
| areadesc.add_image(0x020000, 0x020000, FlashId::Image0); |
| areadesc.add_image(0x040000, 0x020000, FlashId::Image1); |
| areadesc.add_image(0x060000, 0x020000, FlashId::ImageScratch); |
| (flash, areadesc) |
| } |
| DeviceName::K64f => { |
| // NXP style flash. Small sectors, one small sector for scratch. |
| let flash = SimFlash::new(vec![4096; 128], align as usize, erased_val); |
| |
| let mut areadesc = AreaDesc::new(&flash); |
| areadesc.add_image(0x020000, 0x020000, FlashId::Image0); |
| areadesc.add_image(0x040000, 0x020000, FlashId::Image1); |
| areadesc.add_image(0x060000, 0x001000, FlashId::ImageScratch); |
| (flash, areadesc) |
| } |
| DeviceName::K64fBig => { |
| // Simulating an STM style flash on top of an NXP style flash. Underlying flash device |
| // uses small sectors, but we tell the bootloader they are large. |
| let flash = SimFlash::new(vec![4096; 128], align as usize, erased_val); |
| |
| let mut areadesc = AreaDesc::new(&flash); |
| areadesc.add_simple_image(0x020000, 0x020000, FlashId::Image0); |
| areadesc.add_simple_image(0x040000, 0x020000, FlashId::Image1); |
| areadesc.add_simple_image(0x060000, 0x020000, FlashId::ImageScratch); |
| (flash, areadesc) |
| } |
| DeviceName::Nrf52840 => { |
| // Simulating the flash on the nrf52840 with partitions set up so that the scratch size |
| // does not divide into the image size. |
| let flash = SimFlash::new(vec![4096; 128], align as usize, erased_val); |
| |
| let mut areadesc = AreaDesc::new(&flash); |
| areadesc.add_image(0x008000, 0x034000, FlashId::Image0); |
| areadesc.add_image(0x03c000, 0x034000, FlashId::Image1); |
| areadesc.add_image(0x070000, 0x00d000, FlashId::ImageScratch); |
| (flash, areadesc) |
| } |
| } |
| } |
| |
| impl Images { |
| /// A simple upgrade without forced failures. |
| /// |
| /// Returns the number of flash operations which can later be used to |
| /// inject failures at chosen steps. |
| pub fn run_basic_upgrade(&self) -> Result<i32, ()> { |
| let (fl, total_count) = try_upgrade(&self.flash, &self, None); |
| info!("Total flash operation count={}", total_count); |
| |
| if !verify_image(&fl, self.slot0.base_off, &self.upgrade) { |
| warn!("Image mismatch after first boot"); |
| Err(()) |
| } else { |
| Ok(total_count) |
| } |
| } |
| |
| #[cfg(feature = "overwrite-only")] |
| pub fn run_basic_revert(&self) -> bool { |
| false |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| pub fn run_basic_revert(&self) -> bool { |
| let mut fails = 0; |
| |
| // FIXME: this test would also pass if no swap is ever performed??? |
| if Caps::SwapUpgrade.present() { |
| for count in 2 .. 5 { |
| info!("Try revert: {}", count); |
| let fl = try_revert(&self.flash, &self.areadesc, count, self.align); |
| if !verify_image(&fl, self.slot0.base_off, &self.primary) { |
| error!("Revert failure on count {}", count); |
| fails += 1; |
| } |
| } |
| } |
| |
| fails > 0 |
| } |
| |
| pub fn run_perm_with_fails(&self) -> bool { |
| let mut fails = 0; |
| let total_flash_ops = self.total_count.unwrap(); |
| |
| // Let's try an image halfway through. |
| for i in 1 .. total_flash_ops { |
| info!("Try interruption at {}", i); |
| let (fl, count) = try_upgrade(&self.flash, &self, Some(i)); |
| info!("Second boot, count={}", count); |
| if !verify_image(&fl, self.slot0.base_off, &self.upgrade) { |
| warn!("FAIL at step {} of {}", i, total_flash_ops); |
| fails += 1; |
| } |
| |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| |
| if !verify_trailer(&fl, self.slot1.trailer_off, BOOT_MAGIC_UNSET, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 1"); |
| fails += 1; |
| } |
| |
| if Caps::SwapUpgrade.present() { |
| if !verify_image(&fl, self.slot1.base_off, &self.primary) { |
| warn!("Slot 1 FAIL at step {} of {}", i, total_flash_ops); |
| fails += 1; |
| } |
| } |
| } |
| |
| if fails > 0 { |
| error!("{} out of {} failed {:.2}%", fails, total_flash_ops, |
| fails as f32 * 100.0 / total_flash_ops as f32); |
| } |
| |
| fails > 0 |
| } |
| |
| pub fn run_perm_with_random_fails_5(&self) -> bool { |
| self.run_perm_with_random_fails(5) |
| } |
| |
| fn run_perm_with_random_fails(&self, total_fails: usize) -> bool { |
| let mut fails = 0; |
| let total_flash_ops = self.total_count.unwrap(); |
| let (fl, total_counts) = try_random_fails(&self.flash, &self, |
| total_flash_ops, total_fails); |
| info!("Random interruptions at reset points={:?}", total_counts); |
| |
| let slot0_ok = verify_image(&fl, self.slot0.base_off, &self.upgrade); |
| let slot1_ok = if Caps::SwapUpgrade.present() { |
| verify_image(&fl, self.slot1.base_off, &self.primary) |
| } else { |
| true |
| }; |
| if !slot0_ok || !slot1_ok { |
| error!("Image mismatch after random interrupts: slot0={} slot1={}", |
| if slot0_ok { "ok" } else { "fail" }, |
| if slot1_ok { "ok" } else { "fail" }); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_SET) { |
| error!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot1.trailer_off, BOOT_MAGIC_UNSET, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| error!("Mismatched trailer for Slot 1"); |
| fails += 1; |
| } |
| |
| if fails > 0 { |
| error!("Error testing perm upgrade with {} fails", total_fails); |
| } |
| |
| fails > 0 |
| } |
| |
| #[cfg(feature = "overwrite-only")] |
| pub fn run_revert_with_fails(&self) -> bool { |
| false |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| pub fn run_revert_with_fails(&self) -> bool { |
| let mut fails = 0; |
| |
| if Caps::SwapUpgrade.present() { |
| for i in 1 .. (self.total_count.unwrap() - 1) { |
| info!("Try interruption at {}", i); |
| if try_revert_with_fail_at(&self.flash, &self, i) { |
| error!("Revert failed at interruption {}", i); |
| fails += 1; |
| } |
| } |
| } |
| |
| fails > 0 |
| } |
| |
| #[cfg(feature = "overwrite-only")] |
| pub fn run_norevert(&self) -> bool { |
| false |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| pub fn run_norevert(&self) -> bool { |
| let mut fl = self.flash.clone(); |
| let mut fails = 0; |
| |
| info!("Try norevert"); |
| |
| // First do a normal upgrade... |
| let (result, _) = c::boot_go(&mut fl, &self.areadesc, None, self.align, false); |
| if result != 0 { |
| warn!("Failed first boot"); |
| fails += 1; |
| } |
| |
| //FIXME: copy_done is written by boot_go, is it ok if no copy |
| // was ever done? |
| |
| if !verify_image(&fl, self.slot0.base_off, &self.upgrade) { |
| warn!("Slot 0 image verification FAIL"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_UNSET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot1.trailer_off, BOOT_MAGIC_UNSET, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 1"); |
| fails += 1; |
| } |
| |
| // Marks image in slot0 as permanent, no revert should happen... |
| mark_permanent_upgrade(&mut fl, &self.slot0, self.align, self.erased_val); |
| |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| |
| let (result, _) = c::boot_go(&mut fl, &self.areadesc, None, self.align, false); |
| if result != 0 { |
| warn!("Failed second boot"); |
| fails += 1; |
| } |
| |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| if !verify_image(&fl, self.slot0.base_off, &self.upgrade) { |
| warn!("Failed image verification"); |
| fails += 1; |
| } |
| |
| if fails > 0 { |
| error!("Error running upgrade without revert"); |
| } |
| |
| fails > 0 |
| } |
| |
| // Tests a new image written to slot0 that already has magic and image_ok set |
| // while there is no image on slot1, so no revert should ever happen... |
| pub fn run_norevert_newimage(&self) -> bool { |
| let mut fl = self.flash.clone(); |
| let mut fails = 0; |
| |
| info!("Try non-revert on imgtool generated image"); |
| |
| mark_upgrade(&mut fl, &self.slot0); |
| |
| // This simulates writing an image created by imgtool to Slot 0 |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| |
| // Run the bootloader... |
| let (result, _) = c::boot_go(&mut fl, &self.areadesc, None, self.align, false); |
| if result != 0 { |
| warn!("Failed first boot"); |
| fails += 1; |
| } |
| |
| // State should not have changed |
| if !verify_image(&fl, self.slot0.base_off, &self.primary) { |
| warn!("Failed image verification"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot1.trailer_off, BOOT_MAGIC_UNSET, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 1"); |
| fails += 1; |
| } |
| |
| if fails > 0 { |
| error!("Expected a non revert with new image"); |
| } |
| |
| fails > 0 |
| } |
| |
| // Tests a new image written to slot0 that already has magic and image_ok set |
| // while there is no image on slot1, so no revert should ever happen... |
| pub fn run_signfail_upgrade(&self) -> bool { |
| let mut fl = self.flash.clone(); |
| let mut fails = 0; |
| |
| info!("Try upgrade image with bad signature"); |
| |
| mark_upgrade(&mut fl, &self.slot0); |
| mark_permanent_upgrade(&mut fl, &self.slot0, self.align, self.erased_val); |
| mark_upgrade(&mut fl, &self.slot1); |
| |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| |
| // Run the bootloader... |
| let (result, _) = c::boot_go(&mut fl, &self.areadesc, None, self.align, false); |
| if result != 0 { |
| warn!("Failed first boot"); |
| fails += 1; |
| } |
| |
| // State should not have changed |
| if !verify_image(&fl, self.slot0.base_off, &self.primary) { |
| warn!("Failed image verification"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| |
| if fails > 0 { |
| error!("Expected an upgrade failure when image has bad signature"); |
| } |
| |
| fails > 0 |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| fn trailer_sz(&self) -> usize { |
| c::boot_trailer_sz(self.align) as usize |
| } |
| |
| // FIXME: could get status sz from bootloader |
| #[cfg(not(feature = "overwrite-only"))] |
| fn status_sz(&self) -> usize { |
| self.trailer_sz() - (16 + 24) |
| } |
| |
| /// This test runs a simple upgrade with no fails in the images, but |
| /// allowing for fails in the status area. This should run to the end |
| /// and warn that write fails were detected... |
| #[cfg(not(feature = "validate-slot0"))] |
| pub fn run_with_status_fails_complete(&self) -> bool { false } |
| |
| #[cfg(feature = "validate-slot0")] |
| pub fn run_with_status_fails_complete(&self) -> bool { |
| let mut fl = self.flash.clone(); |
| let mut fails = 0; |
| |
| info!("Try swap with status fails"); |
| |
| mark_permanent_upgrade(&mut fl, &self.slot1, self.align, self.erased_val); |
| |
| let status_off = self.slot1.base_off - self.trailer_sz(); |
| |
| // Always fail writes to status area... |
| let _ = fl.add_bad_region(status_off, self.status_sz(), 1.0); |
| |
| let (result, asserts) = c::boot_go(&mut fl, &self.areadesc, None, self.align, true); |
| if result != 0 { |
| warn!("Failed!"); |
| fails += 1; |
| } |
| |
| // Failed writes to the marked "bad" region don't assert anymore. |
| // Any detected assert() is happening in another part of the code. |
| if asserts != 0 { |
| warn!("At least one assert() was called"); |
| fails += 1; |
| } |
| |
| if !verify_trailer(&fl, self.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 0"); |
| fails += 1; |
| } |
| |
| if !verify_image(&fl, self.slot0.base_off, &self.upgrade) { |
| warn!("Failed image verification"); |
| fails += 1; |
| } |
| |
| info!("validate slot0 enabled; re-run of boot_go should just work"); |
| let (result, _) = c::boot_go(&mut fl, &self.areadesc, None, self.align, false); |
| if result != 0 { |
| warn!("Failed!"); |
| fails += 1; |
| } |
| |
| if fails > 0 { |
| error!("Error running upgrade with status write fails"); |
| } |
| |
| fails > 0 |
| } |
| |
| /// This test runs a simple upgrade with no fails in the images, but |
| /// allowing for fails in the status area. This should run to the end |
| /// and warn that write fails were detected... |
| #[cfg(feature = "validate-slot0")] |
| pub fn run_with_status_fails_with_reset(&self) -> bool { |
| let mut fl = self.flash.clone(); |
| let mut fails = 0; |
| let mut count = self.total_count.unwrap() / 2; |
| |
| //info!("count={}\n", count); |
| |
| info!("Try interrupted swap with status fails"); |
| |
| mark_permanent_upgrade(&mut fl, &self.slot1, self.align, self.erased_val); |
| |
| let status_off = self.slot1.base_off - self.trailer_sz(); |
| |
| // Mark the status area as a bad area |
| let _ = fl.add_bad_region(status_off, self.status_sz(), 0.5); |
| |
| // Should not fail, writing to bad regions does not assert |
| let (_, asserts) = c::boot_go(&mut fl, &self.areadesc, Some(&mut count), self.align, true); |
| if asserts != 0 { |
| warn!("At least one assert() was called"); |
| fails += 1; |
| } |
| |
| fl.reset_bad_regions(); |
| |
| // Disabling write verification the only assert triggered by |
| // boot_go should be checking for integrity of status bytes. |
| fl.set_verify_writes(false); |
| |
| info!("Resuming an interrupted swap operation"); |
| let (_, asserts) = c::boot_go(&mut fl, &self.areadesc, None, self.align, true); |
| |
| // This might throw no asserts, for large sector devices, where |
| // a single failure writing is indistinguishable from no failure, |
| // or throw a single assert for small sector devices that fail |
| // multiple times... |
| if asserts > 1 { |
| warn!("Expected single assert validating slot0, more detected {}", asserts); |
| fails += 1; |
| } |
| |
| if fails > 0 { |
| error!("Error running upgrade with status write fails"); |
| } |
| |
| fails > 0 |
| } |
| |
| #[cfg(not(feature = "validate-slot0"))] |
| #[cfg(not(feature = "overwrite-only"))] |
| pub fn run_with_status_fails_with_reset(&self) -> bool { |
| let mut fl = self.flash.clone(); |
| let mut fails = 0; |
| |
| info!("Try interrupted swap with status fails"); |
| |
| mark_permanent_upgrade(&mut fl, &self.slot1, self.align, self.erased_val); |
| |
| let status_off = self.slot1.base_off - self.trailer_sz(); |
| |
| // Mark the status area as a bad area |
| let _ = fl.add_bad_region(status_off, self.status_sz(), 1.0); |
| |
| // This is expected to fail while writing to bad regions... |
| let (_, asserts) = c::boot_go(&mut fl, &self.areadesc, None, self.align, true); |
| if asserts == 0 { |
| warn!("No assert() detected"); |
| fails += 1; |
| } |
| |
| fails > 0 |
| } |
| |
| #[cfg(feature = "overwrite-only")] |
| pub fn run_with_status_fails_with_reset(&self) -> bool { |
| false |
| } |
| } |
| |
| /// Test a boot, optionally stopping after 'n' flash options. Returns a count |
| /// of the number of flash operations done total. |
| fn try_upgrade(flash: &SimFlash, images: &Images, |
| stop: Option<i32>) -> (SimFlash, i32) { |
| // Clone the flash to have a new copy. |
| let mut fl = flash.clone(); |
| |
| mark_permanent_upgrade(&mut fl, &images.slot1, images.align, images.erased_val); |
| |
| let mut counter = stop.unwrap_or(0); |
| |
| let (first_interrupted, count) = match c::boot_go(&mut fl, &images.areadesc, Some(&mut counter), images.align, false) { |
| (-0x13579, _) => (true, stop.unwrap()), |
| (0, _) => (false, -counter), |
| (x, _) => panic!("Unknown return: {}", x), |
| }; |
| |
| counter = 0; |
| if first_interrupted { |
| // fl.dump(); |
| match c::boot_go(&mut fl, &images.areadesc, Some(&mut counter), images.align, false) { |
| (-0x13579, _) => panic!("Shouldn't stop again"), |
| (0, _) => (), |
| (x, _) => panic!("Unknown return: {}", x), |
| } |
| } |
| |
| (fl, count - counter) |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| fn try_revert(flash: &SimFlash, areadesc: &AreaDesc, count: usize, align: u8) -> SimFlash { |
| let mut fl = flash.clone(); |
| |
| // fl.write_file("image0.bin").unwrap(); |
| for i in 0 .. count { |
| info!("Running boot pass {}", i + 1); |
| assert_eq!(c::boot_go(&mut fl, &areadesc, None, align, false), (0, 0)); |
| } |
| fl |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| fn try_revert_with_fail_at(flash: &SimFlash, images: &Images, |
| stop: i32) -> bool { |
| let mut fl = flash.clone(); |
| let mut fails = 0; |
| |
| let mut counter = stop; |
| let (x, _) = c::boot_go(&mut fl, &images.areadesc, Some(&mut counter), images.align, false); |
| if x != -0x13579 { |
| warn!("Should have stopped at interruption point"); |
| fails += 1; |
| } |
| |
| if !verify_trailer(&fl, images.slot0.trailer_off, None, None, BOOT_FLAG_UNSET) { |
| warn!("copy_done should be unset"); |
| fails += 1; |
| } |
| |
| let (x, _) = c::boot_go(&mut fl, &images.areadesc, None, images.align, false); |
| if x != 0 { |
| warn!("Should have finished upgrade"); |
| fails += 1; |
| } |
| |
| if !verify_image(&fl, images.slot0.base_off, &images.upgrade) { |
| warn!("Image in slot 0 before revert is invalid at stop={}", stop); |
| fails += 1; |
| } |
| if !verify_image(&fl, images.slot1.base_off, &images.primary) { |
| warn!("Image in slot 1 before revert is invalid at stop={}", stop); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, images.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_UNSET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 0 before revert"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, images.slot1.trailer_off, BOOT_MAGIC_UNSET, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 1 before revert"); |
| fails += 1; |
| } |
| |
| // Do Revert |
| let (x, _) = c::boot_go(&mut fl, &images.areadesc, None, images.align, false); |
| if x != 0 { |
| warn!("Should have finished a revert"); |
| fails += 1; |
| } |
| |
| if !verify_image(&fl, images.slot0.base_off, &images.primary) { |
| warn!("Image in slot 0 after revert is invalid at stop={}", stop); |
| fails += 1; |
| } |
| if !verify_image(&fl, images.slot1.base_off, &images.upgrade) { |
| warn!("Image in slot 1 after revert is invalid at stop={}", stop); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, images.slot0.trailer_off, BOOT_MAGIC_GOOD, |
| BOOT_FLAG_SET, BOOT_FLAG_SET) { |
| warn!("Mismatched trailer for Slot 1 after revert"); |
| fails += 1; |
| } |
| if !verify_trailer(&fl, images.slot1.trailer_off, BOOT_MAGIC_UNSET, |
| BOOT_FLAG_UNSET, BOOT_FLAG_UNSET) { |
| warn!("Mismatched trailer for Slot 1 after revert"); |
| fails += 1; |
| } |
| |
| fails > 0 |
| } |
| |
| fn try_random_fails(flash: &SimFlash, images: &Images, |
| total_ops: i32, count: usize) -> (SimFlash, Vec<i32>) { |
| let mut fl = flash.clone(); |
| |
| mark_permanent_upgrade(&mut fl, &images.slot1, images.align, images.erased_val); |
| |
| let mut rng = rand::thread_rng(); |
| let mut resets = vec![0i32; count]; |
| let mut remaining_ops = total_ops; |
| for i in 0 .. count { |
| let ops = Range::new(1, remaining_ops / 2); |
| let reset_counter = ops.ind_sample(&mut rng); |
| let mut counter = reset_counter; |
| match c::boot_go(&mut fl, &images.areadesc, Some(&mut counter), images.align, false) { |
| (0, _) | (-0x13579, _) => (), |
| (x, _) => panic!("Unknown return: {}", x), |
| } |
| remaining_ops -= reset_counter; |
| resets[i] = reset_counter; |
| } |
| |
| match c::boot_go(&mut fl, &images.areadesc, None, images.align, false) { |
| (-0x13579, _) => panic!("Should not be have been interrupted!"), |
| (0, _) => (), |
| (x, _) => panic!("Unknown return: {}", x), |
| } |
| |
| (fl, resets) |
| } |
| |
| /// Show the flash layout. |
| #[allow(dead_code)] |
| fn show_flash(flash: &Flash) { |
| println!("---- Flash configuration ----"); |
| for sector in flash.sector_iter() { |
| println!(" {:3}: 0x{:08x}, 0x{:08x}", |
| sector.num, sector.base, sector.size); |
| } |
| println!(""); |
| } |
| |
| /// Install a "program" into the given image. This fakes the image header, or at least all of the |
| /// fields used by the given code. Returns a copy of the image that was written. |
| fn install_image(flash: &mut Flash, offset: usize, len: usize, |
| bad_sig: bool) -> Vec<u8> { |
| let offset0 = offset; |
| |
| let mut tlv = make_tlv(); |
| |
| // Generate a boot header. Note that the size doesn't include the header. |
| let header = ImageHeader { |
| magic: 0x96f3b83d, |
| tlv_size: tlv.get_size(), |
| _pad1: 0, |
| hdr_size: 32, |
| key_id: 0, |
| _pad2: 0, |
| img_size: len as u32, |
| flags: tlv.get_flags(), |
| ver: ImageVersion { |
| major: (offset / (128 * 1024)) as u8, |
| minor: 0, |
| revision: 1, |
| build_num: offset as u32, |
| }, |
| _pad3: 0, |
| }; |
| |
| let b_header = header.as_raw(); |
| tlv.add_bytes(&b_header); |
| /* |
| let b_header = unsafe { slice::from_raw_parts(&header as *const _ as *const u8, |
| mem::size_of::<ImageHeader>()) }; |
| */ |
| assert_eq!(b_header.len(), 32); |
| flash.write(offset, &b_header).unwrap(); |
| let offset = offset + b_header.len(); |
| |
| // The core of the image itself is just pseudorandom data. |
| let mut buf = vec![0; len]; |
| splat(&mut buf, offset); |
| tlv.add_bytes(&buf); |
| |
| // Get and append the TLV itself. |
| if bad_sig { |
| let good_sig = &mut tlv.make_tlv(); |
| buf.append(&mut vec![0; good_sig.len()]); |
| } else { |
| buf.append(&mut tlv.make_tlv()); |
| } |
| |
| // Pad the block to a flash alignment (8 bytes). |
| while buf.len() % 8 != 0 { |
| buf.push(0xFF); |
| } |
| |
| flash.write(offset, &buf).unwrap(); |
| let offset = offset + buf.len(); |
| |
| // Copy out the image so that we can verify that the image was installed correctly later. |
| let mut copy = vec![0u8; offset - offset0]; |
| flash.read(offset0, &mut copy).unwrap(); |
| |
| copy |
| } |
| |
| // The TLV in use depends on what kind of signature we are verifying. |
| #[cfg(feature = "sig-rsa")] |
| fn make_tlv() -> TlvGen { |
| TlvGen::new_rsa_pss() |
| } |
| |
| #[cfg(feature = "sig-ecdsa")] |
| fn make_tlv() -> TlvGen { |
| TlvGen::new_ecdsa() |
| } |
| |
| #[cfg(not(feature = "sig-rsa"))] |
| #[cfg(not(feature = "sig-ecdsa"))] |
| fn make_tlv() -> TlvGen { |
| TlvGen::new_hash_only() |
| } |
| |
| /// Verify that given image is present in the flash at the given offset. |
| fn verify_image(flash: &Flash, offset: usize, buf: &[u8]) -> bool { |
| let mut copy = vec![0u8; buf.len()]; |
| flash.read(offset, &mut copy).unwrap(); |
| |
| if buf != ©[..] { |
| for i in 0 .. buf.len() { |
| if buf[i] != copy[i] { |
| info!("First failure at {:#x}", offset + i); |
| break; |
| } |
| } |
| false |
| } else { |
| true |
| } |
| } |
| |
| #[cfg(feature = "overwrite-only")] |
| #[allow(unused_variables)] |
| // overwrite-only doesn't employ trailer management |
| fn verify_trailer(flash: &Flash, offset: usize, |
| magic: Option<u8>, image_ok: Option<u8>, |
| copy_done: Option<u8>) -> bool { |
| true |
| } |
| |
| #[cfg(not(feature = "overwrite-only"))] |
| fn verify_trailer(flash: &Flash, offset: usize, |
| magic: Option<u8>, image_ok: Option<u8>, |
| copy_done: Option<u8>) -> bool { |
| let mut copy = vec![0u8; c::boot_magic_sz() + c::boot_max_align() * 2]; |
| let mut failed = false; |
| let erased_val = flash.erased_val(); |
| |
| flash.read(offset, &mut copy).unwrap(); |
| |
| failed |= match magic { |
| Some(v) => { |
| if v == 1 && ©[16..] != MAGIC.unwrap() { |
| warn!("\"magic\" mismatch at {:#x}", offset); |
| true |
| } else if v == 3 { |
| let expected = [erased_val; 16]; |
| if ©[16..] != expected { |
| warn!("\"magic\" mismatch at {:#x}", offset); |
| true |
| } else { |
| false |
| } |
| } else { |
| false |
| } |
| }, |
| None => false, |
| }; |
| |
| failed |= match image_ok { |
| Some(v) => { |
| if (v == 1 && copy[8] != v) || (v == 3 && copy[8] != erased_val) { |
| warn!("\"image_ok\" mismatch at {:#x} v={} val={:#x}", offset, v, copy[8]); |
| true |
| } else { |
| false |
| } |
| }, |
| None => false, |
| }; |
| |
| failed |= match copy_done { |
| Some(v) => { |
| if (v == 1 && copy[0] != v) || (v == 3 && copy[0] != erased_val) { |
| warn!("\"copy_done\" mismatch at {:#x} v={} val={:#x}", offset, v, copy[0]); |
| true |
| } else { |
| false |
| } |
| }, |
| None => false, |
| }; |
| |
| !failed |
| } |
| |
| /// The image header |
| #[repr(C)] |
| pub struct ImageHeader { |
| magic: u32, |
| tlv_size: u16, |
| key_id: u8, |
| _pad1: u8, |
| hdr_size: u16, |
| _pad2: u16, |
| img_size: u32, |
| flags: u32, |
| ver: ImageVersion, |
| _pad3: u32, |
| } |
| |
| impl AsRaw for ImageHeader {} |
| |
| #[repr(C)] |
| pub struct ImageVersion { |
| major: u8, |
| minor: u8, |
| revision: u16, |
| build_num: u32, |
| } |
| |
| #[derive(Clone)] |
| struct SlotInfo { |
| base_off: usize, |
| trailer_off: usize, |
| } |
| |
| pub struct Images { |
| flash: SimFlash, |
| areadesc: AreaDesc, |
| slot0: SlotInfo, |
| slot1: SlotInfo, |
| primary: Vec<u8>, |
| upgrade: Vec<u8>, |
| total_count: Option<i32>, |
| align: u8, |
| erased_val: u8, |
| } |
| |
| const MAGIC: Option<&[u8]> = Some(&[0x77, 0xc2, 0x95, 0xf3, |
| 0x60, 0xd2, 0xef, 0x7f, |
| 0x35, 0x52, 0x50, 0x0f, |
| 0x2c, 0xb6, 0x79, 0x80]); |
| |
| // Replicates defines found in bootutil.h |
| const BOOT_MAGIC_GOOD: Option<u8> = Some(1); |
| const BOOT_MAGIC_UNSET: Option<u8> = Some(3); |
| |
| const BOOT_FLAG_SET: Option<u8> = Some(1); |
| const BOOT_FLAG_UNSET: Option<u8> = Some(3); |
| |
| /// Write out the magic so that the loader tries doing an upgrade. |
| fn mark_upgrade(flash: &mut Flash, slot: &SlotInfo) { |
| let offset = slot.trailer_off + c::boot_max_align() * 2; |
| flash.write(offset, MAGIC.unwrap()).unwrap(); |
| } |
| |
| /// Writes the image_ok flag which, guess what, tells the bootloader |
| /// the this image is ok (not a test, and no revert is to be performed). |
| fn mark_permanent_upgrade(flash: &mut Flash, slot: &SlotInfo, align: u8, erased_val: u8) { |
| let mut ok = [erased_val; 8]; |
| ok[0] = 1u8; |
| let off = slot.trailer_off + c::boot_max_align(); |
| flash.write(off, &ok[..align as usize]).unwrap(); |
| } |
| |
| // Drop some pseudo-random gibberish onto the data. |
| fn splat(data: &mut [u8], seed: usize) { |
| let seed_block = [0x135782ea, 0x92184728, data.len() as u32, seed as u32]; |
| let mut rng: XorShiftRng = SeedableRng::from_seed(seed_block); |
| rng.fill_bytes(data); |
| } |
| |
| /// Return a read-only view into the raw bytes of this object |
| trait AsRaw : Sized { |
| fn as_raw<'a>(&'a self) -> &'a [u8] { |
| unsafe { slice::from_raw_parts(self as *const _ as *const u8, |
| mem::size_of::<Self>()) } |
| } |
| } |
| |
| fn show_sizes() { |
| // This isn't panic safe. |
| for min in &[1, 2, 4, 8] { |
| let msize = c::boot_trailer_sz(*min); |
| println!("{:2}: {} (0x{:x})", min, msize, msize); |
| } |
| } |