991 lines
38 KiB
VHDL
991 lines
38 KiB
VHDL
library ieee;
|
|
use ieee.std_logic_1164.all;
|
|
use ieee.numeric_std.all;
|
|
|
|
library osvvm; -- Utility Library
|
|
context osvvm.OsvvmContext;
|
|
|
|
use work.rtps_package.all;
|
|
use work.user_config.all;
|
|
use work.rtps_config_package.all;
|
|
use work.rtps_test_package.all;
|
|
|
|
|
|
entity rtps_builtin_endpoint_test4 is
|
|
end entity;
|
|
|
|
architecture testbench of rtps_builtin_endpoint_test4 is
|
|
|
|
-- *COMPONENT DECLARATION*
|
|
component rtps_builtin_endpoint is
|
|
port (
|
|
clk : in std_logic;
|
|
reset : in std_logic;
|
|
empty : in std_logic;
|
|
rd : out std_logic;
|
|
data_in : in std_logic_vector(WORD_WIDTH-1 downto 0);
|
|
data_out : out std_logic_vector(WORD_WIDTH-1 downto 0);
|
|
last_word_in : in std_logic;
|
|
time : in TIME_TYPE;
|
|
endpoint_full : in std_logic_vector(0 to NUM_ENDPOINTS-1);
|
|
endpoint_wr : out std_logic_vector(0 to NUM_ENDPOINTS-1);
|
|
rtps_wr : out std_logic;
|
|
rtps_full : in std_logic;
|
|
last_word_out : out std_logic;
|
|
alive : in std_logic_vector(0 to NUM_ENDPOINTS-1)
|
|
);
|
|
end component;
|
|
|
|
-- *TYPE DECLARATION*
|
|
type TEST_STAGE_TYPE is (IDLE, BUSY);
|
|
type MATCH_MATRIX_TYPE is array (0 to NUM_WRITERS-1) of std_logic_vector(0 to NUM_READERS-1);
|
|
|
|
-- *SIGNAL DECLARATION*
|
|
signal clk, in_empty, rd_sig, last_word_in, last_word_out: std_logic := '0';
|
|
signal reset : std_logic := '1';
|
|
signal endpoint_wr, endpoint_full : std_logic_vector(0 to NUM_ENDPOINTS-1) := (others => '0');
|
|
signal data_in, data_out : std_logic_vector(WORD_WIDTH-1 downto 0) := (others => '0');
|
|
signal stim_stage : TEST_STAGE_TYPE := IDLE;
|
|
shared variable stimulus, reference : TEST_PACKET_TYPE := EMPTY_TEST_PACKET;
|
|
signal packet_sent : std_logic := '0';
|
|
signal cnt_stim : natural := 0;
|
|
signal start : std_logic := '0';
|
|
shared variable SB_out : work.ScoreBoardPkg_builtin_endpoint.ScoreBoardPType;
|
|
shared variable SB_mem : work.ScoreBoardPkg_MemoryTest.ScoreBoardPType;
|
|
signal stim_done, check_done, mem_check : std_logic := '0';
|
|
|
|
-- *FUNCTION DECLARATION*
|
|
procedure wait_on_complete is
|
|
begin
|
|
wait until rising_edge(packet_sent);
|
|
end procedure;
|
|
|
|
begin
|
|
|
|
-- Unit Under Test
|
|
uut : rtps_builtin_endpoint
|
|
port map (
|
|
clk => clk,
|
|
reset => reset,
|
|
empty => in_empty or packet_sent,
|
|
rd => rd_sig,
|
|
data_in => data_in,
|
|
data_out => data_out,
|
|
last_word_in => last_word_in,
|
|
time => TIME_ZERO,
|
|
endpoint_full => endpoint_full,
|
|
endpoint_wr => endpoint_wr,
|
|
rtps_wr => open,
|
|
rtps_full => '0',
|
|
last_word_out => last_word_out,
|
|
alive => (others => '0')
|
|
);
|
|
|
|
stimulus_prc : process
|
|
variable sub, sub_p : RTPS_SUBMESSAGE_TYPE := DEFAULT_RTPS_SUBMESSAGE;
|
|
variable check_cnt : natural := 0;
|
|
variable RV : RandomPType;
|
|
variable p0, p1, p2, participant : PARTICIPANT_DATA_TYPE := DEFAULT_PARTICIPANT_DATA;
|
|
variable e0, e1, e2, e3, e4, e5, e6, endpoint : ENDPOINT_DATA_TYPE := DEFAULT_ENDPOINT_DATA;
|
|
variable p_sn, p0_sn, p1_sn, p2_sn : SEQUENCENUMBER_TYPE := FIRST_SEQUENCENUMBER;
|
|
variable wr_sig : std_logic_vector(0 to NUM_ENDPOINTS-1) := (others => '0');
|
|
|
|
-- Wrapper to use procedure as function
|
|
impure function gen_rand_loc_2 return LOCATOR_TYPE is
|
|
variable ret : LOCATOR_TYPE := EMPTY_LOCATOR;
|
|
begin
|
|
gen_rand_loc(RV, ret);
|
|
return ret;
|
|
end function;
|
|
|
|
impure function gen_rand_entityid_2(reader : boolean) return std_logic_vector is
|
|
variable ret : std_logic_vector(ENTITYID_WIDTH-1 downto 0) := (others => '0');
|
|
begin
|
|
gen_rand_entityid(RV, reader, ret);
|
|
return ret;
|
|
end function;
|
|
|
|
procedure push_reference is
|
|
begin
|
|
for i in 0 to reference.length-1 loop
|
|
SB_out.Push(wr_sig & reference.last(i) & reference.data(i));
|
|
end loop;
|
|
end procedure;
|
|
|
|
impure function gen_rand_guid_prefix return GUIDPREFIX_TYPE is
|
|
variable ret : GUIDPREFIX_TYPE;
|
|
begin
|
|
ret := (0 => RV.RandSlv(WORD_WIDTH), 1 => RV.RandSlv(WORD_WIDTH), 2 => RV.RandSlv(WORD_WIDTH));
|
|
return ret;
|
|
end function;
|
|
|
|
procedure start_test is
|
|
begin
|
|
start <= '1';
|
|
wait until rising_edge(clk);
|
|
start <= '0';
|
|
mem_check <= '0';
|
|
wait until rising_edge(clk);
|
|
end procedure;
|
|
begin
|
|
|
|
assert (TEST_STRING = "TEST_CONFIG_2") report "user_config incompatible with testbench." severity FAILURE;
|
|
|
|
SetAlertLogName("L0-rtps_builtin_endpoint-memory_handling");
|
|
SetAlertEnable(FAILURE, TRUE);
|
|
SetAlertEnable(ERROR, TRUE);
|
|
SetAlertEnable(WARNING, TRUE);
|
|
SetLogEnable(DEBUG, FALSE);
|
|
SetLogEnable(PASSED, FALSE);
|
|
SetLogEnable(INFO, TRUE);
|
|
RV.InitSeed(RV'instance_name);
|
|
|
|
-- Participant RTPS Submessage
|
|
sub := DEFAULT_RTPS_SUBMESSAGE;
|
|
sub.submessageID := SID_DATA;
|
|
sub.writerId := ENTITYID_SPDP_BUILTIN_PARTICIPANT_ANNOUNCER;
|
|
sub.readerId := ENTITYID_SPDP_BUILTIN_PARTICIPANT_DETECTOR;
|
|
sub.flags(SUBMESSAGE_DATA_FLAG_POS) := '1';
|
|
|
|
-- Publisher Endpoint RTPS Submessage
|
|
sub_p := DEFAULT_RTPS_SUBMESSAGE;
|
|
sub_p.submessageID := SID_DATA;
|
|
sub_p.writerId := ENTITYID_SEDP_BUILTIN_PUBLICATIONS_ANNOUNCER;
|
|
sub_p.readerId := ENTITYID_SEDP_BUILTIN_PUBLICATIONS_DETECTOR;
|
|
sub_p.flags(SUBMESSAGE_DATA_FLAG_POS) := '1';
|
|
|
|
-- Participant 0
|
|
p0.guidPrefix := gen_rand_guid_prefix;
|
|
p0.nr := 0;
|
|
p0.defaultUnicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
|
|
p0.availableBuiltinEndpoints(DISC_BUILTIN_ENDPOINT_SUBSCRIPTIONS_DETECTOR) := '1';
|
|
p0.availableBuiltinEndpoints(DISC_BUILTIN_ENDPOINT_PUBLICATIONS_ANNOUNCER) := '1';
|
|
|
|
-- Participant 1
|
|
p1.guidPrefix := gen_rand_guid_prefix;
|
|
p1.nr := 1;
|
|
p1.defaultUnicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
|
|
p1.availableBuiltinEndpoints(DISC_BUILTIN_ENDPOINT_SUBSCRIPTIONS_DETECTOR) := '1';
|
|
p1.availableBuiltinEndpoints(DISC_BUILTIN_ENDPOINT_PUBLICATIONS_ANNOUNCER) := '1';
|
|
|
|
-- Participant 2
|
|
p2.guidPrefix := gen_rand_guid_prefix;
|
|
p2.nr := 2;
|
|
p2.defaultUnicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
|
|
p2.availableBuiltinEndpoints(DISC_BUILTIN_ENDPOINT_SUBSCRIPTIONS_DETECTOR) := '1';
|
|
p2.availableBuiltinEndpoints(DISC_BUILTIN_ENDPOINT_PUBLICATIONS_ANNOUNCER) := '1';
|
|
|
|
-- Endpoint 0
|
|
e0.participant := p0;
|
|
e0.topic_name := ENDPOINT_TOPIC(0);
|
|
e0.type_name := ENDPOINT_TYPE(0);
|
|
e0.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
-- Endpoint 1
|
|
e1.participant := p0;
|
|
e1.topic_name := ENDPOINT_TOPIC(0);
|
|
e1.type_name := ENDPOINT_TYPE(0);
|
|
e1.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
-- Endpoint 2
|
|
e2.participant := p0;
|
|
e2.topic_name := ENDPOINT_TOPIC(0);
|
|
e2.type_name := ENDPOINT_TYPE(0);
|
|
e2.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
-- Endpoint 3
|
|
e3.participant := p0;
|
|
e3.topic_name := ENDPOINT_TOPIC(0);
|
|
e3.type_name := ENDPOINT_TYPE(0);
|
|
e3.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
-- Endpoint 4
|
|
e4.participant := p0;
|
|
e4.topic_name := ENDPOINT_TOPIC(0);
|
|
e4.type_name := ENDPOINT_TYPE(0);
|
|
e4.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
-- Endpoint 5
|
|
e5.participant := p0;
|
|
e5.topic_name := ENDPOINT_TOPIC(0);
|
|
e5.type_name := ENDPOINT_TYPE(0);
|
|
e5.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
-- Endpoint 6
|
|
e6.participant := p0;
|
|
e6.topic_name := ENDPOINT_TOPIC(0);
|
|
e6.type_name := ENDPOINT_TYPE(0);
|
|
e6.entityId := gen_rand_entityid_2(FALSE);
|
|
|
|
Log("Initiating Test", INFO);
|
|
mem_check <= '1';
|
|
stim_done <= '0';
|
|
start <= '0';
|
|
reset <= '1';
|
|
wait until rising_edge(clk);
|
|
wait until rising_edge(clk);
|
|
reset <= '0';
|
|
|
|
Log("Match Participant 0 [Pos 0]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p0;
|
|
participant.nr := 0;
|
|
participant.match := MATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p0]
|
|
|
|
Log("Match Participant 1 [Pos 1]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p1;
|
|
participant.nr := 1;
|
|
participant.match := MATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p0,p1]
|
|
|
|
Log("Match Endpoint 0 Participant 0 [Pos 0]", INFO);
|
|
sub_p.writerSN := p0_sn;
|
|
endpoint := e0;
|
|
endpoint.participant:= p0;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p0_sn := p0_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e0p0]
|
|
|
|
Log("Match Endpoint 1 Participant 0 [Pos 1]", INFO);
|
|
sub_p.writerSN := p0_sn;
|
|
endpoint := e1;
|
|
endpoint.participant:= p0;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p0_sn := p0_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e1p0,e0p0]
|
|
|
|
Log("Match Endpoint 2 Participant 0 [Pos 2]", INFO);
|
|
sub_p.writerSN := p0_sn;
|
|
endpoint := e2;
|
|
endpoint.participant:= p0;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p0_sn := p0_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e2p0,e1p0,e0p0]
|
|
|
|
Log("Match Endpoint 3 Participant 0 [Pos 3]", INFO);
|
|
sub_p.writerSN := p0_sn;
|
|
endpoint := e3;
|
|
endpoint.participant:= p0;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p0_sn := p0_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e3p0,e2p0,e1p0,e0p0]
|
|
|
|
Log("Match Endpoint 4 Participant 0 [Pos 4]", INFO);
|
|
sub_p.writerSN := p0_sn;
|
|
endpoint := e4;
|
|
endpoint.participant:= p0;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p0_sn := p0_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e4p0,e3p0,e2p0,e1p0,e0p0]
|
|
|
|
Log("Match Endpoint 0 Participant 1 [Pos 5]", INFO);
|
|
sub_p.writerSN := p1_sn;
|
|
endpoint := e0;
|
|
endpoint.participant:= p1;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p1_sn := p1_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e0p1,e4p0,e3p0,e2p0,e1p0,e0p0]
|
|
|
|
Log("Ignore Participant 2 [Memory Collision]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p2;
|
|
participant.nr := 2;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e0p1,e4p0,e3p0,e2p0,e1p0,e0p0]
|
|
|
|
Log("Ignore Endpoint 0 Participant 2 [No matching participant]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e0;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
-- MEMORY STATE [p0,p1/e0p1,e4p0,e3p0,e2p0,e1p0,e0p0]
|
|
|
|
Log("Match Endpoint 1 Participant 1 [Pos 6]", INFO);
|
|
sub_p.writerSN := p1_sn;
|
|
endpoint := e1;
|
|
endpoint.participant:= p1;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p1_sn := p1_sn + 1;
|
|
-- MEMORY STATE [p0,p1/e1p1,e0p1,e4p0,e3p0,e2p0,e1p0,e0p0]
|
|
|
|
Log("Unmatch Participant 0 and its Endpoints", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p0;
|
|
participant.protocolVersion := PROTOCOLVERSION_1_0;
|
|
participant.nr := 0;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
-- Endpoint UNMATCH
|
|
endpoint := e0;
|
|
endpoint.participant:= p0;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e1;
|
|
endpoint.participant:= p0;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e2;
|
|
endpoint.participant:= p0;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e3;
|
|
endpoint.participant:= p0;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e4;
|
|
endpoint.participant:= p0;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
p0_sn := FIRST_SEQUENCENUMBER;
|
|
-- MEMORY STATE [0,p1/e1p1,e0p1,0,0,0,0]
|
|
|
|
Log("Match Participant 2 [Pos 0]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p2;
|
|
participant.nr := 0;
|
|
participant.match := MATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p2,p1/e1p1,e0p1,0,0,0,0]
|
|
|
|
Log("Ignore Participant 0 [Memory Collision]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p0;
|
|
participant.nr := 2;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p2,p1/e1p1,e0p1,0,0,0,0]
|
|
|
|
Log("Ignore Endpoint 0 Participant 0 [No matching participant]", INFO);
|
|
sub_p.writerSN := p0_sn;
|
|
endpoint := e0;
|
|
endpoint.participant:= p0;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
-- MEMORY STATE [p2,p1/e1p1,e0p1,0,0,0,0]
|
|
|
|
Log("Match Endpoint 2 Participant 1 [Pos 0]", INFO);
|
|
sub_p.writerSN := p1_sn;
|
|
endpoint := e2;
|
|
endpoint.participant:= p1;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p1_sn := p1_sn + 1;
|
|
-- MEMORY STATE [p2,p1/e1p1,e0p1,0,0,0,e2p1]
|
|
|
|
Log("Match Endpoint 0 Participant 2 [Pos 1]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e0;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1;
|
|
-- MEMORY STATE [p2,p1/e1p1,e0p1,0,0,e0p2,e2p1]
|
|
|
|
Log("Unmatch Participant 1 and its Endpoints", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p1;
|
|
participant.protocolVersion := PROTOCOLVERSION_1_0;
|
|
participant.nr := 1;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
-- Endpoint UNMATCH
|
|
endpoint := e2;
|
|
endpoint.participant:= p1;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e0;
|
|
endpoint.participant:= p1;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e1;
|
|
endpoint.participant:= p1;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
p1_sn := FIRST_SEQUENCENUMBER;
|
|
-- MEMORY STATE [p2/e0p2,0]
|
|
|
|
Log("Match Participant 0 [Pos 1]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p0;
|
|
participant.nr := 1;
|
|
participant.match := MATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p2,p0/e0p2,0]
|
|
|
|
Log("Match Participant 1 [Pos 2]", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p1;
|
|
participant.nr := 2;
|
|
participant.match := MATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
-- MEMORY STATE [p2,p0,p1/e0p2,0]
|
|
|
|
Log("Match Endpoint 1 Participant 2 [Pos 0]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e1;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1;
|
|
-- MEMORY STATE [p2,p0,p1/e0p2,e1p2]
|
|
|
|
Log("Match Endpoint 2 Participant 2 [Pos 2]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e2;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1;
|
|
-- MEMORY STATE [p2,p0,p1/e2p2,e0p2,e1p2]
|
|
|
|
Log("Match Endpoint 3 Participant 2 [Pos 3]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e3;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1;
|
|
-- MEMORY STATE [p2,p0,p1/e3p2,e2p2,e0p2,e1p2]
|
|
|
|
Log("Match Endpoint 4 Participant 2 [Pos 4]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e4;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1;
|
|
-- MEMORY STATE [p2,p0,p1/e4p2,e3p2,e2p2,e0p2,e1p2]
|
|
|
|
Log("Ignore Endpoint 5 Participant 2 [Memory Collision]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e5;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference); -- Match Frame is generated, even if the Endpoint is not stored
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1; -- Sequence Number is processed even with memory collision
|
|
-- MEMORY STATE [p2,p0,p1/e4p2,e3p2,e2p2,e0p2,e1p2]
|
|
|
|
Log("Unmatch Participant 0", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p0;
|
|
participant.protocolVersion := PROTOCOLVERSION_1_0;
|
|
participant.nr := 1;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
p0_sn := FIRST_SEQUENCENUMBER;
|
|
-- MEMORY STATE [p2,0,p1/e4p2,e3p2,e2p2,e0p2,e1p2]
|
|
|
|
Log("Unmatch Participant 1", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p1;
|
|
participant.protocolVersion := PROTOCOLVERSION_1_0;
|
|
participant.nr := 2;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
p1_sn := FIRST_SEQUENCENUMBER;
|
|
-- MEMORY STATE [p2/e4p2,e3p2,e2p2,e0p2,e1p2]
|
|
|
|
Log("Match Endpoint 5 Participant 2 [Pos 5]", INFO);
|
|
sub_p.writerSN := p2_sn;
|
|
endpoint := e5;
|
|
endpoint.participant:= p2;
|
|
gen_endpoint_data(endpoint, sub_p.data);
|
|
gen_sentinel(sub_p.data);
|
|
gen_rtps_handler_out(sub_p, endpoint, stimulus);
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
start_test;
|
|
wait_on_complete;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub_p.data := EMPTY_TEST_PACKET;
|
|
p2_sn := p2_sn + 1;
|
|
-- MEMORY STATE [p2/e5p2,e4p2,e3p2,e2p2,e0p2,e1p2]
|
|
|
|
Log("Unmatch Participant 2 and its Endpoints", INFO);
|
|
sub.writerSN := p_sn;
|
|
participant := p2;
|
|
participant.protocolVersion := PROTOCOLVERSION_1_0;
|
|
participant.nr := 0;
|
|
participant.match := UNMATCH;
|
|
gen_participant_data(participant, sub.data);
|
|
gen_sentinel(sub.data);
|
|
gen_rtps_handler_out(sub, participant, stimulus);
|
|
SB_mem.Push(gen_participant_mem_frame(participant));
|
|
-- Endpoint UNMATCH
|
|
endpoint := e1;
|
|
endpoint.participant:= p2;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e0;
|
|
endpoint.participant:= p2;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e2;
|
|
endpoint.participant:= p2;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e3;
|
|
endpoint.participant:= p2;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e4;
|
|
endpoint.participant:= p2;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
endpoint := e5;
|
|
endpoint.participant:= p2;
|
|
endpoint.match := UNMATCH;
|
|
gen_match_frame(endpoint, reference);
|
|
wr_sig := (others => '1');
|
|
push_reference;
|
|
reference := EMPTY_TEST_PACKET;
|
|
start_test;
|
|
mem_check <= '1';
|
|
wait_on_complete;
|
|
check_cnt := check_cnt + TEST_PARTICIPANT_MEMORY_FRAME_TYPE'length;
|
|
stimulus := EMPTY_TEST_PACKET;
|
|
reference := EMPTY_TEST_PACKET;
|
|
sub.data := EMPTY_TEST_PACKET;
|
|
p_sn := p_sn + 1;
|
|
p1_sn := FIRST_SEQUENCENUMBER;
|
|
-- MEMORY STATE [0]
|
|
|
|
TranscriptOpen(RESULTS_FILE, APPEND_MODE);
|
|
SetTranscriptMirror;
|
|
stim_done <= '1';
|
|
wait until check_done = '1';
|
|
AlertIf(GetAffirmCount < check_cnt, "Incomplete test run");
|
|
ReportAlerts;
|
|
TranscriptClose;
|
|
std.env.stop;
|
|
wait;
|
|
end process;
|
|
|
|
clock_prc : process
|
|
begin
|
|
clk <= '0';
|
|
wait for 25 ns;
|
|
clk <= '1';
|
|
wait for 25 ns;
|
|
end process;
|
|
|
|
in_empty_prc : process
|
|
begin
|
|
in_empty <= '0';
|
|
wait; --TODO: Remove
|
|
wait until rd_sig = '1';
|
|
wait until rising_edge(clk);
|
|
in_empty <= '1';
|
|
wait until rising_edge(clk);
|
|
end process;
|
|
|
|
endpoint_full_prc : process
|
|
begin
|
|
endpoint_full <= (others => '0');
|
|
wait; --TODO: Remove
|
|
wait until (or endpoint_wr) = '1';
|
|
wait until rising_edge(clk);
|
|
endpoint_full <= (others => '1');
|
|
wait until rising_edge(clk);
|
|
end process;
|
|
|
|
alert_prc : process(all)
|
|
begin
|
|
if rising_edge(clk) then
|
|
alertif(in_empty = '1' and rd_sig = '1', "Input FIFO read signal high while empty signal high", ERROR);
|
|
alertif(endpoint_full /= (0 to NUM_ENDPOINTS-1 => '0') and (endpoint_wr /= (0 to NUM_ENDPOINTS-1 => '0')), "Endpoint FIFO write signal high while full signal high", ERROR);
|
|
end if;
|
|
end process;
|
|
|
|
input_prc : process(all)
|
|
begin
|
|
data_in <= stimulus.data(cnt_stim);
|
|
last_word_in <= stimulus.last(cnt_stim);
|
|
case (stim_stage) is
|
|
when IDLE =>
|
|
packet_sent <= '1';
|
|
when BUSY =>
|
|
packet_sent <= '0';
|
|
end case;
|
|
|
|
if rising_edge(clk) then
|
|
if (reset = '1') then
|
|
cnt_stim <= 0;
|
|
stim_stage <= IDLE;
|
|
else
|
|
case (stim_stage) is
|
|
when IDLE =>
|
|
if (start = '1') then
|
|
stim_stage <= BUSY;
|
|
cnt_stim <= 0;
|
|
end if;
|
|
when BUSY =>
|
|
if (cnt_stim = stimulus.length) then
|
|
stim_stage <= IDLE;
|
|
elsif (rd_sig = '1') then
|
|
cnt_stim <= cnt_stim + 1;
|
|
end if;
|
|
end case;
|
|
end if;
|
|
end if;
|
|
end process;
|
|
|
|
output_check_prc : process(all)
|
|
begin
|
|
check_done <= '0';
|
|
if rising_edge(clk) then
|
|
if (endpoint_wr /= (0 to NUM_ENDPOINTS-1 => '0')) then
|
|
SB_out.Check(endpoint_wr & last_word_out & data_out);
|
|
end if;
|
|
if (stim_done = '1' and SB_out.empty) then
|
|
check_done <= '1';
|
|
end if;
|
|
end if;
|
|
end process;
|
|
|
|
mem_check_prc : process
|
|
alias mem is <<signal uut.ram_inst.mem : TEST_RAM_TYPE>>;
|
|
alias mem_op_done is <<signal uut.mem_op_done : std_logic>>;
|
|
variable reference : TEST_PARTICIPANT_MEMORY_FRAME_TYPE;
|
|
begin
|
|
-- SAFEGUARD: (Prevent Fall-through Behavior)
|
|
if (reset /= '0') then
|
|
wait until reset = '0';
|
|
end if;
|
|
-- NOTE: The first read after the packet is sent signifies that the State Machine has begun processing the next packet.
|
|
-- The memory operation that could still be in progress is the last one concerning the last sent packet.
|
|
wait on packet_sent until (packet_sent = '1' and mem_check = '1');
|
|
if (rd_sig /= '1') then
|
|
wait until rd_sig = '1';
|
|
end if;
|
|
if (mem_op_done /= '1') then
|
|
wait until mem_op_done = '1';
|
|
end if;
|
|
if (not SB_mem.empty) then
|
|
SB_mem.Pop(reference);
|
|
for i in 0 to reference'length-1 loop
|
|
AffirmIf(?? (mem(reference(i).addr) ?= reference(i).data), "Address: " & integer'image(reference(i).addr) & " Received: " & to_hstring(mem(reference(i).addr)) & " Expected: " & to_hstring(reference(i).data));
|
|
end loop;
|
|
end if;
|
|
end process;
|
|
|
|
watchdog : process
|
|
begin
|
|
wait for 1 ms;
|
|
Alert("Test timeout", FAILURE);
|
|
std.env.stop;
|
|
end process;
|
|
|
|
end architecture; |