somethings wrong

vorago-reb1/examples/nvm.rs

@@ -0,0 +1,61 @@
+#![no_main]
+#![no_std]
+
+use cortex_m_rt::entry;
+use embedded_hal::spi::{SpiBus, MODE_0};
+use embedded_hal_bus::spi::ExclusiveDevice;
+use panic_rtt_target as _;
+use rtt_target::{rprintln, rtt_init_print};
+use va108xx_hal::{
+    pac,
+    spi::{RomCs, RomMiso, RomMosi, RomSck, Spi, SpiClkConfig, SpiConfig, TransferConfigWithHwcs},
+    time::Hertz,
+};
+use vorago_reb1::m95m01::{regs::RDSR, M95M01};
+
+const CLOCK_FREQ: Hertz = Hertz::from_raw(50_000_000);
+
+#[entry]
+fn main() -> ! {
+    rtt_init_print!();
+    rprintln!("-- VA108XX REB1 NVM example --");
+
+    let mut dp = pac::Peripherals::take().unwrap();
+    let cp = cortex_m::Peripherals::take().unwrap();
+
+    let mut spi = Spi::new(
+        &mut dp.sysconfig,
+        CLOCK_FREQ,
+        dp.spic,
+        (RomSck, RomMiso, RomMosi),
+        // These values are taken from the vorago bootloader app, don't  want to experiment here..
+        SpiConfig::default().clk_cfg(SpiClkConfig::new(2, 4)),
+        None,
+    );
+    spi.cfg_mode(MODE_0);
+    spi.cfg_hw_cs(va108xx_hal::spi::HwChipSelectId::Id0);
+    spi.spi().ctrl1().modify(|_, w| w.blockmode().set_bit());
+    let mut read_buf: [u8; 2] = [0; 2];
+    spi.transfer(&mut read_buf, &[RDSR, 0]);
+    rprintln!("read buf {:?}", read_buf);
+    /*
+    let mut nvm =
+        M95M01::new(ExclusiveDevice::new_no_delay(spi, dummy_pin::DummyPin::new_low()).unwrap())
+            .expect("creating NVM structure failed");
+    let status_reg = nvm.read_status_reg().expect("reading status reg failed");
+    rprintln!("status reg: {:?}", status_reg);
+    if status_reg.zero_segment() == 0b111 {
+        panic!("status register unexpected values");
+    }
+
+    let mut read_buf: [u8; 16] = [0; 16];
+    nvm.read(0x4000, &mut read_buf[0..4])
+        .expect("reading NVM failed");
+    rprintln!("NVM address 0x4000: {:x?}", &read_buf[0..4]);
+    let write_buf: [u8; 4] = [1, 2, 3, 4];
+    nvm.write(0x4000, &write_buf).unwrap();
+    nvm.read(0x4000, &mut read_buf[0..4]).unwrap();
+    assert_eq!(&read_buf[0..4], write_buf);
+    */
+    loop {}
+}