CORE-73 - The testbench now supports the legacy functionality
This commit is contained in:
parent
464a8ea1cb
commit
aa92da23b7
8 changed files with 1873 additions and 413 deletions
703
generic_ip/common/0/src/test/avalon_verify_pkg_2.vhd
Normal file
703
generic_ip/common/0/src/test/avalon_verify_pkg_2.vhd
Normal file
|
|
@ -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;
|
||||
|
|
@ -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
|
||||
|
|
|
|||
|
|
@ -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}
|
||||
|
|
|
|||
|
|
@ -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;
|
||||
|
|
|
|||
|
|
@ -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 =>
|
||||
|
|
|
|||
|
|
@ -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,
|
||||
|
|
|
|||
|
|
@ -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 <<signal iDUT.pd_pulse : std_logic>>;
|
||||
alias abs_spy is <<signal iDUT.abs_pos : std_logic_vector(31 downto 0)>>;
|
||||
|
||||
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;
|
||||
|
||||
|
|
|
|||
|
|
@ -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;
|
||||
Loading…
Add table
Add a link
Reference in a new issue