From aa92da23b7a838503f4b4274e1c7f7cb577e31e0 Mon Sep 17 00:00:00 2001 From: gianmarcogirau Date: Mon, 6 Jan 2020 14:42:31 +0000 Subject: [PATCH] CORE-73 - The testbench now supports the legacy functionality --- .../common/0/src/test/avalon_verify_pkg_2.vhd | 703 +++++++++++++++++ .../fire_pulse_manager/5/sim/sim_fpm.do | 5 +- .../fire_pulse_manager/5/sim/wave_fpm.do | 209 ++++- .../5/src/fire_pulse_5_pkg.vhd | 22 +- .../5/src/fire_pulse_ctrl_5.vhd | 19 +- .../5/src/fire_pulse_manager_5.vhd | 71 +- .../5/src/test/fire_pulse_manager_5_tb.vhd | 508 ++++-------- .../src/test/fire_pulse_manager_5_tb_pkg.vhd | 743 ++++++++++++++++++ 8 files changed, 1870 insertions(+), 410 deletions(-) create mode 100644 generic_ip/common/0/src/test/avalon_verify_pkg_2.vhd create mode 100644 generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb_pkg.vhd diff --git a/generic_ip/common/0/src/test/avalon_verify_pkg_2.vhd b/generic_ip/common/0/src/test/avalon_verify_pkg_2.vhd new file mode 100644 index 0000000..aa85786 --- /dev/null +++ b/generic_ip/common/0/src/test/avalon_verify_pkg_2.vhd @@ -0,0 +1,703 @@ +-- avalon_verify_pkg_2 vs avalon_verify_pkg: +-- in avalon_verify_pkg_2 the read_latency and the usage of the wait_request +-- can be individually selected to for every avalon master/slave couple. +-- Note: the full package needs to be revised + +library ieee; +use ieee.std_logic_1164.all; +use ieee.numeric_std.all; +use ieee.std_logic_textio.all; +use std.textio.all; + +library OSVVM ; +use OSVVM.RandomBasePkg.all ; +use OSVVM.RandomPkg.all ; + +package avalon_verify_pkg_2 is + + shared variable RV : RandomPType; + + ----------------------------------------------------------------------------- + -- Bus duty cycle control + ----------------------------------------------------------------------------- + + signal int_mmBusPunctureAllowed : boolean := false; + signal int_mmBusPunctureMax : integer := 3; + + signal int_stmBusPunctureAllowed : boolean := false; + signal int_stmBusPunctureMin : integer := 3; + signal int_stmBusPunctureMax : integer := 3; + + ----------------------------------------------------------------------------- + -- Clock and reset section + ----------------------------------------------------------------------------- + + signal clk_clk : std_logic := '0'; + signal reset_reset_n : std_logic := '0'; + + ----------------------------------------------------------------------------- + -- Avalon MM section + ----------------------------------------------------------------------------- + + type data_128b_vec_t is array (0 to 1023) of std_logic_vector(127 downto 0); + + type data_96b_vec_t is array (0 to 1023) of std_logic_vector( 95 downto 0); + + type data_64b_vec_t is array (0 to 1023) of std_logic_vector( 63 downto 0); + + type data_32b_vec_t is array (0 to 1023) of std_logic_vector( 31 downto 0); + + type data_16b_vec_t is array (0 to 1023) of std_logic_vector( 15 downto 0); + + type data_8b_vec_t is array (0 to 1023) of std_logic_vector( 7 downto 0); + + signal base_addr : std_logic_vector(31 downto 0) := (others => '0'); + + type mm_m_rec_t is + record + mm_burstcount : std_logic_vector(31 downto 0) ; + mm_burst : std_logic ; + mm_writedata : std_logic_vector(31 downto 0) ; + mm_address : std_logic_vector(31 downto 0) ; + mm_write : std_logic ; + mm_read : std_logic ; + mm_byteenable : std_logic_vector(3 downto 0) ; + mm_debugaccess : std_logic ; + use_waitrequest : boolean; + use_readvalid : boolean; + read_latency : natural; + end record; + + type mm_s_rec_t is + record + mm_waitrequest : std_logic; + mm_readdata : std_logic_vector(31 downto 0); + mm_readdatavalid : std_logic; + end record; + + type mm_128b_m_rec_t is + record + mm_burstcount : std_logic_vector( 31 downto 0); + mm_burst : std_logic ; + mm_writedata : std_logic_vector(127 downto 0); + mm_address : std_logic_vector( 31 downto 0); + mm_write : std_logic ; + mm_read : std_logic ; + mm_byteenable : std_logic_vector( 15 downto 0); + mm_debugaccess : std_logic ; + use_waitrequest : boolean; + use_readvalid : boolean; + read_latency : natural; + end record; + + type mm_128b_s_rec_t is + record + mm_waitrequest : std_logic; + mm_readdata : std_logic_vector(127 downto 0); + mm_readdatavalid : std_logic; + end record; + + procedure mm_m_init( signal mm_m_rec : out mm_m_rec_t; read_latency : natural := 0; use_readvalid : boolean := false; use_waitrequest : boolean := false); + procedure mm_s_init( signal mm_s_rec : out mm_s_rec_t); + + procedure mm_128b_m_init( signal mm_m_rec : out mm_128b_m_rec_t ); + procedure mm_128b_s_init( signal mm_s_rec : out mm_128b_s_rec_t ); + + procedure mm_128b_burst( addr : in std_logic_vector(31 downto 0); + size : in integer; + data : in data_128b_vec_t; + signal mm_s_rec : in mm_128b_s_rec_t; + signal mm_m_rec : out mm_128b_m_rec_t); + + procedure mm_32b_burst( addr : in std_logic_vector(31 downto 0); + size : in integer; + data : in data_32b_vec_t; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure mm_32b_write( addr : in std_logic_vector(31 downto 0); + data : in std_logic_vector(31 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure mm_16b_write( addr : in std_logic_vector(31 downto 0); + data : in std_logic_vector(15 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure mm_8b_write( addr : in std_logic_vector(31 downto 0); + data : in std_logic_vector( 7 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure mm_32b_read( addr : in std_logic_vector(31 downto 0); + data : out std_logic_vector(31 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure mm_16b_read( addr : in std_logic_vector(31 downto 0); + data : out std_logic_vector(15 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure mm_8b_read( addr : in std_logic_vector(31 downto 0); + data : out std_logic_vector( 7 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + ----------------------------------------------------------------------------- + -- Avalon Stream section + ----------------------------------------------------------------------------- + + type stm_m_rec_t is + record + stm_channel : std_logic_vector( 7 downto 0); + stm_data : std_logic_vector(31 downto 0); + stm_valid : std_logic; + stm_sop : std_logic; + stm_eop : std_logic; + end record; + + type stm_s_rec_t is + record + stm_ready : std_logic; + stm_error : std_logic_vector( 7 downto 0); + end record; + + procedure stm_m_init( signal stm_m_rec : out stm_m_rec_t ); + procedure stm_s_init( signal stm_s_rec : out stm_s_rec_t ); + + procedure stm_puncture; + + procedure stm_32b_write( len : in integer; + channel : in integer; + data_vec : in data_32b_vec_t; + signal stm_s_rec : in stm_s_rec_t; + signal stm_m_rec : out stm_m_rec_t); + + procedure stm_16b_write( len : in integer; + channel : in integer; + data_vec : in data_16b_vec_t; + signal stm_s_rec : in stm_s_rec_t; + signal stm_m_rec : out stm_m_rec_t); + + procedure stm_8b_write( len : in integer; + channel : in integer; + data_vec : in data_8b_vec_t; + signal stm_s_rec : in stm_s_rec_t; + signal stm_m_rec : out stm_m_rec_t); + + procedure stm_8b_read( signal stm_m_rec : in stm_m_rec_t; + signal stm_s_rec : out stm_s_rec_t; + data_vec : out data_8b_vec_t; + channel : out integer; + len : out integer); + + ----------------------------------------------------------------------------- + -- LVDS section + ----------------------------------------------------------------------------- + + type lvds_m_rec_t is + record + lvds_1_rx_data : std_logic_vector(9 downto 0); + lvds_1_rx_nlock : std_logic; + lvds_1_rx_clk : std_logic; + lvds_2_rx_data : std_logic_vector(9 downto 0); + lvds_2_rx_nlock : std_logic; + lvds_2_rx_clk : std_logic; + end record; + + type lvds_s_rec_t is + record + lvds_refclk : std_logic; + lvds_1_rx_npwrdn : std_logic; + lvds_1_rx_en : std_logic; + lvds_2_rx_npwrdn : std_logic; + lvds_2_rx_en : std_logic; + end record; + + procedure lvds_m_init( signal lvds_m_rec : out lvds_m_rec_t ); + procedure lvds_s_init( signal lvds_s_rec : out lvds_s_rec_t ); + procedure lvds_write( len : in integer; + data_vec : in data_8b_vec_t; + signal lvds_s_rec : in lvds_s_rec_t; + signal lvds_m_rec : out lvds_m_rec_t); + + +end avalon_verify_pkg_2; + +package body avalon_verify_pkg_2 is + + ----------------------------------------------------------------------------- + -- Avalon MM section + ----------------------------------------------------------------------------- + + procedure mm_128b_m_init( signal mm_m_rec : out mm_128b_m_rec_t ) is + begin + mm_m_rec.mm_address <= (others => '0'); + mm_m_rec.mm_byteenable <= (others => '0'); + mm_m_rec.mm_writedata <= (others => '0'); + mm_m_rec.mm_write <= '0'; + mm_m_rec.mm_read <= '0'; + mm_m_rec.mm_byteenable <= (others => '0'); + mm_m_rec.mm_debugaccess <= '0'; + mm_m_rec.mm_burstcount <= (others => '0'); + end mm_128b_m_init; + + procedure mm_128b_s_init( signal mm_s_rec : out mm_128b_s_rec_t ) is + begin + --mm_s_rec.mm_waitrequest <= '0'; + --mm_s_rec.mm_readdata <= (others => '0'); + --mm_s_rec.mm_readdatavalid <= '0'; + end mm_128b_s_init; + + procedure mm_m_init( signal mm_m_rec : out mm_m_rec_t; read_latency : natural := 0; use_readvalid : boolean := false; use_waitrequest : boolean := false) is + begin + mm_m_rec.mm_address <= (others => '0'); + mm_m_rec.mm_byteenable <= (others => '0'); + mm_m_rec.mm_writedata <= (others => '0'); + mm_m_rec.mm_write <= '0'; + mm_m_rec.mm_read <= '0'; + mm_m_rec.mm_byteenable <= (others => '0'); + mm_m_rec.mm_debugaccess <= '0'; + mm_m_rec.mm_burstcount <= (others => '0'); + mm_m_rec.use_waitrequest <= use_waitrequest; + mm_m_rec.use_readvalid <= use_readvalid; + mm_m_rec.read_latency <= read_latency; + end mm_m_init; + + procedure mm_s_init( signal mm_s_rec : out mm_s_rec_t) is + begin + mm_s_rec.mm_waitrequest <= '0'; + mm_s_rec.mm_readdata <= (others => '0'); + mm_s_rec.mm_readdatavalid <= '0'; + end mm_s_init; + + procedure mm_128b_burst( addr : in std_logic_vector(31 downto 0); + size : in integer; + data : in data_128b_vec_t; + signal mm_s_rec : in mm_128b_s_rec_t; + signal mm_m_rec : out mm_128b_m_rec_t) is + begin + wait until rising_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + for i in 0 to size-1 loop + if i = 0 then + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_byteenable <= x"1111"; + mm_m_rec.mm_writedata <= data(i); + mm_m_rec.mm_write <= '1'; + mm_m_rec.mm_burst <= '1'; + mm_m_rec.mm_burstcount <= std_logic_vector(to_unsigned(size,32)); + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= x"0000"; + mm_m_rec.mm_write <= '0'; + mm_m_rec.mm_burst <= '0'; + else + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_byteenable <= x"1111"; + mm_m_rec.mm_writedata <= data(i); + mm_m_rec.mm_write <= '1'; + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= x"0000"; + mm_m_rec.mm_write <= '0'; + end if; + end loop; -- i + wait until rising_edge(clk_clk); + end mm_128b_burst; + + procedure mm_32b_burst( addr : in std_logic_vector(31 downto 0); + size : in integer; + data : in data_32b_vec_t; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + begin + wait until rising_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + for i in 0 to size-1 loop + if i = 0 then + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_byteenable <= "1111"; + mm_m_rec.mm_writedata <= data(i); + mm_m_rec.mm_write <= '1'; + mm_m_rec.mm_burst <= '1'; + mm_m_rec.mm_burstcount <= std_logic_vector(to_unsigned(size,32)); + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= "0000"; + mm_m_rec.mm_write <= '0'; + mm_m_rec.mm_burst <= '0'; + else + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_byteenable <= "1111"; + mm_m_rec.mm_writedata <= data(i); + mm_m_rec.mm_write <= '1'; + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= "0000"; + mm_m_rec.mm_write <= '0'; + end if; + end loop; -- i + wait until rising_edge(clk_clk); + end mm_32b_burst; + + procedure mm_32b_write( addr : in std_logic_vector(31 downto 0); + data : in std_logic_vector(31 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + begin + wait until rising_edge(clk_clk); + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_byteenable <= "1111"; + mm_m_rec.mm_writedata <= data; + mm_m_rec.mm_write <= '1'; + wait until falling_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= "0000"; + mm_m_rec.mm_write <= '0'; + end mm_32b_write; + + procedure mm_16b_write( addr : in std_logic_vector(31 downto 0); + data : in std_logic_vector(15 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + variable my_addr : std_logic_vector(31 downto 0) := (others=>'0'); + begin + my_addr := addr; + if addr(1) = '1' then + my_addr := std_logic_vector(unsigned(my_addr)+2); + end if; + wait until rising_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_writedata <= data & data; + if addr(1) = '0' then + mm_m_rec.mm_byteenable <= "0011"; + else + mm_m_rec.mm_byteenable <= "1100"; + end if; + mm_m_rec.mm_write <= '1'; + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= "0000"; + mm_m_rec.mm_write <= '0'; + wait until rising_edge(clk_clk); + end mm_16b_write; + + procedure mm_8b_write( addr : in std_logic_vector(31 downto 0); + data : in std_logic_vector( 7 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + begin + wait until rising_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_writedata <= data & data & data & data; + if addr(1 downto 0) = "00" then + mm_m_rec.mm_byteenable <= "0001"; + elsif addr(1 downto 0) = "01" then + mm_m_rec.mm_byteenable <= "0010"; + elsif addr(1 downto 0) = "10" then + mm_m_rec.mm_byteenable <= "0100"; + else + mm_m_rec.mm_byteenable <= "1000"; + end if; + mm_m_rec.mm_write <= '1'; + wait until rising_edge(clk_clk); + mm_m_rec.mm_byteenable <= "0000"; + mm_m_rec.mm_write <= '0'; + wait until rising_edge(clk_clk); + end mm_8b_write; + + procedure mm_32b_read( addr : in std_logic_vector(31 downto 0); + data : out std_logic_vector(31 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + begin + wait until rising_edge(clk_clk); + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_read <= '1'; + wait until falling_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + wait until rising_edge(clk_clk); + mm_m_rec.mm_read <= '0'; + if(mm_m_rec.use_waitrequest = false) then + for n in 1 to mm_m_rec.read_latency loop + wait until rising_edge(clk_clk); + end loop; -- n + end if; + if(mm_m_rec.use_readvalid = true) then + if(mm_s_rec.mm_readdatavalid = '0') then + wait until mm_s_rec.mm_readdatavalid = '1'; + end if; + end if; + wait until falling_edge(clk_clk); + data := mm_s_rec.mm_readdata; + end mm_32b_read; + + procedure mm_16b_read( addr : in std_logic_vector(31 downto 0); + data : out std_logic_vector(15 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + begin + wait until rising_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_read <= '1'; + wait until rising_edge(clk_clk); + mm_m_rec.mm_read <= '0'; + wait until rising_edge(mm_s_rec.mm_readdatavalid); + data := mm_s_rec.mm_readdata(15 downto 0); + end mm_16b_read; + + procedure mm_8b_read( addr : in std_logic_vector(31 downto 0); + data : out std_logic_vector( 7 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + begin + wait until rising_edge(clk_clk); + if(mm_m_rec.use_waitrequest = true and mm_s_rec.mm_waitrequest = '1') then + wait until falling_edge(mm_s_rec.mm_waitrequest); + end if; + mm_m_rec.mm_address <= addr or base_addr; + mm_m_rec.mm_read <= '1'; + wait until rising_edge(clk_clk); + mm_m_rec.mm_read <= '0'; + wait until rising_edge(mm_s_rec.mm_readdatavalid); + data := mm_s_rec.mm_readdata( 7 downto 0); + end mm_8b_read; + + ----------------------------------------------------------------------------- + -- Avalon Stream section + ----------------------------------------------------------------------------- + + procedure stm_m_init( signal stm_m_rec : out stm_m_rec_t ) is + begin + stm_m_rec.stm_channel <= (others => '0'); + stm_m_rec.stm_data <= (others => '0'); + stm_m_rec.stm_valid <= '0'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + end stm_m_init; + + procedure stm_s_init( signal stm_s_rec : out stm_s_rec_t ) is + begin + stm_s_rec.stm_ready <= '0'; + stm_s_rec.stm_error <= (others => '0'); + end stm_s_init; + + procedure stm_puncture is + variable loop_max : integer; + begin + loop_max := RV.RandInt(int_stmBusPunctureMin,int_stmBusPunctureMax); + if loop_max > 0 then + for i in 1 to loop_max loop + wait until rising_edge(clk_clk); + end loop; -- i + end if; + end stm_puncture; + + procedure stm_32b_write( len : in integer; + channel : in integer; + data_vec : in data_32b_vec_t; + signal stm_s_rec : in stm_s_rec_t; + signal stm_m_rec : out stm_m_rec_t) is + variable loop_max : integer; + begin + wait until rising_edge(clk_clk); + if stm_s_rec.stm_ready = '0' then + wait until rising_edge(stm_s_rec.stm_ready); + end if; + wait until rising_edge(clk_clk); + for i in 1 to len loop + stm_m_rec.stm_channel <= std_logic_vector(to_unsigned(channel, 8)); + stm_m_rec.stm_data <= data_vec(i-1); + stm_m_rec.stm_valid <= '1'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + if i = 1 then + stm_m_rec.stm_sop <= '1'; + end if; + if i = len then + stm_m_rec.stm_eop <= '1'; + end if; + wait until rising_edge(clk_clk); + stm_m_rec.stm_valid <= '0'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + + stm_puncture; + end loop; -- i + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + stm_m_rec.stm_valid <= '0'; + end stm_32b_write; + + procedure stm_16b_write( len : in integer; + channel : in integer; + data_vec : in data_16b_vec_t; + signal stm_s_rec : in stm_s_rec_t; + signal stm_m_rec : out stm_m_rec_t) is + variable loop_max : integer; + begin + wait until rising_edge(clk_clk); + if stm_s_rec.stm_ready = '0' then + wait until rising_edge(stm_s_rec.stm_ready); + end if; + wait until rising_edge(clk_clk); + for i in 1 to len loop + stm_m_rec.stm_channel <= std_logic_vector(to_unsigned(channel, 8)); + stm_m_rec.stm_data <= x"0000" & data_vec(i-1); + stm_m_rec.stm_valid <= '1'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + if i = 1 then + stm_m_rec.stm_sop <= '1'; + end if; + if i = len then + stm_m_rec.stm_eop <= '1'; + end if; + wait until rising_edge(clk_clk); + stm_m_rec.stm_valid <= '0'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + + stm_puncture; + + end loop; -- i + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + stm_m_rec.stm_valid <= '0'; + end stm_16b_write; + + procedure stm_8b_write( len : in integer; + channel : in integer; + data_vec : in data_8b_vec_t; + signal stm_s_rec : in stm_s_rec_t; + signal stm_m_rec : out stm_m_rec_t) is + variable loop_max : integer; + begin + wait until rising_edge(clk_clk); + if stm_s_rec.stm_ready = '0' then + wait until rising_edge(stm_s_rec.stm_ready); + end if; + wait until rising_edge(clk_clk); + for i in 1 to len loop + stm_m_rec.stm_channel <= std_logic_vector(to_unsigned(channel, 8)); + stm_m_rec.stm_data <= x"000000" & data_vec(i-1); + stm_m_rec.stm_valid <= '1'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + if i = 1 then + stm_m_rec.stm_sop <= '1'; + end if; + if i = len then + stm_m_rec.stm_eop <= '1'; + end if; + wait until rising_edge(clk_clk); + stm_m_rec.stm_valid <= '0'; + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + + stm_puncture; + + end loop; -- i + stm_m_rec.stm_sop <= '0'; + stm_m_rec.stm_eop <= '0'; + stm_m_rec.stm_valid <= '0'; + end stm_8b_write; + + procedure stm_8b_read( signal stm_m_rec : in stm_m_rec_t; + signal stm_s_rec : out stm_s_rec_t; + data_vec : out data_8b_vec_t; + channel : out integer; + len : out integer) is + variable tmp_len : integer := 0; + begin + wait until rising_edge(clk_clk); + if stm_m_rec.stm_sop = '0' then + wait until rising_edge(stm_m_rec.stm_sop); + end if; + channel := to_integer(unsigned(stm_m_rec.stm_data)); + while stm_m_rec.stm_eop = '0' loop + tmp_len := tmp_len + 1; + wait until rising_edge(clk_clk); + if stm_m_rec.stm_valid = '1' then + data_vec(tmp_len-1) := stm_m_rec.stm_data(7 downto 0); + end if; + end loop; + len := tmp_len; + end stm_8b_read; + + ----------------------------------------------------------------------------- + -- LVDS section + ----------------------------------------------------------------------------- + + procedure lvds_m_init( signal lvds_m_rec : out lvds_m_rec_t ) is + begin + lvds_m_rec.lvds_1_rx_data <= (others => '0'); + lvds_m_rec.lvds_1_rx_nlock <= '0'; + lvds_m_rec.lvds_1_rx_clk <= '0'; + lvds_m_rec.lvds_2_rx_data <= (others => '0'); + lvds_m_rec.lvds_2_rx_nlock <= '0'; + lvds_m_rec.lvds_2_rx_clk <= '0'; + end lvds_m_init; + + procedure lvds_s_init( signal lvds_s_rec : out lvds_s_rec_t ) is + begin + lvds_s_rec.lvds_refclk <= '0'; + lvds_s_rec.lvds_1_rx_npwrdn <= '0'; + lvds_s_rec.lvds_1_rx_en <= '0'; + lvds_s_rec.lvds_2_rx_npwrdn <= '0'; + lvds_s_rec.lvds_2_rx_en <= '0'; + end lvds_s_init; + + procedure lvds_write( len : in integer; + data_vec : in data_8b_vec_t; + signal lvds_s_rec : in lvds_s_rec_t; + signal lvds_m_rec : out lvds_m_rec_t) is + variable tog : std_logic := '1'; + variable lvds_crc : std_logic_vector(7 downto 0) := x"00"; + variable lvds_tmp : std_logic_vector(7 downto 0) := x"00"; + constant STX : std_logic_vector(7 downto 0) := x"02"; + constant ETX : std_logic_vector(7 downto 0) := x"03"; + begin + wait until rising_edge(lvds_s_rec.lvds_refclk); + lvds_m_rec.lvds_1_rx_data <= '1' & '0' & STX; + wait until rising_edge(lvds_s_rec.lvds_refclk); + lvds_m_rec.lvds_1_rx_data <= '0' & '0' & std_logic_vector(to_unsigned(len / 256,8)); + wait until rising_edge(lvds_s_rec.lvds_refclk); + lvds_m_rec.lvds_1_rx_data <= '1' & '0' & std_logic_vector(to_unsigned(len mod 256,8)); + wait until rising_edge(lvds_s_rec.lvds_refclk); + for i in 0 to len-1 loop + tog := not tog; + lvds_crc := lvds_crc xor data_vec(i); + lvds_m_rec.lvds_1_rx_data <= tog & '0' & data_vec(i); + wait until rising_edge(lvds_s_rec.lvds_refclk); + end loop; -- i + tog := not tog; + lvds_m_rec.lvds_1_rx_data <= tog & '0' & lvds_crc; + wait until rising_edge(lvds_s_rec.lvds_refclk); + tog := not tog; + lvds_m_rec.lvds_1_rx_data <= tog & '0' & ETX; + wait until rising_edge(lvds_s_rec.lvds_refclk); + if tog = '1' then + lvds_m_rec.lvds_1_rx_data <= (others => '0'); + wait until rising_edge(lvds_s_rec.lvds_refclk); + end if; + end lvds_write; + + +end avalon_verify_pkg_2; diff --git a/generic_ip/fire_pulse_manager/5/sim/sim_fpm.do b/generic_ip/fire_pulse_manager/5/sim/sim_fpm.do index 980d57f..bdeb8ec 100644 --- a/generic_ip/fire_pulse_manager/5/sim/sim_fpm.do +++ b/generic_ip/fire_pulse_manager/5/sim/sim_fpm.do @@ -98,7 +98,10 @@ vcom -2008 -work $WORKLIB $COMMON_PATH/test/common_test_pkg.vhd vcom -2008 -work $WORKLIB $COMMON_PATH/test/log_pkg.vhd # Compile the VHDL packages that support bus protocols, memory mapped registers and functional procedures -vcom -2008 -work $WORKLIB $COMMON_PATH/test/avalon_verify_pkg.vhd +vcom -2008 -work $WORKLIB $COMMON_PATH/test/avalon_verify_pkg_2.vhd + +# Testbench support package +vcom -2008 -work $WORKLIB $TB_PATH/fire_pulse_manager_5_tb_pkg.vhd # Testbench vcom -2008 -work $WORKLIB $TB_PATH/fire_pulse_manager_5_tb.vhd diff --git a/generic_ip/fire_pulse_manager/5/sim/wave_fpm.do b/generic_ip/fire_pulse_manager/5/sim/wave_fpm.do index ea34572..bb7d5d7 100644 --- a/generic_ip/fire_pulse_manager/5/sim/wave_fpm.do +++ b/generic_ip/fire_pulse_manager/5/sim/wave_fpm.do @@ -1,6 +1,6 @@ onerror {resume} quietly WaveActivateNextPane {} 0 -add wave -noupdate -group TB /fire_pulse_manager_5_tb/ch_offset +add wave -noupdate -group TB -expand /fire_pulse_manager_5_tb/ch_offset add wave -noupdate -group TB /fire_pulse_manager_5_tb/reset_n add wave -noupdate -group TB /fire_pulse_manager_5_tb/clk add wave -noupdate -group TB /fire_pulse_manager_5_tb/rx_clk @@ -14,17 +14,18 @@ add wave -noupdate -group TB /fire_pulse_manager_5_tb/avs_read add wave -noupdate -group TB /fire_pulse_manager_5_tb/avs_waitrequest add wave -noupdate -group TB /fire_pulse_manager_5_tb/avs_readdata add wave -noupdate -group TB /fire_pulse_manager_5_tb/init_tx -add wave -noupdate -group TB /fire_pulse_manager_5_tb/pd_in -add wave -noupdate -group TB /fire_pulse_manager_5_tb/pd_spy add wave -noupdate -group TB /fire_pulse_manager_5_tb/inc_pos add wave -noupdate -group TB /fire_pulse_manager_5_tb/dec_pos -add wave -noupdate -group TB -radix hexadecimal /fire_pulse_manager_5_tb/abs_position -add wave -noupdate -group TB /fire_pulse_manager_5_tb/abs_spy +add wave -noupdate -group TB -radix unsigned /fire_pulse_manager_5_tb/abs_position add wave -noupdate -group TB /fire_pulse_manager_5_tb/tx_data -add wave -noupdate -group TB /fire_pulse_manager_5_tb/abs_position_d -add wave -noupdate -group TB /fire_pulse_manager_5_tb/dir_in add wave -noupdate -group TB /fire_pulse_manager_5_tb/swathe_cnt -add wave -noupdate -group TB /fire_pulse_manager_5_tb/swathe_pos +add wave -noupdate -group TB /fire_pulse_manager_5_tb/enc_p1 +add wave -noupdate -group TB /fire_pulse_manager_5_tb/enc_p2 +add wave -noupdate -group TB /fire_pulse_manager_5_tb/pd +add wave -noupdate -group TB /fire_pulse_manager_5_tb/seb_epd_enc_p1 +add wave -noupdate -group TB /fire_pulse_manager_5_tb/seb_epd_enc_p2 +add wave -noupdate -group TB /fire_pulse_manager_5_tb/seb_epd_pd +add wave -noupdate -group TB /fire_pulse_manager_5_tb/seb_epd_link_out add wave -noupdate -group TB /fire_pulse_manager_5_tb/end_of_swathe add wave -noupdate -group TB /fire_pulse_manager_5_tb/test_completed add wave -noupdate -group TB /fire_pulse_manager_5_tb/running @@ -41,6 +42,129 @@ add wave -noupdate -group TB /fire_pulse_manager_5_tb/sel_slave_0 add wave -noupdate -group TB /fire_pulse_manager_5_tb/sel_slave_1 add wave -noupdate -group TB /fire_pulse_manager_5_tb/pd_cnt add wave -noupdate -group TB /fire_pulse_manager_5_tb/fp_cnt +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/reset_n +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/clk +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/rx_clk +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pof_rx +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pof_tx +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pof_iso_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/seb_epd_enc_p1 +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/seb_epd_enc_p2 +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/seb_epd_pd +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/seb_epd_link_out +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/fire_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/start_of_image +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dp_dir_out +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/abs_pos_out +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/print_start +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/mon_pt +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ins_fpm_irq_0 +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ins_fpm_irq_1 +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ins_fpm_irq_2 +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ins_fpm_irq_3 +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/avs_address +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/avs_write +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/avs_writedata +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/avs_read +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/avs_waitrequest +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/avs_readdata +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/reset_n_i +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_addr +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_write_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ctrl_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ctrl_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ctrl_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ctrl_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pg_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pg_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pg_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pg_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_diag_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_diag_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_diag_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_diag_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_log_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_log_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_log_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_log_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ie_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ie_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ie_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ie_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ems_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ems_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ems_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_ems_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pof_write_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pof_read_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pof_read_valid +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/cs_pof_read_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/enable_rx +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/uart_regen_bypass +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/max_error_flag +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/rx_watchdog +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/rx_watchdog_en +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/rx_watchdog_clr +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/print_start_i +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dw_src +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/error_rate_thres +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/parity_err_cnt +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/skip_pos_cnt +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/mon_point_src +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dw_pulse_width +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/fine_time +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/coarse_time +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/init +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/remote_init +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dp_dir +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/set_pos_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/enc_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pd_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pd_pulse_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pd_pulse_pof +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pd_ems +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/inc_pos +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/inc_pos_pof +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/inc_pos_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/inc_pos_ems +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dec_pos +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dec_pos_pof +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dec_pos_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dec_pos_ems +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/abs_pos +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/abs_pos_pof +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/abs_pos_ems +add wave -noupdate -group {FPM top} -radix decimal /fire_pulse_manager_5_tb/iDUT/abs_pos_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pd_pulse_mux +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/enc_p1_mux +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/enc_p2_mux +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/enc_p1_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/enc_p2_ie +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pof_tx_data +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dw_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dw_pulse_i +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/rst_dw_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/set_dw_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/dw_pulse_cnt +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ch_pd +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ch_pulse_out +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ch_raw_pulse +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ch_mask +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ch_start_of_image +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/start_of_image_i +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/fire_pulse_i +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/src_sel +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/vel_meas +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/vel_sampling_per +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/one_pps +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ext_fp_det +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/ext_fp_gen +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/pof_rx_regen +add wave -noupdate -group {FPM top} /fire_pulse_manager_5_tb/iDUT/log_data_src add wave -noupdate -group {POF RX} /fire_pulse_manager_5_tb/iDUT/gPOF/iPOF_RX/reset_n add wave -noupdate -group {POF RX} /fire_pulse_manager_5_tb/iDUT/gPOF/iPOF_RX/clk add wave -noupdate -group {POF RX} /fire_pulse_manager_5_tb/iDUT/gPOF/iPOF_RX/init @@ -383,8 +507,73 @@ add wave -noupdate -group POF_Tx /fire_pulse_manager_5_tb/iPOF_TX/keepalive_peri add wave -noupdate -group POF_Tx /fire_pulse_manager_5_tb/iPOF_TX/init_blocked_period add wave -noupdate -group POF_Tx /fire_pulse_manager_5_tb/iPOF_TX/fifo_level add wave -noupdate -group POF_Tx /fire_pulse_manager_5_tb/iPOF_TX/fifo_level_max +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/reset_n +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/clk +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/src_sel +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/uart_regen_bypass +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/enable_rx +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/error_rate_thres +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/max_error_flag +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/rx_watchdog +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/rx_watchdog_en +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/rx_watchdog_clr +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/parity_err_cnt +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/skip_pos_cnt +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/mon_point_src +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/mon_points +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/coarse_time +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fine_time +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/one_pps +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/ext_fp_det +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/ext_fp_gen +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/dw_src +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/dw_pulse_width +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/ins_fpm_irq_0 +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/avs_address +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/avs_write +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/avs_writedata +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/avs_read +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/avs_readdatavalid +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/avs_readdata +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/enable_rx_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fine_time_wrap +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/time_ld_en +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/rx_watchdog_en_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/rx_watchdog_clr_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/uart_regen_bypass_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/upd_min_pos_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/upd_max_pos_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fpm_init_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fpm_init_d +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fpm_init_start +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fpm_init_done +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fpm_init_done_flag +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fpm_init_pulse +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq_src +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq_src_d +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq_en +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq_mask +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq_val +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/irq_clr +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/src_sel_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/dw_src_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/mp_sel0 +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/mp_sel1 +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/mp_sel2 +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/mp_sel3 +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/bit_div +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/error_rate_thres_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/init_cnt +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/ext_fp_det_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/ext_fp_gen_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/dw_pulse_width_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fine_time_init +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/fine_time_i +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/coarse_time_init +add wave -noupdate -group {FPM Ctrl} /fire_pulse_manager_5_tb/iDUT/iCTRL/coarse_time_i TreeUpdate [SetDefaultTree] -WaveRestoreCursors {{Cursor 1} {16135000 ps} 0} +WaveRestoreCursors {{Cursor 1} {8565000 ps} 0} quietly wave cursor active 1 configure wave -namecolwidth 223 configure wave -valuecolwidth 100 @@ -400,4 +589,4 @@ configure wave -griddelta 40 configure wave -timeline 0 configure wave -timelineunits ps update -WaveRestoreZoom {0 ps} {193574912 ps} +WaveRestoreZoom {200417556 ps} {249051708 ps} diff --git a/generic_ip/fire_pulse_manager/5/src/fire_pulse_5_pkg.vhd b/generic_ip/fire_pulse_manager/5/src/fire_pulse_5_pkg.vhd index ae43edb..6f1b89b 100644 --- a/generic_ip/fire_pulse_manager/5/src/fire_pulse_5_pkg.vhd +++ b/generic_ip/fire_pulse_manager/5/src/fire_pulse_5_pkg.vhd @@ -6,7 +6,7 @@ -- Author : Gianmarco Girau -- Company : Global Inkjet Systems -- Created : 2017-09-08 --- Last update: 2019-12-18 +-- Last update: 2020-01-03 -- SVN ID : Git -- Standard : VHDL'08 ------------------------------------------------------------------------------- @@ -25,17 +25,17 @@ package fire_pulse_5_pkg is -- Inner block mapping ----------------------------------------------------------------------------- - constant blk_size : integer := 2048; + constant BLK_SIZE : integer := 2048; - constant blk_num : integer := 10; -- number of sub-blocks with dedicated - -- C&S registers + constant BLK_NUM : integer := 10; -- number of sub-blocks with dedicated + -- C&S registers - constant fp_ctrl_id : natural := 0; -- Block ID for the Fire-Pulse-Mang Controller - constant diag_blk_id : natural := 1; -- Block ID for the Diagnostic Block - constant log_blk_id : natural := 2; -- Block ID for the Event Logger - constant int_enc_id : natural := 3; -- Block ID for the Internal Encoder Block - constant ems_blk_id : natural := 4; -- Block ID for the EMS block - constant pof_blk_id : natural := 5; -- Block ID for the POF output interface - constant pg_ch_id : natural := 6; -- Block ID for Pulse-Generator + constant FP_CTRL_ID : natural := 0; -- Block ID for the Fire-Pulse-Mang Controller + constant DIAG_BLK_ID : natural := 1; -- Block ID for the Diagnostic Block + constant LOG_BLK_ID : natural := 2; -- Block ID for the Event Logger + constant INT_ENC_ID : natural := 3; -- Block ID for the Internal Encoder Block + constant EMS_BLK_ID : natural := 4; -- Block ID for the EMS block + constant POF_BLK_ID : natural := 5; -- Block ID for the POF output interface + constant PG_CH_ID : natural := 6; -- Block ID for Pulse-Generator end package fire_pulse_5_pkg; diff --git a/generic_ip/fire_pulse_manager/5/src/fire_pulse_ctrl_5.vhd b/generic_ip/fire_pulse_manager/5/src/fire_pulse_ctrl_5.vhd index f3474cb..d89cb71 100644 --- a/generic_ip/fire_pulse_manager/5/src/fire_pulse_ctrl_5.vhd +++ b/generic_ip/fire_pulse_manager/5/src/fire_pulse_ctrl_5.vhd @@ -6,7 +6,7 @@ -- Author : Gianmarco Girau -- Company : Global Inkjet Systems -- Created : 2017-09-06 --- Last update: 2019-12-18 +-- Last update: 2020-01-02 -- SVN ID : Git -- Standard : VHDL'08 ------------------------------------------------------------------------------- @@ -28,10 +28,7 @@ entity fire_pulse_ctrl_5 is clk : in std_logic; src_sel : out std_logic_vector(3 downto 0); uart_regen_bypass : out std_logic; - upd_max_pos : out std_logic; - upd_min_pos : out std_logic; enable_rx : out std_logic; - uart_bit_div : out std_logic_vector(3 downto 0); error_rate_thres : out std_logic_vector(7 downto 0); max_error_flag : in std_logic; rx_watchdog : in std_logic; @@ -188,10 +185,6 @@ begin enable_rx <= enable_rx_i; uart_regen_bypass <= uart_regen_bypass_i; - uart_bit_div <= bit_div; - upd_max_pos <= upd_max_pos_i; - upd_min_pos <= upd_min_pos_i; - error_rate_thres <= error_rate_thres_i; rx_watchdog_en <= rx_watchdog_en_i; rx_watchdog_clr <= rx_watchdog_clr_i; @@ -207,9 +200,6 @@ begin src_sel_i <= "0000"; enable_rx_i <= '0'; uart_regen_bypass_i <= '0'; - upd_max_pos_i <= '0'; - upd_min_pos_i <= '0'; - bit_div <= "0100"; error_rate_thres_i <= X"0A"; rx_watchdog_en_i <= '1'; rx_watchdog_clr_i <= '0'; @@ -222,6 +212,8 @@ begin time_ld_en <= '0'; ext_fp_det_i <= X"0010"; ext_fp_gen_i <= X"0020"; + dw_src_i <= (others => '0'); + dw_pulse_width_i <= X"000A"; elsif (clk = '1' and clk'event) then -- CTRL registers if (avs_write = '1') then @@ -233,9 +225,6 @@ begin when POF_RX_CTRL => enable_rx_i <= avs_writedata(0); uart_regen_bypass_i <= avs_writedata(1); - upd_max_pos_i <= avs_writedata(2); - upd_min_pos_i <= avs_writedata(3); - bit_div <= avs_writedata(7 downto 4); when MON_PT_CTRL_REG => mp_sel0 <= avs_writedata(3 downto 0); mp_sel1 <= avs_writedata(7 downto 4); @@ -276,7 +265,7 @@ begin when SRC_SEL_REG => avs_readdata <= 28x"0" & src_sel_i; when POF_RX_CTRL => - avs_readdata <= X"000000" & bit_div & upd_min_pos_i & upd_max_pos_i & uart_regen_bypass_i & enable_rx_i; + avs_readdata <= (0 => enable_rx_i, 1 => uart_regen_bypass_i, others => '0'); when MON_PT_CTRL_REG => avs_readdata <= X"0000" & mp_sel3 & mp_sel2 & mp_sel1 & mp_sel0; when COARSE_TIME_INIT_REG => diff --git a/generic_ip/fire_pulse_manager/5/src/fire_pulse_manager_5.vhd b/generic_ip/fire_pulse_manager/5/src/fire_pulse_manager_5.vhd index e7d44da..6962afe 100644 --- a/generic_ip/fire_pulse_manager/5/src/fire_pulse_manager_5.vhd +++ b/generic_ip/fire_pulse_manager/5/src/fire_pulse_manager_5.vhd @@ -6,7 +6,7 @@ -- Author : Gianmarco Girau -- Company : Global Inkjet Systems -- Created : 2017-09-06 --- Last update: 2019-12-18 +-- Last update: 2020-01-03 -- SVN ID : Git -- Standard : VHDL'08 ------------------------------------------------------------------------------- @@ -85,11 +85,11 @@ architecture rtl of fire_pulse_manager_5 is signal reset_n_i : std_logic; -- signal cs_addr : std_logic_vector(10 downto 0); - signal cs_write_en : std_logic_vector(blk_num - 1 downto 0); + signal cs_write_en : std_logic_vector(BLK_NUM - 1 downto 0); signal cs_write_data : std_logic_vector(31 downto 0); - signal cs_read_en : std_logic_vector(blk_num - 1 downto 0); - signal cs_read_valid : std_logic_vector(blk_num - 1 downto 0); - signal cs_read_data : std_logic_vector(32 * blk_num - 1 downto 0); + signal cs_read_en : std_logic_vector(BLK_NUM - 1 downto 0); + signal cs_read_valid : std_logic_vector(BLK_NUM - 1 downto 0); + signal cs_read_data : std_logic_vector(32 * BLK_NUM - 1 downto 0); -- signal cs_ctrl_write_en : std_logic; signal cs_ctrl_read_en : std_logic; @@ -213,7 +213,7 @@ begin iCS_BUS_ITF : entity work.cs_bus_ift generic map( - blk_num => blk_num) + BLK_NUM => BLK_NUM) port map( rstN => reset_n_i, clk => clk, @@ -230,44 +230,44 @@ begin cs_rv => cs_read_valid, cs_rd_data => cs_read_data); - cs_ctrl_write_en <= cs_write_en(fp_ctrl_id); - cs_diag_write_en <= cs_write_en(diag_blk_id); - cs_log_write_en <= cs_write_en(log_blk_id); - cs_ie_write_en <= cs_write_en(int_enc_id); - cs_ems_write_en <= cs_write_en(ems_blk_id); - cs_pof_write_en <= cs_write_en(pof_blk_id); + cs_ctrl_write_en <= cs_write_en(FP_CTRL_ID); + cs_diag_write_en <= cs_write_en(DIAG_BLK_ID); + cs_log_write_en <= cs_write_en(LOG_BLK_ID); + cs_ie_write_en <= cs_write_en(INT_ENC_ID); + cs_ems_write_en <= cs_write_en(EMS_BLK_ID); + cs_pof_write_en <= cs_write_en(POF_BLK_ID); cs_pg_write_en_g : for i in 1 to CH_NUM generate - cs_pg_write_en(i - 1) <= cs_write_en(pg_ch_id + i - 1); + cs_pg_write_en(i - 1) <= cs_write_en(PG_CH_ID + i - 1); end generate; - cs_ctrl_read_en <= cs_read_en(fp_ctrl_id); - cs_diag_read_en <= cs_read_en(diag_blk_id); - cs_log_read_en <= cs_read_en(log_blk_id); - cs_ie_read_en <= cs_read_en(int_enc_id); - cs_ems_read_en <= cs_read_en(ems_blk_id); - cs_pof_read_en <= cs_read_en(pof_blk_id); + cs_ctrl_read_en <= cs_read_en(FP_CTRL_ID); + cs_diag_read_en <= cs_read_en(DIAG_BLK_ID); + cs_log_read_en <= cs_read_en(LOG_BLK_ID); + cs_ie_read_en <= cs_read_en(INT_ENC_ID); + cs_ems_read_en <= cs_read_en(EMS_BLK_ID); + cs_pof_read_en <= cs_read_en(POF_BLK_ID); cs_pg_read_en_g : for i in 1 to CH_NUM generate - cs_pg_read_en(i - 1) <= cs_read_en(pg_ch_id + i - 1); + cs_pg_read_en(i - 1) <= cs_read_en(PG_CH_ID + i - 1); end generate; - cs_read_valid(fp_ctrl_id) <= cs_ctrl_read_valid; - cs_read_valid(diag_blk_id) <= cs_diag_read_valid; - cs_read_valid(log_blk_id) <= cs_log_read_valid; - cs_read_valid(int_enc_id) <= cs_ie_read_valid; - cs_read_valid(ems_blk_id) <= cs_ems_read_valid; - cs_read_valid(pof_blk_id) <= cs_pof_read_valid; + cs_read_valid(FP_CTRL_ID) <= cs_ctrl_read_valid; + cs_read_valid(DIAG_BLK_ID) <= cs_diag_read_valid; + cs_read_valid(LOG_BLK_ID) <= cs_log_read_valid; + cs_read_valid(INT_ENC_ID) <= cs_ie_read_valid; + cs_read_valid(EMS_BLK_ID) <= cs_ems_read_valid; + cs_read_valid(POF_BLK_ID) <= cs_pof_read_valid; cs_read_valid_pg_g : for i in 1 to CH_NUM generate - cs_read_valid(pg_ch_id + i - 1) <= cs_pg_read_valid(i - 1); + cs_read_valid(PG_CH_ID + i - 1) <= cs_pg_read_valid(i - 1); end generate; - cs_read_data(31 + 32 * fp_ctrl_id downto 32 * fp_ctrl_id) <= cs_ctrl_read_data; - cs_read_data(31 + 32 * diag_blk_id downto 32 * diag_blk_id) <= cs_diag_read_data; - cs_read_data(31 + 32 * log_blk_id downto 32 * log_blk_id) <= cs_log_read_data; - cs_read_data(31 + 32 * int_enc_id downto 32 * int_enc_id) <= cs_ie_read_data; - cs_read_data(31 + 32 * ems_blk_id downto 32 * ems_blk_id) <= cs_ems_read_data; - cs_read_data(31 + 32 * pof_blk_id downto 32 * pof_blk_id) <= cs_pof_read_data; + cs_read_data(31 + 32 * FP_CTRL_ID downto 32 * FP_CTRL_ID) <= cs_ctrl_read_data; + cs_read_data(31 + 32 * DIAG_BLK_ID downto 32 * DIAG_BLK_ID) <= cs_diag_read_data; + cs_read_data(31 + 32 * LOG_BLK_ID downto 32 * LOG_BLK_ID) <= cs_log_read_data; + cs_read_data(31 + 32 * INT_ENC_ID downto 32 * INT_ENC_ID) <= cs_ie_read_data; + cs_read_data(31 + 32 * EMS_BLK_ID downto 32 * EMS_BLK_ID) <= cs_ems_read_data; + cs_read_data(31 + 32 * POF_BLK_ID downto 32 * POF_BLK_ID) <= cs_pof_read_data; cs_read_data_pg_g : for i in 1 to CH_NUM generate - cs_read_data(31 + 32 * (pg_ch_id + i - 1) downto 32 * (pg_ch_id + i - 1)) <= cs_pg_read_data(31 + 32 * (i - 1) downto 32 * (i - 1)); + cs_read_data(31 + 32 * (PG_CH_ID + i - 1) downto 32 * (PG_CH_ID + i - 1)) <= cs_pg_read_data(31 + 32 * (i - 1) downto 32 * (i - 1)); end generate; ----------------------------------------------------------------------------- @@ -280,10 +280,7 @@ begin clk => clk, src_sel => src_sel, uart_regen_bypass => uart_regen_bypass, - upd_max_pos => open, - upd_min_pos => open, enable_rx => enable_rx, - uart_bit_div => open, error_rate_thres => error_rate_thres, max_error_flag => max_error_flag, rx_watchdog => rx_watchdog, diff --git a/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb.vhd b/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb.vhd index 6f3df34..41a403a 100644 --- a/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb.vhd +++ b/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb.vhd @@ -6,7 +6,7 @@ -- Author : Christos Spirotis -- Company : Global Inkjet Systems -- Created : 2018-08-10 --- Last update: 2019-12-18 +-- Last update: 2020-01-06 -- SVN ID : Git -- Standard : VHDL'08 ------------------------------------------------------------------------------- @@ -14,20 +14,21 @@ -- Testbench for fire pulse manager block ------------------------------------------------------------------------------- -library modelsim_lib; -use modelsim_lib.util.all; library ieee; use ieee.std_logic_1164.all; use ieee.numeric_std.all; use ieee.math_real.all; + use std.textio.all; + library work; use work.fire_pulse_5_pkg.all; use work.fire_pulse_ctrl_5_pkg.all; use work.log_pkg.all; -use work.avalon_verify_pkg.all; +use work.avalon_verify_pkg_2.all; use work.pulse_generator_2_pkg.all; use work.enc_pd_emul_1_pkg.all; +use work.fire_pulse_manager_5_tb_pkg.all; library osvvm; use osvvm.RandomPkg.all; @@ -39,24 +40,27 @@ architecture behav of fire_pulse_manager_5_tb is constant CH_NUM : integer := 4; constant DEV_NUM : integer := 2; - - - constant CLK_PERIOD : time := 10.0 ns; - constant CLK_FREQ : real := 100.0e6; constant RX_CLK_PERIOD : time := CLK_PERIOD / 3; -- clock period for used by the -- UART-Rx on the POF constant POF_DELAY : time := 30 ns; -- Total delay from POF-Tx input to POF-Rx output + constant ENC_PPR : natural := 10000; + constant ENC_FREQ : enc_freq_t := 1.0e6; + + constant PD_PULSE_W : pd_pulse_width_t := 0.5; + constant PD_PERIOD : pd_period_t := 2.0; + constant NUM_ITERATIONS : natural := 5; constant SWATHE_LEN : integer := 600; - constant START_DIR : std_logic := '0'; - constant TIME_INT : time := 5000 ns; + constant IMAGE_SIZE : integer := 100; + constant START_DIR : enc_dir_t := DIR_0; + constant VERBOSITY_LEVEL : verb_level_t := VMEDIUM; type ch_offset_t is array (0 to CH_NUM - 1) of integer; - signal ch_offset : ch_offset_t := (100, 308, 316, 324); + signal ch_offset : ch_offset_t := (others => 0); type avs_read_bus_t is array (0 to DEV_NUM - 1) of std_logic_vector(31 downto 0); @@ -64,7 +68,7 @@ architecture behav of fire_pulse_manager_5_tb is signal clk : std_logic := '0'; signal rx_clk : std_logic := '0'; signal pof_tx, pof_rx : std_logic; - signal ch_pulse_out : std_logic_vector(3 downto 0); + signal ch_pulse_out : std_logic_vector(CH_NUM-1 downto 0); signal avs_address : std_logic_vector(14 downto 0); signal avs_write : std_logic_vector(DEV_NUM - 1 downto 0); signal avs_writedata : std_logic_vector(31 downto 0); @@ -73,22 +77,31 @@ architecture behav of fire_pulse_manager_5_tb is signal avs_readdata : avs_read_bus_t; -- signal init_tx : std_logic; - signal pd_in : std_logic; - signal pd_spy : std_logic; signal inc_pos : std_logic; signal dec_pos : std_logic; signal abs_position : std_logic_vector(31 downto 0); - signal abs_spy : std_logic_vector(31 downto 0); signal tx_data : std_logic; signal pof_tx_avs_rv : std_logic; signal pof_tx_avs_we_d : std_logic; + signal enc_p1 : std_logic; + signal enc_p2 : std_logic; + signal pd : std_logic; signal seb_epd_enc_p1 : std_logic; signal seb_epd_enc_p2 : std_logic; signal seb_epd_pd : std_logic; signal seb_epd_link_out : std_logic; -- - signal abs_position_d : std_logic_vector(31 downto 0); - signal dir_in : std_logic; + signal emul_address : std_logic_vector( 9 downto 0); + signal emul_write : std_logic; + signal emul_writedata : std_logic_vector(31 downto 0); + signal emul_read : std_logic; + signal emul_readdatavalid : std_logic; + signal emul_readdata : std_logic_vector(31 downto 0); + signal emul_inc_pos : std_logic; + signal emul_dec_pos : std_logic; + signal emul_pos : std_logic_vector(39 downto 0); + -- + signal enc_dir : enc_dir_t; signal swathe_cnt : integer; signal swathe_pos : integer; signal end_of_swathe : std_logic; @@ -101,29 +114,20 @@ architecture behav of fire_pulse_manager_5_tb is signal detected_error : boolean := false; signal registers_read : boolean := false; signal reprogram_offset : boolean := false; - -- signal avs_m : mm_m_rec_t; signal avs_s : mm_s_rec_t; signal sel_slave_0 : std_logic; signal sel_slave_1 : std_logic; + signal emul_s : mm_s_rec_t; + signal emul_m : mm_m_rec_t; -- type pd_cnt_t is array (0 to CH_NUM - 1) of integer; signal pd_cnt : pd_cnt_t; type fp_cnt_t is array (0 to CH_NUM - 1) of integer; - signal fp_cnt : fp_cnt_t; - type pg_offset_t is array (0 to CH_NUM - 1) of integer; - - -- generate the NCO increment corresponding to a given output frequency - function freq2NCO_inc( - f_out : real; f_clk : real) return std_logic_vector is - variable nco_inc : std_logic_vector(31 downto 0); - - begin - nco_inc := std_logic_vector(to_unsigned(integer((f_out / f_clk) * (2.0**32)), 32)); - return nco_inc; - - end function freq2NCO_inc; + signal fp_cnt : fp_cnt_t; + signal loc_fp_cnt : fp_cnt_t; + signal ch_pulse_out_d : std_logic_vector(CH_NUM-1 downto 0); begin -- behav @@ -171,8 +175,7 @@ begin -- behav avs_writedata => avs_writedata, avs_read => avs_read(0), avs_waitrequest => avs_waitrequest(0), - avs_readdata => avs_readdata(0) - ); + avs_readdata => avs_readdata(0)); pof_rx <= transport tx_data after POF_DELAY; @@ -180,22 +183,29 @@ begin -- behav -- Encoder/PD emulator (Stimuli Generator) ----------------------------------------------------------------------------- + -- The Emulator provides the Encoder and PD stimuli to the FPM: + -- When using the SEB-POF, the encoder stimuli is given by the absolute position. + -- A POF-Transmitter block (below) encodes the Absolute position and PD + -- events according to the POF-Protocol format. + -- When using the SEB-EPD, the encoder phase-1/2 outputs of the emulator are + -- directly fed as inputs to the FPM + iEMUL : entity work.enc_pd_emul_1 port map ( clk => clk, reset_n => reset_n, - ttl_pd => ttl_pd, - ttl_enc_p1 => ttl_p1, - ttl_enc_p2 => ttl_p2, - ttl_enc_zp => ttl_zp, - rs422_pd => rs422_pd, - rs422_enc_p1 => rs422_p1, - rs422_enc_p2 => rs422_p2, - rs422_enc_zp => rs422_zp, + ttl_pd => open, + ttl_enc_p1 => open, + ttl_enc_p2 => open, + ttl_enc_zp => open, + rs422_pd => pd, + rs422_enc_p1 => enc_p1, + rs422_enc_p2 => enc_p2, + rs422_enc_zp => open, abs_pos_out => emul_pos, - set_pos_out => emul_set_pos, - inc_pos_out => emul_inc_pos, - dec_pos_out => emul_dec_pos, + set_pos_out => open, + inc_pos_out => inc_pos, + dec_pos_out => dec_pos, avs_address => emul_address, avs_write => emul_write, avs_writedata => emul_writedata, @@ -203,6 +213,12 @@ begin -- behav avs_readdatavalid => emul_readdatavalid, avs_readdata => emul_readdata); + abs_position <= emul_pos(31 downto 0); + + seb_epd_pd <= pd; + seb_epd_enc_p1 <= enc_p1; + seb_epd_enc_p2 <= enc_p2; + ----------------------------------------------------------------------------- -- POF Tx (Stimuli Generator) ----------------------------------------------------------------------------- @@ -212,7 +228,7 @@ begin -- behav reset_n => reset_n, clk => clk, init => init_tx, - pd_in => pd_in, + pd_in => pd, inc_pos => inc_pos, dec_pos => dec_pos, abs_position => abs_position, @@ -238,56 +254,50 @@ begin -- behav -- Stimuli Generation ----------------------------------------------------------------------------- - /* - - pSTIMULI_REGs : process(clk) - begin - if (clk = '1' and clk'event) then - abs_position_d <= abs_position; - end if; - end process pSTIMULI_REGs; - - inc_pos <= '1' when signed(abs_position) = signed(abs_position_d) + 1 else '0'; - dec_pos <= '1' when signed(abs_position) = signed(abs_position_d) - 1 else '0'; - - seb_epd_pd <= '0'; - seb_epd_enc_p1 <= '0'; - seb_epd_enc_p2 <= '0'; - pSTIMULI : process - variable end_of_stimuli : boolean; - variable rv : RandomPType; + variable end_of_stimuli : boolean; + variable swathe_completed : boolean; + variable pd_pos : integer; + variable rv : RandomPType; begin -- initialization init_tx <= '0'; - dir_in <= START_DIR; - pd_in <= '0'; - abs_position <= (others => '0'); + enc_dir <= START_DIR; swathe_pos <= 0; -- swathe_cnt <= 0; stimuli_completed <= false; end_of_swathe <= '0'; + -- + mm_m_init(emul_m, use_readvalid => true); -- generating the stimulus - wait until running = true; + if(running /= true) then + wait until running = true; + end if; wait for 200 ns; - -- Send a Init/Sync pulse + + -- Set the initial absolute-position for the encoder emulator + set_enc_abs_pos(40x"0", emul_s, emul_m); + + -- Send a Init/Sync pulse to the POF-Tx wait until clk = '1' and clk'event; init_tx <= '1'; wait until clk = '1' and clk'event; init_tx <= '0'; wait for 500 ns; + -- -- generate the forward swathe end_of_stimuli := false; while end_of_stimuli = false loop - swathe_pos <= 0; + --swathe_pos <= 0; for i in 0 to CH_NUM - 1 loop - ch_offset(i) <= rv.RandInt(0, 379); + ch_offset(i) <= rv.RandInt(0, 199); + --ch_offset(i) <= 50; end loop; reprogram_offset <= true; wait until configuring = true; @@ -295,35 +305,36 @@ begin -- behav wait until configuring = false; wait until clk = '1' and clk'event; - - while swathe_pos /= SWATHE_LEN loop - wait until clk = '1' and clk'event; - --generate a position increment - swathe_pos <= swathe_pos + 1; - if (dir_in = '0') then - abs_position <= std_logic_vector(signed(abs_position) + 1); - else - abs_position <= std_logic_vector(signed(abs_position) - 1); - end if; - -- - if (swathe_pos = 16) then - -- generate a PD increment: the PD might be either concurren or not - -- to the position increment - wait for 0.5 * CLK_PERIOD; - pd_in <= '1'; - wait for 100 ns; - wait until clk = '1' and clk'event; - pd_in <= '0'; - end if; - wait for TIME_INT; - end loop; -- swathe_pos /= SWATHE_LEN + + -- start running the encoder + run_enc_pulses(ENC_FREQ, enc_dir, true, SWATHE_LEN, ENC_PPR, emul_s, emul_m); + if(enc_dir = DIR_0) then + log("Running Swathe " & to_string(swathe_cnt + 1) & ", DIR-0.", VMEDIUM); + else + log("Running Swathe " & to_string(swathe_cnt + 1) & ", DIR-1.", VMEDIUM); + end if; + + -- issue a PD to start firing + pd_pos := rv.RandInt(0, 49); + --pd_pos := 10; + for k in 1 to pd_pos loop + wait until abs_position'event; + end loop; -- k + run_pd_pulses(PD_PULSE_W, PD_PERIOD, true, emul_s, emul_m); + + swathe_completed := false; + while swathe_completed = false loop + wait for 500 ns; + -- Check whether the encoder generation has completed + check_max_pulses_done(swathe_completed, emul_s, emul_m); + end loop; wait for 25 us; end_of_swathe <= '1'; wait until clk = '1' and clk'event; end_of_swathe <= '0'; -- reverse direction - if (dir_in /= START_DIR) then + if (enc_dir /= START_DIR) then if (swathe_cnt = NUM_ITERATIONS - 1) then end_of_stimuli := true; else @@ -332,7 +343,11 @@ begin -- behav end if; if (end_of_stimuli = false) then wait until clk = '1' and clk'event; - dir_in <= not dir_in; + if(enc_dir = DIR_0) then + enc_dir <= DIR_1; + else + enc_dir <= DIR_0; + end if; -- Wait some time to make sure the change of direction is transmitted. -- Note: if the position starts changing before the receiver was able to -- confirm the change of direction, then some encoder pulses may not be @@ -347,31 +362,40 @@ begin -- behav end process pSTIMULI; - */ - - - ----------------------------------------------------------------------------- -- Testbench Control ----------------------------------------------------------------------------- + pOUT_CHECK_REGs : process(reset_n, clk) + begin + if(reset_n = '0') then + ch_pulse_out_d <= (others => '0'); + loc_fp_cnt <= (others => 0); + elsif(clk = '1' and clk'event) then + ch_pulse_out_d <= ch_pulse_out; + for n in 0 to CH_NUM-1 loop + if(ch_pulse_out(n) = '1' and ch_pulse_out_d(n) = '0') then + loc_fp_cnt(n) <= loc_fp_cnt(n) + 1; + end if; + end loop; -- n + end if; + end process pOUT_CHECK_REGs; + pTB_CTRL : process type fp_arrived_t is array (0 to CH_NUM - 1) of boolean; variable fp_arrived : fp_arrived_t; - type fp_arrived_time_t is array (0 to CH_NUM - 1) of integer; - variable fp_arrived_time : fp_arrived_time_t; - variable fp_arrived_agg : integer; - variable pd_arrived_time : integer; + type fp_arrived_pos_t is array (0 to CH_NUM - 1) of integer; + variable fp_arrived_pos : fp_arrived_pos_t; + variable fp_arrived_agg : integer; + variable pd_arrived_pos : integer; + alias pd_spy is <>; + alias abs_spy is <>; begin - -- init_signal_spy("/iDUT/abs_pos","abs_spy",0); - -- init_signal_spy("/iDUT/pd_pulse","pd_spy",0); - init_signal_spy("abs_position", "abs_spy", 0); - init_signal_spy("pd_in", "pd_spy", 0); -- Set the verbosity level for logging set_log_verbosity(VERBOSITY_LEVEL); - set_log_verbosity(VHIGH); + --set_log_verbosity(VHIGH); log_header("Multi-channel FPM verification:", VLOW); @@ -391,7 +415,9 @@ begin -- behav end if; wait until configuring = false; running <= true; - log("Running test ... ", VLOW, true); + log_separator_line(VLOW); + log("Configuration completed. Running test ... ", VLOW, true); + log_separator_line(VLOW); while stimuli_completed = false loop wait until ((pd_spy = '1' and pd_spy'event) or stimuli_completed); @@ -400,12 +426,12 @@ begin -- behav exit; end if; - pd_arrived_time := to_integer(signed(abs_spy)); + pd_arrived_pos := to_integer(signed(abs_spy)); for i in 0 to CH_NUM - 1 loop fp_arrived(i) := false; - fp_arrived_time(i) := 0; + fp_arrived_pos(i) := 0; end loop; - log("Product detect fired @ " & integer'image(pd_arrived_time) & " ... ", VLOW, true); + log("Product detect fired @ " & integer'image(pd_arrived_pos) & " ... ", VLOW, true); fp_arrived_agg := 0; while fp_arrived_agg < CH_NUM loop fp_arrived_agg := 0; @@ -423,10 +449,10 @@ begin -- behav for i in 0 to CH_NUM - 1 loop if ch_pulse_out(i) = '1' and fp_arrived(i) = false then fp_arrived(i) := true; - fp_arrived_time(i) := to_integer(signed(abs_spy)); - log("Channel CH" & integer'image(i) & " Fire pulse logged @ " & integer'image(fp_arrived_time(i)) & " ... ", VLOW, true); - if (abs (pd_arrived_time - fp_arrived_time(i)) /= ch_offset(i)) then - log("Channel CH" & integer'image(i) & " OFFSET INCORRECT !!! ", VLOW, true); + fp_arrived_pos(i) := to_integer(signed(abs_spy)); + log("Channel CH" & integer'image(i) & " Fire pulse logged @ " & integer'image(fp_arrived_pos(i)) & " ... ", VLOW, true); + if (abs (pd_arrived_pos - fp_arrived_pos(i)) /= ch_offset(i)) then + log("ERROR on Channel CH" & integer'image(i) & ": First Fire-Pulse detected at position " & to_string(fp_arrived_pos(i)) & ", expected position is " & to_string((pd_arrived_pos+ch_offset(i))), VLOW, true); detected_error <= true; end if; end if; @@ -445,15 +471,15 @@ begin -- behav -- Report PD and FP counter from pulse generator for i in 0 to CH_NUM - 1 loop - log("Channel CH" & integer'image(i) & " PDin counter value : " & integer'image(pd_cnt(i)) & " ... ", VLOW, true); - log("Channel CH" & integer'image(i) & " FPout counter value : " & integer'image(fp_cnt(i)) & " ... ", VLOW, true); + log("Channel CH" & integer'image(i) & " PD-in counter value : " & integer'image(pd_cnt(i)) & " ... ", VLOW, true); + log("Channel CH" & integer'image(i) & " FP-out counter value : " & integer'image(fp_cnt(i)) & " ... ", VLOW, true); + log("Channel CH" & integer'image(i) & " Detected Fire-Pulses : " & integer'image(loc_fp_cnt(i)) & " ... ", VLOW, true); if (i = 0 and (pd_cnt(i) /= (NUM_ITERATIONS) * 2)) or (i /= 0 and pd_cnt(i) /= 0) then -- fire_pulse_manager now has no registers beyond channel 0 log("Channel CH" & integer'image(i) & " PD_cnt counter value Incorrect: ", VLOW, true); detected_error <= true; end if; - if (i = 0 and (fp_cnt(i) /= (NUM_ITERATIONS) * 2 * 100)) or - (i /= 0 and fp_cnt(i) /= 0) then + if((loc_fp_cnt(i) /= (NUM_ITERATIONS) * 2 * 100) or (i = 0 and (fp_cnt(i) /= (NUM_ITERATIONS) * 2 * 100)) or (i /= 0 and fp_cnt(i) /= 0)) then log("Channel CH" & integer'image(i) & " FP_cnt counter value Incorrect: ", VLOW, true); detected_error <= true; end if; @@ -478,10 +504,6 @@ begin -- behav pUUT_CTRL : process variable addr : std_logic_vector(31 downto 0) := (others => '0'); variable data : std_logic_vector(31 downto 0) := (others => '0'); - variable ratio_int : integer; - variable ratio_slv : std_logic_vector(33 downto 0); - variable pg_off : pg_offset_t; - variable pg_ram_off : pg_offset_t; begin sel_slave_0 <= '0'; @@ -491,8 +513,6 @@ begin -- behav -- Initialize avalon mm interfaces mm_m_init(avs_m, use_waitrequest => true); - mm_m_init(emul_mm_m, use_readvalid => true); - if (reset_n = '0') then wait until reset_n = '1'; wait for 100 ns; @@ -511,168 +531,16 @@ begin -- behav sel_slave_0 <= '1'; wait until clk = '1' and clk'event; - log("Configuring EMUL ... ", VLOW, true); - -- Configure Encoder NCO freq - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_ENC_NCO_INC_ADDR)), 32)); - data := freq2NCO_inc(200.0e3, CLK_FREQ); - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - -- Enable outputs - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_OUT_ENABLE_ADDR)), 32)); - data := X"000000FF"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - log("Configuring FPM ... ", VLOW, true); - -- Config fire_pulse_manager control registers: - -- Enable the POF-Rx - addr := std_logic_vector(to_unsigned(3, 32)); - data := X"0000_8061"; -- set bit_div to 6 to match the 50MBd TX signal to the 300MHz RX_CLK - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - -- Select pulse generator - addr := std_logic_vector(to_unsigned(2, 32)); - data := X"0000_0001"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - -- Config external fire pulses - addr := std_logic_vector(to_unsigned(12, 32)); - data := X"0008_0004"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - - -- precompute the channel memory offsets: - for i in 0 to CH_NUM - 1 loop - pg_off(i) := (work.fire_pulse_5_pkg.pg_ch_id + i)*work.fire_pulse_5_pkg.blk_size; - pg_ram_off(i) := pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.SEQ_RAM_OFFSET)); - end loop; -- i + + fpm_ctrl_config(avs_s, avs_m); config_pg_l : for i in 0 to CH_NUM - 1 loop - -- Disable/Re-enable first the whole pulse_generator - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.PULSE_GEN_CTRL_REG)), 32)); - data := (others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); - data := (0 => '1', 16 => '1', others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); - -- Disable/Re-enable the Channel Controller sequencer - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.CH_CTRL_CTRL_REG)), 32)); - data := (others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.CH_CTRL_CTRL_REG)), 32)); - data := (0 => '1', others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); - -- set the sub-pixel offset - data := std_logic_vector(to_unsigned(0, 32)); - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.SP_OFFSET_INT)), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - data := std_logic_vector(to_unsigned(0, 32)); - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.SP_OFFSET_FRAC)), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- set the division ratio - ratio_int := integer(2.0 * real(2**24)); - ratio_slv := std_logic_vector(to_unsigned(ratio_int, 34)); - -- Set the integer part of the div-ratio - data(31 downto 10) := (others => '0'); - data(9 downto 0) := ratio_slv(33 downto 24); - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.DIV_RATIO_INT)), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- Set the fractional part of the div-ratio - data(31 downto 24) := (others => '0'); - data(23 downto 0) := ratio_slv(23 downto 0); - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.DIV_RATIO_FRAC)), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- Disable/Enable the fractional divider - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.FRAC_DIV_CTRL_REG)), 32)); - data := (others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); - data := (0 => '1', others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); - -- Configure the Channel Offset (Both DIR_0 and DIR_1): - -- DIR_0 - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.CH_OFFSET_D0_REG)), 32)); - data := std_logic_vector(to_unsigned(ch_offset(i), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- DIR_1 - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.CH_OFFSET_D1_REG)), 32)); - data := std_logic_vector(to_unsigned(ch_offset(i), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- Configure the Channel Delay - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.CH_DELAY_REG)), 32)); - data := std_logic_vector(to_unsigned(0, 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- Fill Sequencer RAM with simple swathe DIR-0 - -- 0x00, 0x30000000 – Reset the vector output value - addr := std_logic_vector(to_unsigned(pg_ram_off(i), 32)); - data := X"30000000"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x01, 0x10000001 – Trigger Mask (PD trigger enabled) - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 1, 32)); - data := X"10000001"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x02, 0x20000001 – Wait for a single PD event - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 2, 32)); - data := X"20000001"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x03, 0x30006404 – Issue a request for starting the generation of 100 fire pulses (DIR-0) - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 3, 32)); - data := X"30006404"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x04, 0x30006400 – De-assert the request bit (start_image_req) - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 4, 32)); - data := X"30006400"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x05, 0x80000258 – Wait till POS END - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 5, 32)); - data := X"80000258"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x06, 0xC0000000 – Jump to DIR-1 - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 6, 32)); - data := X"C0000010"; - mm_32b_write(addr, data, avs_s, avs_m); + pulse_gen_config(i, ch_offset(i), IMAGE_SIZE, avs_s, avs_m); - -- Fill Sequencer RAM with simple swathe DIR-1 - -- 0x10, 0x30000000 – Reset the vector output value - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 16, 32)); - data := X"30000001"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x11, 0x10000001 – Trigger Mask (PD trigger enabled) - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 17, 32)); - data := X"10000001"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x12, 0x20000001 – Wait for a single PD event - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 18, 32)); - data := X"20000001"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x13, 0x30006405 – Issue a request for starting the generation of 100 fire pulses (DIR-1) - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 19, 32)); - data := X"30006405"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x14, 0x30006401 – De-assert the request bit (start_image_req) - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 20, 32)); - data := X"30006401"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x15, 0x80000000 – Wait till POS START - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 21, 32)); - data := X"80000000"; - mm_32b_write(addr, data, avs_s, avs_m); - -- 0x16, 0xC0000000 – Jump to DIR-0 - addr := std_logic_vector(to_unsigned(pg_ram_off(i) + 22, 32)); - data := X"C0000000"; - mm_32b_write(addr, data, avs_s, avs_m); - - -- Start Sequencer - addr := std_logic_vector(to_unsigned(pg_off(i) + to_integer(unsigned(work.pulse_generator_2_pkg.SEQ_CSR_OFFSET) + 3), 32)); - data := (0 => '1', others => '0'); - mm_32b_write(addr, data, avs_s, avs_m); end loop config_pg_l; - -- Init the encoder NCO - Preset Abs-Pos - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_ENC_CTRL_ADDR)), 32)); - data := 32X"B"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - log("Configuration completed.", VLOW, true); configuring <= false; @@ -682,64 +550,34 @@ begin -- behav exit; end if; + log("Reading counters ... ", VLOW, true); + -- Read PD and FP counter from pulse generator + for i in 0 to CH_NUM - 1 loop + fpm_reg_read(PG_CH_ID+i, work.pulse_generator_2_pkg.PD_IN_CNT_REG, data, avs_s, avs_m); + pd_cnt(i) <= to_integer(unsigned(data)); + fpm_reg_read(PG_CH_ID+i, work.pulse_generator_2_pkg.FIRE_REQ_CNT_REG, data, avs_s, avs_m); + fp_cnt(i) <= to_integer(unsigned(data)); + wait until clk = '1' and clk'event; + log("CH-" & to_string(i) & ": pd_in_cnt = " & to_string(pd_cnt(i)) & ", fire_req_cnt = " & to_string(fp_cnt(i)) & ", detected fire-req-cnt = " & to_string(loc_fp_cnt(i)), VMEDIUM); + end loop; + configuring <= true; log("Reprogramming offset ... ", VLOW, true); config_of_l : for i in 0 to CH_NUM - 1 loop - -- Configure the Channel Offset (Both DIR_0 and DIR_1): - -- DIR_0 - addr := std_logic_vector(to_unsigned(8192 + (2048 * i) + to_integer(unsigned(CH_OFFSET_D0_REG)), 32)); - data := std_logic_vector(to_unsigned(ch_offset(i), 32)); - mm_32b_write(addr, data, avs_s, avs_m); - -- DIR_1 - addr := std_logic_vector(to_unsigned(8192 + (2048 * i) + to_integer(unsigned(CH_OFFSET_D1_REG)), 32)); - data := std_logic_vector(to_unsigned(ch_offset(i), 32)); - mm_32b_write(addr, data, avs_s, avs_m); + ch_offset_config(i, ch_offset(i), avs_s, avs_m); end loop; configuring <= false; - -- issue PD - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_PD_CTRL_ADDR)), 32)); - data := 32X"3"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - if dir_in = '0' then - log("Running 600 steps in DIR-0 ...", VLOW); - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_PULSE_NUM_ADDR)), 32)); - data := 32X"258"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_ENC_CTRL_ADDR)), 32)); - data := 32X"11"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_ENC_CTRL_ADDR)), 32)); - data := 32X"31"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - else - log("Running 600 steps in DIR-1 ...", VLOW); - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_PULSE_NUM_ADDR)), 32)); - data := 32X"258"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_ENC_CTRL_ADDR)), 32)); - data := 32X"15"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - addr := std_logic_vector(to_unsigned(6144 + to_integer(unsigned(CSR_ENC_CTRL_ADDR)), 32)); - data := 32X"35"; - -- Write the data to the register - mm_32b_write(addr, data, avs_s, avs_m); - end if; end loop; + log("Reading counters ... ", VLOW, true); -- Read PD and FP counter from pulse generator for i in 0 to CH_NUM - 1 loop - addr := std_logic_vector(to_unsigned(8192 + (2048 * i) + to_integer(unsigned(PD_IN_CNT_REG)), 32)); - mm_32b_read(addr, data, avs_s, avs_m); + fpm_reg_read(PG_CH_ID+i, work.pulse_generator_2_pkg.PD_IN_CNT_REG, data, avs_s, avs_m); pd_cnt(i) <= to_integer(unsigned(data)); - addr := std_logic_vector(to_unsigned(8192 + (2048 * i) + to_integer(unsigned(FIRE_REQ_CNT_REG)), 32)); - mm_32b_read(addr, data, avs_s, avs_m); + fpm_reg_read(PG_CH_ID+i, work.pulse_generator_2_pkg.FIRE_REQ_CNT_REG, data, avs_s, avs_m); fp_cnt(i) <= to_integer(unsigned(data)); + wait until clk = '1' and clk'event; + log("CH-" & to_string(i) & ": pd_in_cnt = " & to_string(pd_cnt(i)) & ", fire_req_cnt = " & to_string(fp_cnt(i)), VMEDIUM); end loop; registers_read <= true; @@ -758,8 +596,6 @@ begin -- behav avs_s.mm_waitrequest <= avs_waitrequest(0) when sel_slave_0 = '1' else avs_waitrequest(1) when sel_slave_1 = '1' else '0'; - avs_s.use_readvalid <= false; - avs_address <= avs_m.mm_address(avs_address'range); avs_write(0) <= avs_m.mm_write and sel_slave_0; avs_write(1) <= avs_m.mm_write and sel_slave_1; @@ -768,14 +604,14 @@ begin -- behav avs_read(1) <= avs_m.mm_read and sel_slave_1; -- Emulator Avalon bus maapings - emul_mm_s.mm_readdata <= emul_readdata; - emul_mm_s.mm_readdatavalid <= emul_readdatavalid; - emul_mm_s.mm_waitrequest <= '0'; + emul_s.mm_readdata <= emul_readdata; + emul_s.mm_readdatavalid <= emul_readdatavalid; + emul_s.mm_waitrequest <= '0'; - emul_address <= emul_mm_m.mm_address(emul_address'range); - emul_writedata <= emul_mm_m.mm_writedata; - emul_write <= emul_mm_m.mm_write; - emul_read <= emul_mm_m.mm_read; + emul_address <= emul_m.mm_address(emul_address'range); + emul_writedata <= emul_m.mm_writedata; + emul_write <= emul_m.mm_write; + emul_read <= emul_m.mm_read; end behav; diff --git a/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb_pkg.vhd b/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb_pkg.vhd new file mode 100644 index 0000000..72b6a56 --- /dev/null +++ b/generic_ip/fire_pulse_manager/5/src/test/fire_pulse_manager_5_tb_pkg.vhd @@ -0,0 +1,743 @@ +------------------------------------------------------------------------------- +-- Title : fire_pulse_manager_5_tb_pkg +-- Project : SMB +------------------------------------------------------------------------------- +-- File : fire_pulse_manager_5_tb_pkg.vhd +-- Author : Gianmarco Girau +-- Company : Global Inkjet Systems +-- Created : 2020-01-02 +-- Last update: 2020-01-06 +-- SVN ID : Git +-- Standard : VHDL'2008 +------------------------------------------------------------------------------- +-- Description: +-- Support package for the FPM testbench +------------------------------------------------------------------------------- + +--library std; +--use std.textio.all; + +library ieee; +use ieee.std_logic_1164.all; +use ieee.std_logic_textio.all; +use ieee.numeric_std.all; +use ieee.math_real.all; + +library work; +use work.fire_pulse_5_pkg.all; +use work.enc_pd_emul_1_pkg.all; +use work.fire_pulse_ctrl_5_pkg.all; + +library OSVVM ; +use OSVVM.RandomBasePkg.all ; +use OSVVM.RandomPkg.all; + +library work; +use work.log_pkg.all; +use work.avalon_verify_pkg_2.all; +use work.enc_pd_emul_1_pkg.all; + +package fire_pulse_manager_5_tb_pkg is + + constant CLK_PERIOD : time := 10.0 ns; + constant CLK_FREQ : real := 100.0e6; + + constant ENC_NCO_WIDTH : positive := 32; + + -- Logging Verbosity Level + constant VERBOSITY_LEVEL : verb_level_t := VMEDIUM; + + ----------------------------------------------------------------------------- + -- FPM Configuration + ----------------------------------------------------------------------------- + + -- fpm_reg_write with addr defined as std_logic_vector + procedure fpm_reg_write( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in std_logic_vector; + data : in std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + -- fpm_reg_write with addr defined as integer + procedure fpm_reg_write( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in integer; + data : in std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + -- fpm_reg_read with addr defined as std_logic_vector + procedure fpm_reg_read( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in std_logic_vector; + data : out std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + -- fpm_reg_read with addr defined as integer + procedure fpm_reg_read( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in integer; + data : out std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + procedure fpm_ctrl_config( + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + procedure ch_offset_config( + ch_id : in natural; + ch_offset : in natural; + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + procedure ch_ctrl_config( + ch_id : in natural; + pixel_num : in natural; + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + procedure pulse_gen_config( + ch_id : in natural; + ch_offset : in natural; + pixel_num : in natural; + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t); + + ----------------------------------------------------------------------------- + -- ENC/PD Emulator Configuration + ----------------------------------------------------------------------------- + + type enc_phase_t is (SINGLE_PHASE, DUAL_PHASE); + type enc_edge_t is (RISING, FALLING, RISING_AND_FALLING); + type pd_edge_t is (RISING, FALLING, RISING_AND_FALLING); + subtype enc_freq_t is real range 0.0e3 to 10.0e6; + subtype pd_pulse_width_t is real range 0.0 to 1000.0; -- PD period in us + --subtype pd_period_t is real range 50.0 to 1.0e6; -- PD period in us + subtype pd_period_t is real range 0.5 to 1.0e6; -- PD period in us + + type enc_dir_t is (DIR_0, DIR_1); + + type emul_cfg_t is record + + enc_res : real; + enc_ppr : integer; + enc_phase : enc_phase_t; + enc_edge : enc_edge_t; + enc_dir : enc_dir_t; + pd_edge : pd_edge_t; + enc_freq : enc_freq_t; + pd_pulse_w : pd_pulse_width_t; + pd_period : pd_period_t; + enc_pulses : integer; + + end record emul_cfg_t; + + -- set abs-pos + procedure set_enc_abs_pos( + abs_pos : in std_logic_vector(39 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + -- The ENC/PD emulator configuration is derived from the EMS + procedure apply_enc_pd_emul_cfg( + cfg : in emul_cfg_t; + init : in boolean := true; + run_pulses_mode : in boolean := false; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + -- Stop the ENC/PD emulator + procedure stop_enc_pd_emul( + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + procedure check_max_pulses_done( + done : out boolean; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + -- Run a fix number of encoder pulses + procedure run_enc_pulses( + enc_freq : in enc_freq_t; + direction : in enc_dir_t; + double_ph_mode : in boolean := true; + num_pulses : in integer; + enc_ppr : in integer; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + -- Run PD pulses: either single pulse or periodic mode + procedure run_pd_pulses( + pulse_width : in pd_pulse_width_t; + pd_period : in pd_period_t; + single_pulse_mode : in boolean := false; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t); + + ----------------------------------------------------------------------------- + -- Support functions + ----------------------------------------------------------------------------- + + -- generate the NCO increment corresponding to a given output frequency + function freq2NCO_inc( + f_out : real; f_clk : real) return std_logic_vector; + +end fire_pulse_manager_5_tb_pkg; + +package body fire_pulse_manager_5_tb_pkg is + + ----------------------------------------------------------------------------- + -- FPM Configuration + ----------------------------------------------------------------------------- + + -- fpm_reg_write with addr defined as std_logic_vector + procedure fpm_reg_write( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in std_logic_vector; + data : in std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable address : std_logic_vector(31 downto 0); + + begin + + address := std_logic_vector(to_unsigned(blk_id*BLK_SIZE+to_integer(unsigned(addr)),32)); + mm_32b_write(address, data, mm_s, mm_m); + + end procedure fpm_reg_write; + + -- fpm_reg_write with addr defined as integer + procedure fpm_reg_write( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in integer; + data : in std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable address : std_logic_vector(31 downto 0); + + begin + + address := std_logic_vector(to_unsigned((blk_id*BLK_SIZE)+addr,32)); + mm_32b_write(address, data, mm_s, mm_m); + + end procedure fpm_reg_write; + + -- fpm_reg_read with addr defined as std_logic_vector + procedure fpm_reg_read( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in std_logic_vector; + data : out std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable address : std_logic_vector(31 downto 0); + + begin + + address := std_logic_vector(to_unsigned(blk_id*BLK_SIZE+to_integer(unsigned(addr)),32)); + mm_32b_read(address, data, mm_s, mm_m); + + end procedure fpm_reg_read; + + -- fpm_reg_read with addr defined as std_logic_vector + procedure fpm_reg_read( + blk_id : in natural range 0 to BLK_NUM-1; + addr : in integer; + data : out std_logic_vector(31 downto 0); + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable address : std_logic_vector(31 downto 0); + + begin + + address := std_logic_vector(to_unsigned((blk_id*BLK_SIZE)+addr,32)); + mm_32b_read(address, data, mm_s, mm_m); + + end procedure fpm_reg_read; + + procedure fpm_ctrl_config( + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable data : std_logic_vector(31 downto 0); + + begin + + log("Configuring FPM Controller ... ", VMEDIUM, true); + -- Enable the POF-Rx + data := X"0000_0001"; + fpm_reg_write(FP_CTRL_ID, POF_RX_CTRL, data, mm_s, mm_m); + + -- Select the input source + data := X"0000_0001"; + fpm_reg_write(FP_CTRL_ID, SRC_SEL_REG, data, mm_s, mm_m); + + -- Config external fire pulses + data := X"0008_0004"; + -- Write the data to the register + fpm_reg_write(FP_CTRL_ID, EXT_FP_CTRL_REG, data, mm_s, mm_m); + + end procedure fpm_ctrl_config; + + procedure ch_offset_config( + ch_id : in natural; + ch_offset : in natural; + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable data : std_logic_vector(31 downto 0); + + begin + + -- Disable/Re-enable first the whole pulse_generator + data := std_logic_vector(to_unsigned(ch_offset, 32)); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.CH_OFFSET_D0_REG, data, mm_s, mm_m); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.CH_OFFSET_D1_REG, data, mm_s, mm_m); + + log("CH-" & to_string(ch_id) & ": PD offset configured to " & to_string(ch_offset) & ".", VMEDIUM); + + end procedure ch_offset_config; + + procedure ch_ctrl_config( + ch_id : in natural; + pixel_num : in natural; + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable data : std_logic_vector(31 downto 0); + variable ram_idx : natural; + variable ram_offset : natural; + + begin + + ram_offset := to_integer(unsigned(work.pulse_generator_2_pkg.SEQ_RAM_OFFSET)); + ram_idx := 0; + + -- Issue first an image on DIR-0, then on DIR-1 + -- Reset the vector output value + data := X"30000000"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Enable Trigger Mask (All the triggers) + data := X"1000000F"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Wait for a single PD event + data := X"20000001"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Issue a request to generate 'pixel_num' fire requests + data := X"30" & std_logic_vector(to_unsigned(pixel_num,16)) & X"24"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + data := X"30" & std_logic_vector(to_unsigned(pixel_num,16)) & X"00"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- wait until the end of the image + data := X"23000001"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Switch to DIR-1 + data := X"30000001"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Wait for a single PD event + data := X"20000001"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Issue a request to generate 'pixel_num' fire requests + data := X"30" & std_logic_vector(to_unsigned(pixel_num,16)) & X"25"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + data := X"30" & std_logic_vector(to_unsigned(pixel_num,16)) & X"01"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- wait until the end of the image + data := X"23000001"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + -- Jump to DIR-0 + data := X"C0000000"; + fpm_reg_write(PG_CH_ID+ch_id, ram_offset+ram_idx, data, mm_s, mm_m); + ram_idx := ram_idx + 1; + + end procedure ch_ctrl_config; + + procedure pulse_gen_config( + ch_id : in natural; + ch_offset : in natural; + pixel_num : in natural; + signal mm_s : in mm_s_rec_t; + signal mm_m : out mm_m_rec_t) is + + variable data : std_logic_vector(31 downto 0); + variable ratio_int : integer; + variable ratio_slv : std_logic_vector(33 downto 0); + + begin + + log("Configuring Channel " & to_string(ch_id) & " ... ", VMEDIUM, true); + + -- Disable/Re-enable first the whole pulse_generator + data := (others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.PULSE_GEN_CTRL_REG, data, mm_s, mm_m); + data := (0 => '1', 16 => '1', others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.PULSE_GEN_CTRL_REG, data, mm_s, mm_m); + + -- Disable/Re-enable the Channel Controller sequencer + data := (others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.CH_CTRL_CTRL_REG, data, mm_s, mm_m); + data := (0 => '1', others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.CH_CTRL_CTRL_REG, data, mm_s, mm_m); + -- set the sub-pixel offset + data := std_logic_vector(to_unsigned(0, 32)); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.SP_OFFSET_INT, data, mm_s, mm_m); + data := std_logic_vector(to_unsigned(0, 32)); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.SP_OFFSET_FRAC, data, mm_s, mm_m); + -- set the division ratio + ratio_int := integer(2.0 * real(2**24)); + ratio_slv := std_logic_vector(to_unsigned(ratio_int, 34)); + -- Set the integer part of the div-ratio + data(31 downto 10) := (others => '0'); + data(9 downto 0) := ratio_slv(33 downto 24); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.DIV_RATIO_INT, data, mm_s, mm_m); + data(31 downto 24) := (others => '0'); + data(23 downto 0) := ratio_slv(23 downto 0); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.DIV_RATIO_FRAC, data, mm_s, mm_m); + -- Disable/Enable the fractional divider + data := (others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.FRAC_DIV_CTRL_REG, data, mm_s, mm_m); + data := (0 => '1', others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, work.pulse_generator_2_pkg.FRAC_DIV_CTRL_REG, data, mm_s, mm_m); + + -- configure the channel offset + ch_offset_config(ch_id, ch_offset, mm_s, mm_m); + + -- Configure the sequencer RAM + ch_ctrl_config(ch_id, pixel_num, mm_s, mm_m); + + -- Restart the sequencer + data := (others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, to_integer(unsigned(work.pulse_generator_2_pkg.SEQ_CSR_OFFSET)) + 3, data, mm_s, mm_m); + data := (0 => '1', others => '0'); + fpm_reg_write(PG_CH_ID+ch_id, to_integer(unsigned(work.pulse_generator_2_pkg.SEQ_CSR_OFFSET)) + 3, data, mm_s, mm_m); + + end procedure pulse_gen_config; + + ----------------------------------------------------------------------------- + -- ENC/PD Emulator Configuration + ----------------------------------------------------------------------------- + + procedure set_enc_abs_pos( + abs_pos : in std_logic_vector(39 downto 0); + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + + variable addr : std_logic_vector(31 downto 0) := (others => '0'); + variable data : std_logic_vector(31 downto 0) := (others => '0'); + + begin + + -- set the value for MSBs + addr:= std_logic_vector(resize(unsigned(CSR_POS_INIT_MSB_ADDR), 32)); + mm_32b_write(addr, 24x"0" & abs_pos(39 downto 32), mm_s_rec, mm_m_rec); + -- set the value for LSBs + addr:= std_logic_vector(resize(unsigned(CSR_POS_INIT_LSB_ADDR), 32)); + mm_32b_write(addr, abs_pos(31 downto 0), mm_s_rec, mm_m_rec); + -- read back the encoder configuration, then apply the set_abs_pos control + -- bit + addr:= std_logic_vector(resize(unsigned(CSR_ENC_CTRL_ADDR), 32)); + mm_32b_read(addr, data, mm_s_rec, mm_m_rec); + data(3) := '1'; + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + log("Encoder/PD emulator abs-pos preset to " & to_string(to_integer(signed(abs_pos))) & ".", VMEDIUM); + + + end procedure set_enc_abs_pos; + + procedure apply_enc_pd_emul_cfg( + cfg : in emul_cfg_t; + init : in boolean := true; + run_pulses_mode : in boolean := false; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + + variable addr : std_logic_vector(31 downto 0) := (others => '0'); + variable data : std_logic_vector(31 downto 0) := (others => '0'); + variable data_check : std_logic_vector(31 downto 0) := (others => '0'); + -- + variable pd_low_period : real := 0.0; -- PD low period (ns) + variable pd_high_period : real := 0.0; -- PD high period (ns) + + begin + + -- Set the NCO inc: output freq + addr:= std_logic_vector(resize(unsigned(CSR_ENC_NCO_INC_ADDR), 32)); + data := freq2NCO_inc(real(cfg.enc_freq), CLK_FREQ); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- set the max pulses register + addr := std_logic_vector(resize(unsigned(CSR_PULSE_NUM_ADDR), 32)); + data := std_logic_vector(to_unsigned(cfg.enc_pulses, 32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- set the zero-phase ppr number + addr := std_logic_vector(resize(unsigned(CSR_ZP_PPR_ADDR), 32)); + data := std_logic_vector(to_unsigned(cfg.enc_ppr, 32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + /* + pd_high_period := cfg.pd_pulse_w*(1000.0/CLK_PERIOD); + pd_low_period := real(cfg.pd_period)*(1000.0/CLK_PERIOD)-pd_high_period; + + addr(blk_addr_width-1 downto 0) := std_logic_vector(to_unsigned(8, blk_addr_width)); + data := std_logic_vector(to_unsigned(integer(pd_high_period-1.0),32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + addr(blk_addr_width-1 downto 0) := std_logic_vector(to_unsigned(7, blk_addr_width)); + data := std_logic_vector(to_unsigned(integer(pd_low_period-1.0),32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- Enable PD emulation (first de-assert, then assert) + addr(blk_addr_width-1 downto 0) := std_logic_vector(to_unsigned(6, blk_addr_width)); + data := (others => '0'); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + data := (0 => '1', others => '0'); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + */ + + -- Enable only the necessary outputs: + if(cfg.enc_phase = DUAL_PHASE ) then + data := 32x"FF"; + else + data := 32x"BB"; + end if; + addr := std_logic_vector(resize(unsigned(CSR_OUT_ENABLE_ADDR), 32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + addr := std_logic_vector(resize(unsigned(CSR_ENC_CTRL_ADDR), 32)); + if(init = true) then + mm_32b_write(addr, 32x"2", mm_s_rec, mm_m_rec); + end if; + + data := (others => '0'); + if(run_pulses_mode = true) then + data(4) := '1'; + end if; + if(cfg.enc_dir = DIR_0) then + data(2) := '0'; + else + data(2) := '1'; + end if; + + -- enable the encoder + data(0) := '1'; + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + log("Encoder/PD emulator enabled.", VMEDIUM); + + end procedure apply_enc_pd_emul_cfg; + + -- Stop the ENC/PD emulator + procedure stop_enc_pd_emul( + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + + variable addr : std_logic_vector(31 downto 0) := (others => '0'); + variable data : std_logic_vector(31 downto 0) := (others => '0'); + + begin + + -- Disable PD emulation + addr := std_logic_vector(resize(unsigned(CSR_PD_CTRL_ADDR), 32)); + mm_32b_read(addr, data, mm_s_rec, mm_m_rec); + data(0) := '0'; + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- Disable Enc emulation + addr := std_logic_vector(resize(unsigned(CSR_ENC_CTRL_ADDR), 32)); + mm_32b_read(addr, data, mm_s_rec, mm_m_rec); + data(0) := '0'; + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + end procedure stop_enc_pd_emul; + + -- Check whether the generation of a fixed number of encoder pulses has completed + procedure check_max_pulses_done( + done : out boolean; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + + variable addr : std_logic_vector(31 downto 0) := (others => '0'); + variable data : std_logic_vector(31 downto 0) := (others => '0'); + + begin + + addr := std_logic_vector(resize(unsigned(CSR_ENC_CTRL_ADDR), 32)); + mm_32b_read(addr, data, mm_s_rec, mm_m_rec); + + if(data(6) = '1') then + done := true; + else + done := false; + end if; + + end procedure check_max_pulses_done; + + -- Run a fix number of encoder pulses + procedure run_enc_pulses( + enc_freq : in enc_freq_t; + direction : in enc_dir_t; + double_ph_mode : in boolean := true; + num_pulses : in integer; + enc_ppr : in integer; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + + variable addr : std_logic_vector(31 downto 0) := (others => '0'); + variable data : std_logic_vector(31 downto 0) := (others => '0'); + variable data_check : std_logic_vector(31 downto 0) := (others => '0'); + + begin + + -- Set the NCO inc: output freq + addr := std_logic_vector(resize(unsigned(CSR_ENC_NCO_INC_ADDR), 32)); + data := freq2NCO_inc(real(enc_freq), CLK_FREQ); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- set the max pulses register + addr := std_logic_vector(resize(unsigned(CSR_PULSE_NUM_ADDR), 32)); + data := std_logic_vector(to_unsigned(num_pulses, 32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- set the zero-phase ppr number + addr := std_logic_vector(resize(unsigned(CSR_ZP_PPR_ADDR), 32)); + data := std_logic_vector(to_unsigned(enc_ppr, 32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- Enable only the necessary outputs: + if(double_ph_mode = true) then + data := 32x"FF"; + else + data := 32x"BB"; + end if; + addr := std_logic_vector(resize(unsigned(CSR_OUT_ENABLE_ADDR), 32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + addr := std_logic_vector(resize(unsigned(CSR_ENC_CTRL_ADDR), 32)); + data := (4 => '1', 5 => '1', others => '0'); + if(direction = DIR_0) then + data(2) := '0'; + else + data(2) := '1'; + end if; + + -- enable the encoder + data(0) := '1'; + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + --log("Running encoder pulses ... ", VMEDIUM); + + end procedure run_enc_pulses; + + -- Run PD pulses: either single pulse or periodic mode + procedure run_pd_pulses( + pulse_width : in pd_pulse_width_t; + pd_period : in pd_period_t; + single_pulse_mode : in boolean := false; + signal mm_s_rec : in mm_s_rec_t; + signal mm_m_rec : out mm_m_rec_t) is + + variable addr : std_logic_vector(31 downto 0) := (others => '0'); + variable data : std_logic_vector(31 downto 0) := (others => '0'); + variable data_check : std_logic_vector(31 downto 0) := (others => '0'); + variable tmp_val : integer; + variable idx : integer; + variable loop_idx : integer; + + begin + + -- set the pulse width + addr := std_logic_vector(resize(unsigned(CSR_PD_PULSE_W_ADDR), 32)); + data := std_logic_vector(to_unsigned(integer(pulse_width*100.0),32)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); + + -- No need to use the sequerncer for a single pulse + if(single_pulse_mode = true) then + addr := std_logic_vector(resize(unsigned(CSR_PD_CTRL_ADDR), 32)); + mm_32b_write(addr, 32x"3", mm_s_rec, mm_m_rec); + log("Issued single PD pulse. ", VMEDIUM); + return; + end if; + + -- Use the sequencer to generate periodic pulses (here the periodicity is + -- in time): First program the sequencer RAM with instructions to generate + -- pulses with the specified periodicity, then enable the sequencer, + -- finally trigger the start of the procedure: + + -- Write in the Emulator sequencer a simple procedure to issue PD pulses + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+0, 32)); + mm_32b_write(addr, X"100000FF", mm_s_rec, mm_m_rec); -- Enable triggers + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+1, 32)); + mm_32b_write(addr, X"30000000", mm_s_rec, mm_m_rec); -- All the outputs to zero + idx := 2; + loop_idx := idx; + if(pd_period >= 1.0) then + -- add a first trigger-wait instruction for 1-us pulses + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+idx, 32)); + tmp_val := integer(pd_period); + data := X"21000" & std_logic_vector(to_unsigned(tmp_val, 12)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); -- trig_wait (us pulses) + idx := idx + 1; + end if; + -- add a second trigger on single clock cycle events + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+idx, 32)); + tmp_val := integer((pd_period-floor(pd_period))*100.0); + data := X"20000" & std_logic_vector(to_unsigned(tmp_val, 12)); + mm_32b_write(addr, data, mm_s_rec, mm_m_rec); -- trig_wait (clk pulses) + idx := idx + 1; + -- issue the PD pulse + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+idx, 32)); + mm_32b_write(addr, X"31000001", mm_s_rec, mm_m_rec); -- All the outputs to zero + idx := idx + 1; + -- Jump to the beginning of the loop + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+idx, 32)); + mm_32b_write(addr, X"31000001", mm_s_rec, mm_m_rec); -- All the outputs to zero + + -- Enable the sequencer + addr := std_logic_vector(resize(unsigned(SEQ_RAM_OFFSET)+idx, 32)); + mm_32b_write(addr, 32x"1", mm_s_rec, mm_m_rec); -- All the outputs to zero + + -- issue a start-request to the sequencer + addr := std_logic_vector(resize(unsigned(CSR_SEQ_CTRL_ADDR), 32)); + data(0) := '1'; -- start-request bit + data(24 downto 16) := 9x"0"; -- EAM sequence start-address + mm_32b_write(addr, 32x"1", mm_s_rec, mm_m_rec); + + log("Running PD pulses ... ", VMEDIUM); + + end procedure run_pd_pulses; + + ----------------------------------------------------------------------------- + -- Support functions + ----------------------------------------------------------------------------- + + -- generate the NCO increment corresponding to a given output frequency + function freq2NCO_inc( + f_out : real; f_clk : real) return std_logic_vector is + variable nco_inc : std_logic_vector(ENC_NCO_WIDTH-1 downto 0); + + begin + nco_inc := std_logic_vector(to_unsigned(integer((f_out/f_clk)*(2.0**ENC_NCO_WIDTH)),ENC_NCO_WIDTH)); + return nco_inc; + + end function freq2NCO_inc; + +end fire_pulse_manager_5_tb_pkg;