devc pcap WIP

This commit is contained in:
Stewart Mackenzie 2020-03-06 18:37:15 +08:00
parent 774e4e88a9
commit dcee7213de
9 changed files with 173 additions and 12 deletions

View File

@ -1 +1,7 @@
nix-shell --command "cargo xbuild --release" && scp -P 2204 -C target/armv7-none-eabihf/release/zc706-experiments $1@nixbld.m-labs.hk:/home/$1/zc706/zc706.elf if [ $1 = "cora" ]; then
nix-shell --command "cd experiments && cargo xbuild --release --no-default-features --features=target_cora_z7_10"
elif [ -z $2 ]; then
nix-shell --command "cargo xbuild --release" && scp -P 2204 -C target/armv7-none-eabihf/release/experiments $1@nixbld.m-labs.hk:/home/$1/zc706/zc706.elf
else
nix-shell --command "cargo xbuild --release" && scp -C target/armv7-none-eabihf/release/experiments $1@rpi-4.m-labs.hk:/home/$1/zc706/zc706.elf
fi

View File

@ -3,7 +3,7 @@
use core::mem::transmute; use core::mem::transmute;
use libcortex_a9::mutex::Mutex; use libcortex_a9::mutex::Mutex;
use libboard_zynq::{print, println, self as zynq, clocks::Clocks, clocks::source::{ClockSource, ArmPll, IoPll}}; use libboard_zynq::{print, println, self as zynq, clocks::Clocks, clocks::source::{ClockSource, ArmPll, IoPll}, devc::{DevC}};
use libsupport_zynq::{ use libsupport_zynq::{
ram, alloc::{vec, vec::Vec}, ram, alloc::{vec, vec::Vec},
boot, boot,
@ -13,6 +13,8 @@ use libsupport_zynq::{
smoltcp::socket::SocketSet, smoltcp::socket::SocketSet,
smoltcp::socket::{TcpSocket, TcpSocketBuffer}, smoltcp::socket::{TcpSocket, TcpSocketBuffer},
}; };
mod pl_config;
use pl_config::load_pl;
const HWADDR: [u8; 6] = [0, 0x23, 0xde, 0xea, 0xbe, 0xef]; const HWADDR: [u8; 6] = [0, 0x23, 0xde, 0xea, 0xbe, 0xef];
@ -20,6 +22,13 @@ static mut STACK_CORE1: [u32; 512] = [0; 512];
#[no_mangle] #[no_mangle]
pub fn main_core0() { pub fn main_core0() {
let mut devc = DevC::new();
load_pl(&mut devc);
loop {}
}
//#[no_mangle]
pub fn main_core01() {
// zynq::clocks::CpuClocks::enable_io(1_250_000_000); // zynq::clocks::CpuClocks::enable_io(1_250_000_000);
println!("\nzc706 main"); println!("\nzc706 main");
{ {

View File

@ -0,0 +1,15 @@
use libboard_zynq::{print, println, self as zynq,
devc::{DevC},
};
pub fn load_pl(devc: &mut DevC) {
devc.enable_and_select_pcap();
devc.clear_interrupts();
devc.initialize_pl();
devc.wait_for_pl_to_be_ready();
devc.disable_pcap_loopback();
devc.disable_pcap_secure_mode();
devc.load_dma();
//devc.wait_for_dma_transfer();
println!("end\n\n");
}

View File

@ -1,6 +1,10 @@
use core::fmt;
use libregister::*; use libregister::*;
mod regs; mod regs;
use crate::println;
pub struct DevC { pub struct DevC {
regs: &'static mut regs::RegisterBlock, regs: &'static mut regs::RegisterBlock,
} }
@ -12,16 +16,134 @@ impl DevC {
} }
} }
pub fn enable(&mut self) { pub fn enable_and_select_pcap(&mut self) {
self.regs.control.modify(|_, w| { self.regs.control.modify(|_, w| {
w.pcap_mode(true) w.pcap_mode(true)
.pcap_pr(true) .pcap_pr(true)
}) });
let status = self.regs.control.read();
println!("pcap mode: {}, pcap_pr: {}",status.pcap_pr(), status.pcap_mode());
} }
pub fn disable(&mut self) {
pub fn enable_and_select_icap(&mut self) {
self.regs.control.modify(|_, w| { self.regs.control.modify(|_, w| {
w.pcap_mode(false) w.pcap_mode(true)
.pcap_pr(false) .pcap_pr(false)
}) })
} }
pub fn clear_interrupts(&mut self) {
self.regs.int_sts.modify(|_, w| {
w.pps_gts_usr_b_int(true)
.pps_fst_cfg_b_int(true)
.pps_gpwrdwn_b_int(true)
.pps_gts_cfg_b_int(true)
.pps_cfg_reset_b_int(true)
.ixr_axi_wto(true)
.ixr_axi_werr(true)
.ixr_axi_rto(true)
.ixr_axi_rerr(true)
.ixr_rx_fifo_ov(true)
.ixr_wr_fifo_lvl(true)
.ixr_rd_fifo_lvl(true)
.ixr_dma_cmd_err(true)
.ixr_dma_q_ov(true)
.ixr_dma_done(true)
.ixr_d_p_done(true)
.ixr_p2d_len_err(true)
.ixr_pcfg_hmac_err(true)
.ixr_pcfg_seu_err(true)
.ixr_pcfg_por_b(true)
.ixr_pcfg_cfg_rst(true)
.ixr_pcfg_done(true)
.ixr_pcfg_init_pe(true)
.ixr_pcfg_init_ne(true)
})
}
pub fn initialize_pl(&mut self) {
self.regs.control.modify(|_, w| {
w.pcfg_prog_b(true)
});
let control = self.regs.control.read();
println!("pcfg_prog_b mode: {}",control.pcfg_prog_b());
self.regs.control.modify(|_, w| {
w.pcfg_prog_b(false)
});
let control = self.regs.control.read();
println!("pcfg_prog_b mode: {}",control.pcfg_prog_b());
self.wait_for_status_pcfg_init_to_be(false);
self.regs.control.modify(|_, w| {
w.pcfg_prog_b(true)
});
let control = self.regs.control.read();
println!("pcfg_prog_b mode: {}",control.pcfg_prog_b());
self.regs.int_sts.modify(|_,w| {
w.ixr_pcfg_done(true)
});
let int_sts= self.regs.int_sts.read();
println!("ixr_pcfg_done mode: {}",int_sts.ixr_pcfg_done());
}
pub fn wait_for_pl_to_be_ready(&self) {
self.wait_for_status_pcfg_init_to_be(true)
}
pub fn disable_pcap_loopback(&mut self) {
let mctrl = self.regs.mctrl.read();
println!("mctrl pcap_lpbk: {}", mctrl.pcap_lpbk());
self.regs.mctrl.modify(|_,w| {
w.pcap_lpbk(false)
});
let mctrl = self.regs.mctrl.read();
println!("mctrl pcap_lpbk: {}", mctrl.pcap_lpbk());
}
pub fn enable_pcap_secure_mode(&mut self) {
self.regs.control.modify(|_, w| {
w.pcap_rate_en(true)
});
}
pub fn disable_pcap_secure_mode(&mut self) {
let control = self.regs.control.read();
println!("control pcap_rate_en: {}", control.pcap_rate_en());
self.regs.control.modify(|_, w| {
w.pcap_rate_en(false)
});
let control = self.regs.control.read();
println!("control pcap_rate_en: {}", control.pcap_rate_en());
}
pub fn wait_for_dma_transfer(&self) {
self.wait_for_int_sts_ixr_dma_done_to_be(true);
}
pub fn load_dma(&mut self) {
self.regs.dma_src_addr.modify(|_, w| {
w.src_addr(regs::SRC_ADDR)
});
self.regs.dma_dest_addr.modify(|_, w| {
w.dest_addr(regs::DEST_ADDR)
});
}
fn wait_for_status_pcfg_init_to_be(&self, value: bool) {
loop {
let status = self.regs.status.read();
println!("expected value for pcfg_init: {}, actual: {}",value, status.pcfg_init());
if value == status.pcfg_init() {
return
}
}
}
fn wait_for_int_sts_ixr_dma_done_to_be(&self, value: bool) {
loop {
let int_sts = self.regs.int_sts.read();
println!("expected value for int_sts.ixr_dma_done: {}, actual: {}",value, int_sts.ixr_dma_done());
if value == int_sts.ixr_dma_done() {
return
}
}
}
} }

