CORE-73 - The testbench now supports the legacy functionality

This commit is contained in:
gianmarcogirau 2020-01-06 14:42:31 +00:00
commit aa92da23b7
8 changed files with 1873 additions and 413 deletions

View 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;

View file

@ -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

View file

@ -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}

View file

@ -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;

View file

@ -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 =>

View file

@ -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,

View file

@ -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;

View file

@ -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;