forked from M-Labs/artiq-zynq
cxp upconn fw: update trigger csr
This commit is contained in:
parent
d84c7c9523
commit
7ee867d7c4
|
@ -3,25 +3,25 @@ use libboard_zynq::{println, timer::GlobalTimer};
|
|||
|
||||
use crate::pl::csr;
|
||||
|
||||
pub fn trigger_test(timer: &mut GlobalTimer) {
|
||||
pub fn trigger_test(timer: &mut GlobalTimer, linktrig_mode: u8) {
|
||||
const LEN: usize = 4 * 8;
|
||||
let mut pak_arr: [u8; LEN] = [0; LEN];
|
||||
|
||||
unsafe {
|
||||
csr::cxp::trig_trig_delay_write(0x05);
|
||||
csr::cxp::trig_linktrigger_write(0x05); // mode 0
|
||||
csr::cxp::trig_stb_write(1); // send trig
|
||||
csr::cxp::upconn_trig_delay_write(0x05);
|
||||
csr::cxp::upconn_linktrigger_write(linktrig_mode);
|
||||
csr::cxp::upconn_trig_stb_write(1); // send trig
|
||||
timer.delay_us(1);
|
||||
|
||||
let mut i: usize = 0;
|
||||
while csr::cxp::trig_dout_valid_read() == 1 {
|
||||
pak_arr[i] = csr::cxp::trig_dout_pak_read();
|
||||
while csr::cxp::upconn_trig_dout_valid_read() == 1 {
|
||||
pak_arr[i] = csr::cxp::upconn_trig_dout_pak_read();
|
||||
// println!("received {:#04X}", pak_arr[i]);
|
||||
csr::cxp::trig_inc_write(1);
|
||||
csr::cxp::upconn_trig_inc_write(1);
|
||||
i += 1;
|
||||
}
|
||||
|
||||
println!("trigger packet");
|
||||
println!("trigger packet | linktrigger = {}", linktrig_mode);
|
||||
println!("arr = [");
|
||||
for i in 0..(LEN / 4) {
|
||||
println!(
|
||||
|
|
Loading…
Reference in New Issue