View File

@ -3,6 +3,10 @@ use libregister::{
register_bit, register_bits, register_bits_typed, register_bit, register_bits, register_bits_typed,
}; };
pub const SRC_ADDR: u32 = 0x00000000;
pub const DEST_ADDR: u32 = 0xFFFFFFFF;
pub const TEST_DATA: u32 = 0xABCD1234;
#[repr(C)] #[repr(C)]
pub struct RegisterBlock { pub struct RegisterBlock {
pub control: Control, pub control: Control,
@ -148,10 +152,10 @@ register_bit!(status, efuse_sec_en, 2);
register_bit!(status, efuse_jtag_dis, 1); register_bit!(status, efuse_jtag_dis, 1);
register!(dma_src_addr, DmaSrcAddr, RW, u32); register!(dma_src_addr, DmaSrcAddr, RW, u32);
register_bits!(dma_src_addr, src_addr, u8, 0, 31); register_bits!(dma_src_addr, src_addr, u32, 0, 31);
register!(dma_dest_addr, DmaDestAddr, RW, u32); register!(dma_dest_addr, DmaDestAddr, RW, u32);
register_bits!(dma_dest_addr, dest_addr, u8, 0, 31); register_bits!(dma_dest_addr, dest_addr, u32, 0, 31);
register!(dma_src_len, DmaSrcLen, RW, u32); register!(dma_src_len, DmaSrcLen, RW, u32);
register_bits!(dma_src_len, dma_len, u8, 0, 26); register_bits!(dma_src_len, dma_len, u8, 0, 26);

View File

@ -25,4 +25,8 @@ def dfr
zynq-fsbl-restart zynq-fsbl-restart
end end
#shortcut to load
def l
load
end

View File

@ -0,0 +1 @@

View File

@ -13,7 +13,7 @@ stdenv.mkDerivation {
rustc cargo rustc cargo
cargo-xbuild rustcSrc cargo-xbuild rustcSrc
gcc gcc
]) ++ (with pkgs; [ openocd gdb ]); ]) ++ (with pkgs; [ openocd gdb cgdb tcl ]);
# Set Environment Variables # Set Environment Variables
RUST_BACKTRACE = 1; RUST_BACKTRACE = 1;

View File

@ -10,7 +10,7 @@ then
tmux select-pane -t 0 tmux select-pane -t 0
tmux send-keys "stty 115200 < /dev/ttyUSB1 && cat /dev/ttyUSB1" C-m tmux send-keys "stty 115200 < /dev/ttyUSB1 && cat /dev/ttyUSB1" C-m
tmux select-pane -t 1 tmux select-pane -t 1
tmux send-keys "sleep 10 && cgdb zc706.elf -x openocd/gdb-zynq-commands" C-m tmux send-keys "sleep 10 && cgdb zc706.elf -x openocd/gdb-zynq-commands.gdb" C-m
tmux split-window -v tmux split-window -v
tmux resize-pane -D 20 tmux resize-pane -D 20
tmux send-keys "cd openocd && openocd -f zc706.cfg -c reset init" C-m tmux send-keys "cd openocd && openocd -f zc706.cfg -c reset init" C-m
@ -21,7 +21,7 @@ else
tmux select-pane -t 0 tmux select-pane -t 0
tmux send-keys "stty 115200 < /dev/ttyUSB1 && cat /dev/ttyUSB1" C-m tmux send-keys "stty 115200 < /dev/ttyUSB1 && cat /dev/ttyUSB1" C-m
tmux select-pane -t 1 tmux select-pane -t 1
tmux send-keys "sleep 10 && cgdb target/armv7-none-eabihf/release/zc706-experiments -x openocd/gdb-zynq-commands" C-m tmux send-keys "sleep 3 && cgdb target/armv7-none-eabihf/release/zc706-experiments -x openocd/gdb-zynq-commands.gdb" C-m
tmux split-window -v tmux split-window -v
tmux resize-pane -D 20 tmux resize-pane -D 20
tmux send-keys "cd openocd && openocd -f cora-z7-10.cfg -c reset init" C-m tmux send-keys "cd openocd && openocd -f cora-z7-10.cfg -c reset init" C-m