mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-18 08:52:45 +00:00
cleanup the initialization code some more
move the full mem initailization above the memory load/store pipe cleaner, and have the memory load/store actually do a load and not just stores.
This commit is contained in:
parent
5fb01c5332
commit
11fb1452c9
2 changed files with 17 additions and 18 deletions
|
|
@ -152,6 +152,7 @@ pub fn fifo_basic() -> usize {
|
||||||
test_cfg.wo(utra::csrtest::WTEST, 0);
|
test_cfg.wo(utra::csrtest::WTEST, 0);
|
||||||
|
|
||||||
let mut bio_ss = BioSharedState::new();
|
let mut bio_ss = BioSharedState::new();
|
||||||
|
bio_ss.init();
|
||||||
// stop all the machines, so that code can be loaded
|
// stop all the machines, so that code can be loaded
|
||||||
bio_ss.bio.wo(utra::bio_bdma::SFR_CTRL, 0x0);
|
bio_ss.bio.wo(utra::bio_bdma::SFR_CTRL, 0x0);
|
||||||
bio_ss.load_code(fifo_basic0_code(), 0, BioCore::Core0);
|
bio_ss.load_code(fifo_basic0_code(), 0, BioCore::Core0);
|
||||||
|
|
|
||||||
|
|
@ -229,24 +229,6 @@ impl BioSharedState {
|
||||||
self.bio.wo(utra::bio_bdma::SFR_QDIV2, 0x0_0000);
|
self.bio.wo(utra::bio_bdma::SFR_QDIV2, 0x0_0000);
|
||||||
self.bio.wo(utra::bio_bdma::SFR_QDIV3, 0x0_0000);
|
self.bio.wo(utra::bio_bdma::SFR_QDIV3, 0x0_0000);
|
||||||
|
|
||||||
for core in 0..4 {
|
|
||||||
// crate::println!("ldst trial");
|
|
||||||
let core_num = 1 << (core as usize);
|
|
||||||
self.load_code(mem_init_code(), 0, BioCore::from(core));
|
|
||||||
self.bio.wo(
|
|
||||||
utra::bio_bdma::SFR_CTRL,
|
|
||||||
self.bio.r(utra::bio_bdma::SFR_CTRL) | (core_num | core_num << 4 | core_num << 8),
|
|
||||||
);
|
|
||||||
for _ in 0..16 {
|
|
||||||
let _ = self.bio.r(utra::bio_bdma::SFR_RXF0);
|
|
||||||
let _ = self.bio.r(utra::bio_bdma::SFR_RXF1);
|
|
||||||
let _ = self.bio.r(utra::bio_bdma::SFR_RXF2);
|
|
||||||
let _ = self.bio.r(utra::bio_bdma::SFR_RXF3);
|
|
||||||
}
|
|
||||||
// crate::println!("ldst trial end");
|
|
||||||
}
|
|
||||||
self.bio.wfo(utra::bio_bdma::SFR_FIFO_CLR_SFR_FIFO_CLR, 0xf);
|
|
||||||
|
|
||||||
self.bio.wo(utra::bio_bdma::SFR_CTRL, 0x0);
|
self.bio.wo(utra::bio_bdma::SFR_CTRL, 0x0);
|
||||||
for imem in self.imem_slice.iter_mut() {
|
for imem in self.imem_slice.iter_mut() {
|
||||||
// jump to current location
|
// jump to current location
|
||||||
|
|
@ -269,6 +251,20 @@ impl BioSharedState {
|
||||||
}
|
}
|
||||||
self.bio.wfo(utra::bio_bdma::SFR_FIFO_CLR_SFR_FIFO_CLR, 0xf);
|
self.bio.wfo(utra::bio_bdma::SFR_FIFO_CLR_SFR_FIFO_CLR, 0xf);
|
||||||
self.bio.wo(utra::bio_bdma::SFR_CTRL, 0x0);
|
self.bio.wo(utra::bio_bdma::SFR_CTRL, 0x0);
|
||||||
|
|
||||||
|
for core in 0..4 {
|
||||||
|
// crate::println!("ldst trial");
|
||||||
|
self.load_code(mem_init_code(), 0, BioCore::from(core));
|
||||||
|
self.set_core_run_states([core == 0, core == 1, core == 2, core == 3]);
|
||||||
|
for _ in 0..16 {
|
||||||
|
let _ = self.bio.r(utra::bio_bdma::SFR_RXF0);
|
||||||
|
let _ = self.bio.r(utra::bio_bdma::SFR_RXF1);
|
||||||
|
let _ = self.bio.r(utra::bio_bdma::SFR_RXF2);
|
||||||
|
let _ = self.bio.r(utra::bio_bdma::SFR_RXF3);
|
||||||
|
}
|
||||||
|
// crate::println!("ldst trial end");
|
||||||
|
}
|
||||||
|
self.bio.wfo(utra::bio_bdma::SFR_FIFO_CLR_SFR_FIFO_CLR, 0xf);
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn load_code(&mut self, prog: &[u8], offset_bytes: usize, core: BioCore) {
|
pub fn load_code(&mut self, prog: &[u8], offset_bytes: usize, core: BioCore) {
|
||||||
|
|
@ -627,9 +623,11 @@ macro_rules! bio_code {
|
||||||
#[rustfmt::skip]
|
#[rustfmt::skip]
|
||||||
bio_code!(mem_init_code, MEM_INIT_START, MEM_INIT_END,
|
bio_code!(mem_init_code, MEM_INIT_START, MEM_INIT_END,
|
||||||
"sw x0, 0x20(x0)",
|
"sw x0, 0x20(x0)",
|
||||||
|
"lw t0, 0x20(x0)",
|
||||||
"li sp, 0x61200000",
|
"li sp, 0x61200000",
|
||||||
"addi sp, sp, -4",
|
"addi sp, sp, -4",
|
||||||
"sw x0, 0(sp)",
|
"sw x0, 0(sp)",
|
||||||
|
"lw t0, 0(sp)",
|
||||||
"10:",
|
"10:",
|
||||||
"j 10b"
|
"j 10b"
|
||||||
);
|
);
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue