mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-18 08:52:45 +00:00
start on a simple "multi-core" test
This commit is contained in:
parent
7c30a6960c
commit
27760d5477
2 changed files with 92 additions and 37 deletions
|
|
@ -79,4 +79,5 @@ pub fn bio_tests() {
|
||||||
report_api(crate::get_id());
|
report_api(crate::get_id());
|
||||||
|
|
||||||
units::hello_world();
|
units::hello_world();
|
||||||
|
units::hello_multiverse();
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -2,55 +2,109 @@ use super::report_api;
|
||||||
use crate::*;
|
use crate::*;
|
||||||
|
|
||||||
pub fn hello_world() {
|
pub fn hello_world() {
|
||||||
report_api(0x0510_0000);
|
report_api(0x1310_0000);
|
||||||
// map the instruction memory
|
let mut bio_ss = BioSharedState::new();
|
||||||
let imem_slice = unsafe {
|
let simple_test_code = fn_to_slice(simple_test, simple_test_endcap);
|
||||||
core::slice::from_raw_parts_mut(
|
|
||||||
utralib::generated::HW_BIO_RAM_MEM as *mut u32,
|
|
||||||
utralib::generated::HW_BIO_RAM_MEM_LEN
|
|
||||||
)
|
|
||||||
};
|
|
||||||
|
|
||||||
let simple_test_ptr = simple_test as *const u8;
|
|
||||||
let simple_test_slice = unsafe {
|
|
||||||
core::slice::from_raw_parts(simple_test_ptr,
|
|
||||||
(simple_test_end as *const u8) as usize - simple_test_ptr as usize
|
|
||||||
)
|
|
||||||
};
|
|
||||||
// copy code to reset vector for 0th machine
|
// copy code to reset vector for 0th machine
|
||||||
for (i, chunk) in simple_test_slice.chunks(4).enumerate() {
|
bio_ss.load_code(simple_test_code, 0);
|
||||||
if chunk.len() == 4 {
|
|
||||||
let word: u32 = u32::from_le_bytes(chunk.try_into().unwrap());
|
|
||||||
imem_slice[i] = word;
|
|
||||||
report_api(i as u32);
|
|
||||||
report_api(word);
|
|
||||||
} else {
|
|
||||||
let mut ragged_word = 0;
|
|
||||||
for (j, &b) in chunk.iter().enumerate() {
|
|
||||||
ragged_word |= (b as u32) << (4 - chunk.len() + j);
|
|
||||||
}
|
|
||||||
imem_slice[i] = ragged_word;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
// configure & run the 0th machine
|
// configure & run the 0th machine
|
||||||
let mut bio = CSR::new(utra::bio::HW_BIO_BASE as *mut u32);
|
// /32 clock
|
||||||
// /16 clock
|
bio_ss.bio.wo(utra::bio::SFR_QDIV0, 0x20_0000);
|
||||||
bio.wo(utra::bio::SFR_QDIV0, 0x10_0000);
|
|
||||||
// start the machine
|
// start the machine
|
||||||
bio.wo(utra::bio::SFR_CTRL, 0x111);
|
bio_ss.bio.wo(utra::bio::SFR_CTRL, 0x111);
|
||||||
report_api(0x0510_0001);
|
report_api(0x1310_00FF);
|
||||||
}
|
}
|
||||||
|
|
||||||
pub unsafe fn simple_test() {
|
pub unsafe fn simple_test() {
|
||||||
core::arch::asm!(
|
core::arch::asm!(
|
||||||
|
"add x1, zero, 0x10",
|
||||||
"0:",
|
"0:",
|
||||||
"nop",
|
"add x1, x1, 0x1",
|
||||||
|
"mv x21, x1",
|
||||||
|
"mv x20, zero",
|
||||||
"j 0b",
|
"j 0b",
|
||||||
"nop"
|
"nop"
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
// this marks the "end address" of simple_test
|
// this marks the "end address" of simple_test
|
||||||
pub unsafe fn simple_test_end() {
|
pub unsafe fn simple_test_endcap() {
|
||||||
|
core::arch::asm!(
|
||||||
|
"nop"
|
||||||
|
);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn hello_multiverse() {
|
||||||
|
report_api(0x1310_1000);
|
||||||
|
let mut bio_ss = BioSharedState::new();
|
||||||
|
// stop all the machines, so that code can be loaded
|
||||||
|
bio_ss.bio.wo(utra::bio::SFR_CTRL, 0x0);
|
||||||
|
let mv_test_code = fn_to_slice(multiverse_test, multiverse_test_endcap);
|
||||||
|
bio_ss.load_code(mv_test_code, 0);
|
||||||
|
|
||||||
|
// configure & run the 0th machine
|
||||||
|
// /32 clock
|
||||||
|
bio_ss.bio.wo(utra::bio::SFR_QDIV0, 0x20_0000);
|
||||||
|
bio_ss.bio.wo(utra::bio::SFR_QDIV1, 0x20_0000);
|
||||||
|
bio_ss.bio.wo(utra::bio::SFR_QDIV2, 0x20_0000);
|
||||||
|
bio_ss.bio.wo(utra::bio::SFR_QDIV3, 0x20_0000);
|
||||||
|
// start all the machines, all at once
|
||||||
|
bio_ss.bio.wo(utra::bio::SFR_CTRL, 0xfff);
|
||||||
|
report_api(0x1310_10FF);
|
||||||
|
}
|
||||||
|
|
||||||
|
pub unsafe fn multiverse_test() {
|
||||||
|
core::arch::asm!(
|
||||||
|
// reset vectors for each machine
|
||||||
|
"j 0f",
|
||||||
|
"nop",
|
||||||
|
"j 1f",
|
||||||
|
"nop",
|
||||||
|
"j 2f",
|
||||||
|
"nop",
|
||||||
|
"j 3f",
|
||||||
|
"nop",
|
||||||
|
// mach 0 code
|
||||||
|
"0:",
|
||||||
|
"li x26, 0xFF",
|
||||||
|
"add x1, zero, 0x10",
|
||||||
|
"4:",
|
||||||
|
"add x1, x1, 0x1",
|
||||||
|
"mv x21, x1",
|
||||||
|
"mv x20, zero",
|
||||||
|
"j 4b",
|
||||||
|
// mach 1 code
|
||||||
|
"1:",
|
||||||
|
"li x26, 0xFF00",
|
||||||
|
"add x1, zero, 0x20",
|
||||||
|
"5:",
|
||||||
|
"add x1, x1, 0x1",
|
||||||
|
"slli x21, x1, 8",
|
||||||
|
"mv x20, zero",
|
||||||
|
"j 5b",
|
||||||
|
// mach 2 code
|
||||||
|
"2:",
|
||||||
|
"li x26, 0xFF0000",
|
||||||
|
"add x1, zero, 0x20",
|
||||||
|
"6:",
|
||||||
|
"add x1, x1, 0x1",
|
||||||
|
"slli x21, x1, 16",
|
||||||
|
"mv x20, zero",
|
||||||
|
"j 6b",
|
||||||
|
// mach 3 code
|
||||||
|
"3:",
|
||||||
|
"li x26, 0xFF0000",
|
||||||
|
"add x1, zero, 0x20",
|
||||||
|
"7:",
|
||||||
|
"add x1, x1, 0x1",
|
||||||
|
"slli x21, x1, 24",
|
||||||
|
"mv x20, zero",
|
||||||
|
"j 7b",
|
||||||
|
);
|
||||||
|
}
|
||||||
|
// this marks the "end address" of simple_test
|
||||||
|
pub unsafe fn multiverse_test_endcap() {
|
||||||
core::arch::asm!(
|
core::arch::asm!(
|
||||||
"nop"
|
"nop"
|
||||||
);
|
);
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue