add SPIM loader bringup code

This commit is contained in:
bunnie 2024-04-30 17:13:42 +08:00
parent fd9f85ef58
commit 1810880723

View file

@ -220,6 +220,9 @@ pub fn early_init() {
xous_pl230::pl230_tests::units::basic_tests(&mut pl230); xous_pl230::pl230_tests::units::basic_tests(&mut pl230);
// xous_pl230::pl230_tests::units::pio_test(&mut pl230); // xous_pl230::pl230_tests::units::pio_test(&mut pl230);
const BANNER: &'static str = "\n\rKeep pressing keys to continue boot...\r\n";
udma_uart.write(BANNER.as_bytes());
// Quantum timer stub // Quantum timer stub
#[cfg(feature = "quantum-timer-test")] #[cfg(feature = "quantum-timer-test")]
{ {
@ -271,6 +274,9 @@ pub fn early_init() {
} }
} }
} }
// space for one character, plus appending CRLF for the return
let mut rx_buf = [0u8; 3];
#[cfg(feature = "spim-test")] #[cfg(feature = "spim-test")]
{ {
use cramium_hal::ifram::IframRange; use cramium_hal::ifram::IframRange;
@ -310,73 +316,133 @@ pub fn early_init() {
// setup the I/O pins // setup the I/O pins
let mut iox = Iox::new(utralib::generated::HW_IOX_BASE as *mut u32); let mut iox = Iox::new(utralib::generated::HW_IOX_BASE as *mut u32);
// JQSPI1 let mut udma_global = GlobalConfig::new(utralib::generated::HW_UDMA_CTRL_BASE as *mut u32);
// SPIM_CLK_A[0] #[cfg(not(feature = "spi-alt-channel"))]
setup_port( let channel = {
&mut iox, // JQSPI1
IoxPort::PD, // SPIM_CLK_A[0]
4,
Some(IoxFunction::AF1),
Some(IoxDir::Output),
Some(IoxDriveStrength::Drive2mA),
Some(IoxEnable::Disable),
None,
None,
);
// SPIM_SD[0-3]_A[0]
for i in 0..3 {
setup_port( setup_port(
&mut iox, &mut iox,
IoxPort::PD, IoxPort::PD,
i, 4,
Some(IoxFunction::AF1), Some(IoxFunction::AF1),
Some(IoxDir::Output),
Some(IoxDriveStrength::Drive4mA),
Some(IoxEnable::Enable),
None, None,
None,
);
// SPIM_SD[0-3]_A[0]
for i in 0..3 {
setup_port(
&mut iox,
IoxPort::PD,
i,
Some(IoxFunction::AF1),
None,
Some(IoxDriveStrength::Drive2mA),
Some(IoxEnable::Enable),
None,
None,
);
}
// SPIM_CSN0_A[0]
setup_port(
&mut iox,
IoxPort::PD,
5,
Some(IoxFunction::AF1),
Some(IoxDir::Output),
Some(IoxDriveStrength::Drive2mA), Some(IoxDriveStrength::Drive2mA),
Some(IoxEnable::Enable), Some(IoxEnable::Enable),
None, None,
None, None,
); );
} // SPIM_CSN0_A[1]
// SPIM_CSN0_A[0] setup_port(
setup_port( &mut iox,
&mut iox, IoxPort::PD,
IoxPort::PD, 6,
5, Some(IoxFunction::AF1),
Some(IoxFunction::AF1), Some(IoxDir::Output),
Some(IoxDir::Output), Some(IoxDriveStrength::Drive2mA),
Some(IoxDriveStrength::Drive2mA), Some(IoxEnable::Enable),
Some(IoxEnable::Enable), None,
None, None,
None, );
); udma_global.clock_on(PeriphId::Spim0); // JQSPI1
// SPIM_CSN0_A[1] SpimChannel::Channel0
setup_port( };
&mut iox, #[cfg(feature = "spi-alt-channel")]
IoxPort::PD, let channel = {
6, // JPC7_13
Some(IoxFunction::AF1), // SPIM_CLK_A[1]
Some(IoxDir::Output), setup_port(
Some(IoxDriveStrength::Drive2mA), &mut iox,
Some(IoxEnable::Enable), IoxPort::PC,
None, 11,
None, Some(IoxFunction::AF1),
); Some(IoxDir::Output),
let mut udma_global = GlobalConfig::new(utralib::generated::HW_UDMA_CTRL_BASE as *mut u32); Some(IoxDriveStrength::Drive4mA),
udma_global.clock_on(PeriphId::Spim0); // JQSPI1 Some(IoxEnable::Enable),
None,
None,
);
// SPIM_SD[0-3]_A[1]
for i in 7..11 {
setup_port(
&mut iox,
IoxPort::PC,
i,
Some(IoxFunction::AF1),
None,
Some(IoxDriveStrength::Drive2mA),
Some(IoxEnable::Enable),
None,
None,
);
}
// SPIM_CSN0_A[1]
setup_port(
&mut iox,
IoxPort::PC,
12,
Some(IoxFunction::AF1),
Some(IoxDir::Output),
Some(IoxDriveStrength::Drive2mA),
Some(IoxEnable::Enable),
None,
None,
);
// SPIM_CSN0_A[1]
setup_port(
&mut iox,
IoxPort::PC,
13,
Some(IoxFunction::AF1),
Some(IoxDir::Output),
Some(IoxDriveStrength::Drive2mA),
Some(IoxEnable::Enable),
None,
None,
);
udma_global.clock_on(PeriphId::Spim1); // JPC7_13
SpimChannel::Channel1
};
crate::println!("Configuring SPI channel: {:?}", channel);
// safety: this is safe because clocks have been set up // safety: this is safe because clocks have been set up
let mut flash_spim = unsafe { let mut flash_spim = unsafe {
Spim::new_with_ifram( Spim::new_with_ifram(
SpimChannel::Channel0, channel,
100_000_000, 50_000_000,
100_000_000, 50_000_000,
SpimClkPol::LeadingEdgeRise, SpimClkPol::LeadingEdgeRise,
SpimClkPha::CaptureOnLeading, SpimClkPha::CaptureOnLeading,
SpimCs::Cs0, SpimCs::Cs0,
0, 0,
0, 0,
None, None,
0, // we will never write to flash 16, // just enough space to send commands
4096, 4096,
Some(8), Some(8),
IframRange::from_raw_parts(SPIM_FLASH_IFRAM_ADDR, SPIM_FLASH_IFRAM_ADDR, 4096 * 2), IframRange::from_raw_parts(SPIM_FLASH_IFRAM_ADDR, SPIM_FLASH_IFRAM_ADDR, 4096 * 2),
@ -385,9 +451,9 @@ pub fn early_init() {
let mut ram_spim = unsafe { let mut ram_spim = unsafe {
Spim::new_with_ifram( Spim::new_with_ifram(
SpimChannel::Channel0, channel,
100_000_000, 50_000_000,
100_000_000, 50_000_000,
SpimClkPol::LeadingEdgeRise, SpimClkPol::LeadingEdgeRise,
SpimClkPha::CaptureOnLeading, SpimClkPha::CaptureOnLeading,
SpimCs::Cs1, SpimCs::Cs1,
@ -400,23 +466,70 @@ pub fn early_init() {
IframRange::from_raw_parts(SPIM_RAM_IFRAM_ADDR, SPIM_RAM_IFRAM_ADDR, 4096 * 2), IframRange::from_raw_parts(SPIM_RAM_IFRAM_ADDR, SPIM_RAM_IFRAM_ADDR, 4096 * 2),
) )
}; };
crate::println!("spim init done");
crate::println!(
"Flash RxBuf: {:x}[{:x}] / {:x}[{:x}]",
flash_spim.rx_buf::<u8>().as_ptr() as usize,
flash_spim.rx_buf::<u8>().len(),
unsafe { flash_spim.rx_buf_phys::<u8>().as_ptr() as usize },
unsafe { flash_spim.rx_buf_phys::<u8>().len() },
);
crate::println!(
"Ram RxBuf: {:x}[{:x}] / {:x}[{:x}]",
ram_spim.rx_buf::<u8>().as_ptr() as usize,
ram_spim.rx_buf::<u8>().len(),
unsafe { ram_spim.rx_buf_phys::<u8>().as_ptr() as usize },
unsafe { ram_spim.rx_buf_phys::<u8>().len() }
);
// turn off QPI mode, in case it was set from a reboot in a bad state
flash_spim.mem_qpi_mode(false);
ram_spim.mem_qpi_mode(false);
// sanity check: read ID // sanity check: read ID
crate::println!("flash ID: {:x}", flash_spim.mem_read_id()); crate::println!("read ID...");
crate::println!("ram ID: {:x}", ram_spim.mem_read_id()); udma_uart.read(&mut rx_buf[..1]);
let flash_id = flash_spim.mem_read_id_flash();
let ram_id = ram_spim.mem_read_id_ram();
crate::println!("flash ID: {:x}", flash_id);
crate::println!("ram ID: {:x}", ram_id);
// density 18, memory type 20, mfg ID C2 ==> MX25L128833F
assert!(flash_id & 0xFF_FF_FF == 0x1820C2);
// KGD 5D, mfg ID 9D; remainder of bits are part of the EID
assert!(ram_id & 0xFF_FF == 0x5D9D);
// setup FLASH // setup FLASH
// - QE enable // - QE enable
// - dummy cycles = 8 // - dummy cycles = 8
crate::println!("write SR...");
udma_uart.read(&mut rx_buf[..1]);
flash_spim.mem_write_status_register(0b01_0000_00, 0b10_00_0_111); flash_spim.mem_write_status_register(0b01_0000_00, 0b10_00_0_111);
// set SPI devices to QPI mode // set SPI devices to QPI mode
// We expect a MX25L12833F (3.3V) on CS0 // We expect a MX25L12833F (3.3V) on CS0
// We expect a ISS66WVS4M8BLL (3.3V) on CS1 // We expect a ISS66WVS4M8BLL (3.3V) on CS1
// Both support QPI. // Both support QPI.
crate::println!("set QPI mode...");
udma_uart.read(&mut rx_buf[..1]);
flash_spim.mem_qpi_mode(true); flash_spim.mem_qpi_mode(true);
ram_spim.mem_qpi_mode(true); ram_spim.mem_qpi_mode(true);
// density 18, memory type 20, mfg ID C2 ==> MX25L128833F
assert!(flash_id & 0xFF_FF_FF == 0x1820C2);
// KGD 5D, mfg ID 9D; remainder of bits are part of the EID
assert!(ram_id & 0xFF_FF == 0x5D9D);
crate::println!("read ID QPI mode...");
udma_uart.read(&mut rx_buf[..1]);
let flash_id = flash_spim.mem_read_id_flash();
let ram_id = ram_spim.mem_read_id_ram();
crate::println!("QPI flash ID: {:x}", flash_id);
crate::println!("QPI ram ID: {:x}", ram_id);
let mut chk_buf = [0u8; 32]; let mut chk_buf = [0u8; 32];
crate::println!("first read...");
udma_uart.read(&mut rx_buf[..1]);
crate::println!("flash read");
flash_spim.mem_read(0x0, &mut chk_buf); flash_spim.mem_read(0x0, &mut chk_buf);
crate::println!("flash: {:x?}", chk_buf); crate::println!("flash: {:x?}", chk_buf);
ram_spim.mem_read(0x0, &mut chk_buf); ram_spim.mem_read(0x0, &mut chk_buf);
@ -424,19 +537,25 @@ pub fn early_init() {
for (i, d) in chk_buf.iter_mut().enumerate() { for (i, d) in chk_buf.iter_mut().enumerate() {
*d = i as u8; *d = i as u8;
} }
crate::println!("ram write...");
udma_uart.read(&mut rx_buf[..1]);
ram_spim.mem_ram_write(0x0, &chk_buf); ram_spim.mem_ram_write(0x0, &chk_buf);
chk_buf.fill(0); chk_buf.fill(0);
crate::println!("empty buf: {:x?}", chk_buf); crate::println!("empty buf: {:x?}", chk_buf);
crate::println!("ram read...");
udma_uart.read(&mut rx_buf[..1]);
ram_spim.mem_read(0x0, &mut chk_buf); ram_spim.mem_read(0x0, &mut chk_buf);
crate::println!("RAM checked: {:x?}", chk_buf); crate::println!("RAM checked: {:x?}", chk_buf);
/*
crate::println!("looping around, turning off QPI mode!");
udma_uart.read(&mut rx_buf[..1]);
flash_spim.mem_qpi_mode(false);
ram_spim.mem_qpi_mode(false);
*/
} }
const BANNER: &'static str = "\n\rKeep pressing keys to continue boot...\r\n";
udma_uart.write(BANNER.as_bytes());
// space for one character, plus appending CRLF for the return
let mut rx_buf = [0u8; 3];
// receive characters -- print them back. just to prove that this works. no other reason than that. // receive characters -- print them back. just to prove that this works. no other reason than that.
for _ in 0..4 { for _ in 0..4 {
udma_uart.read(&mut rx_buf[..1]); udma_uart.read(&mut rx_buf[..1]);