rtps-fpga/src/Tests/Level_1/L1_rtps_writer_test1_vrkdp.vhd
Greek 6e20b8958d Add VHDL configuration for single_port_ram and FWFT_FIFO
Allow single_port_ram and FWFT_FIFO to have Altera specific
architectures.
2021-12-09 19:43:56 +01:00

1162 lines
47 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;
-- This testbench tests the RTPS Message generation of the RTPS Writer (DATA and GAP Generation).
-- This testbench covers following:
-- * (Best Effort/Transient Local/Expecting Inline Qos) Remote Readers
-- * New Data Push
-- * ACK Handling
-- * NACK/Request Handling
entity L1_rtps_writer_test1_vrkdp is
end entity;
architecture testbench of L1_rtps_writer_test1_vrkdp is
-- *CONSTANT DECLARATION*
constant MAX_REMOTE_ENDPOINTS : natural := 5;
constant MAX_CC : natural := 10;
-- *TYPE DECLARATION*
type SEND_STAGE_TYPE is (IDLE, BUSY);
type TEST_CC_ARRAY_TYPE is array (0 to MAX_CC-1) of CACHE_CHANGE_TYPE;
type HC_STAGE_TYPE is (IDLE, PUSH, DONE, INVALID);
-- *SIGNAL DECLARATION*
signal clk, empty_user, empty_meta, rd_user, rd_meta, last_word_in_user, last_word_in_meta, last_word_in_hc, last_word_out_rtps : std_logic := '0';
signal reset : std_logic := '1';
signal data_in_user, data_in_meta, data_out, data_in_hc : std_logic_vector(WORD_WIDTH-1 downto 0) := (others => '0');
signal wr_sig, full, data_available : std_logic := '0';
signal ready_in_hc, valid_in_hc, ack_hc, done_hc, get_data_hc, start_hc : std_logic := '0';
signal seq_nr_hc : SEQUENCENUMBER_TYPE := SEQUENCENUMBER_UNKNOWN;
signal stim_stage_user, stim_stage_meta : SEND_STAGE_TYPE := IDLE;
signal opcode_hc : HISTORY_CACHE_OPCODE_TYPE := NOP;
signal ret_hc : HISTORY_CACHE_RESPONSE_TYPE := ERROR;
signal cc_instance_handle : INSTANCE_HANDLE_TYPE := HANDLE_NIL;
signal cc_kind : CACHE_CHANGE_KIND_TYPE := ALIVE;
signal cc_source_timestamp : TIME_TYPE := TIME_INVALID;
signal cc_seq_nr : SEQUENCENUMBER_TYPE := SEQUENCENUMBER_UNKNOWN;
shared variable stimulus_user, stimulus_meta, reference : TEST_PACKET_TYPE := EMPTY_TEST_PACKET;
signal packet_sent_user, packet_sent_meta : std_logic := '0';
signal cnt_stim_meta, cnt_stim_user, count : natural := 0;
signal start_meta, start_user : std_logic := '0';
shared variable SB_out, SB_hc : osvvm.ScoreBoardPkg_slv.ScoreBoardPType;
signal stim_done, out_check_done, hc_check_done, test_done : std_logic := '0';
signal test_time : TIME_TYPE := TIME_ZERO;
signal fifo_in, fifo_out : std_logic_vector(WORD_WIDTH downto 0) := (others => '0');
signal fifo_wr, fifo_empty, fifo_full : std_logic := '0';
signal rtps_out_data : RTPS_OUT_DATA_TYPE := (others => (others => '0'));
signal rtps_out_rd, rtps_out_last_word_in, rtps_out_empty : std_logic_vector(0 to NUM_ENDPOINTS) := (others => '0');
signal test_cc : TEST_CC_ARRAY_TYPE := (others => DEFAULT_CACHE_CHANGE);
-- Signal containing the current fill level of the test_cc array
signal test_cc_fill : natural := 0;
signal stage_hc : HC_STAGE_TYPE := IDLE;
signal new_cc : std_logic := '0';
signal cnt : natural := 0;
-- *FUNCTION DECLARATION*
function gen_sn(input : natural) return SEQUENCENUMBER_TYPE is
variable ret : SEQUENCENUMBER_TYPE;
begin
ret(0) := (others => '0');
ret(1) := unsigned(int(input, WORD_WIDTH));
return ret;
end function;
begin
-- Unit Under Test
uut : entity work.rtps_writer(arch)
generic map (
RELIABILITY_QOS => RELIABLE_RELIABILITY_QOS,
LIVELINESS_QOS => AUTOMATIC_LIVELINESS_QOS,
DURABILITY_QOS => VOLATILE_DURABILITY_QOS,
DESTINATION_ORDER_QOS => BY_RECEPTION_TIMESTAMP_DESTINATION_ORDER_QOS,
ACKNACK_RESPONSE_DELAY => gen_duration(1,0),
ACKNACK_SUPPRESSION_DELAY => DURATION_ZERO,
LEASE_DURATION => DURATION_INFINITE,
HEARTBEAT_PERIOD => DURATION_INFINITE,
ENTITYID => DEFAULT_WRITER_ENTITYID,
WITH_KEY => TRUE,
PUSH_MODE => TRUE,
INLINE_QOS => gen_inline_qos(NUM_READERS+7),
MAX_REMOTE_ENDPOINTS => MAX_REMOTE_ENDPOINTS
)
port map (
clk => clk,
reset => reset,
time => test_time,
empty_user => empty_user or packet_sent_user,
rd_user => rd_user,
data_in_user => data_in_user,
last_word_in_user => last_word_in_user,
empty_meta => empty_meta or packet_sent_meta,
rd_meta => rd_meta,
data_in_meta => data_in_meta,
last_word_in_meta => last_word_in_meta,
alive_sig => open,
wr_ro => fifo_wr,
full_ro => fifo_full,
last_word_out_ro => fifo_in(WORD_WIDTH),
data_out_ro => fifo_in(WORD_WIDTH-1 downto 0),
liveliness_assertion => '0',
data_available => data_available,
start_hc => start_hc,
opcode_hc => opcode_hc,
ack_hc => ack_hc,
seq_nr_hc => seq_nr_hc,
done_hc => done_hc,
ret_hc => ret_hc,
get_data_hc => get_data_hc,
data_in_hc => data_in_hc,
valid_in_hc => valid_in_hc,
ready_in_hc => ready_in_hc,
last_word_in_hc => last_word_in_hc,
cc_instance_handle => cc_instance_handle,
cc_kind => cc_kind,
cc_source_timestamp => cc_source_timestamp,
cc_seq_nr => cc_seq_nr
);
fifo_inst : configuration work.FWFT_FIFO_cfg
generic map (
FIFO_DEPTH => 2,
DATA_WIDTH => WORD_WIDTH+1
)
port map
(
reset => reset,
clk => clk,
data_in => fifo_in,
write => fifo_wr,
read => rtps_out_rd(0),
data_out => fifo_out,
empty => fifo_empty,
full => fifo_full,
free => open
);
rtps_out_data <= (0 => fifo_out(WORD_WIDTH-1 downto 0), others => (others => '0'));
rtps_out_last_word_in <= (0 => fifo_out(WORD_WIDTH), others => '0');
rtps_out_empty <= (0 => fifo_empty, others => '1');
rtps_out_inst : entity work.rtps_out(arch)
port map (
clk => clk,
reset => reset,
data_in => rtps_out_data,
last_word_in=> rtps_out_last_word_in,
rd => rtps_out_rd,
empty => rtps_out_empty,
data_out => data_out,
wr => wr_sig,
full => full
);
stimulus_prc : process
variable RV : RandomPType;
variable e0, e1, e2, e3, e4, endpoint : ENDPOINT_DATA_TYPE := DEFAULT_ENDPOINT_DATA;
variable sub : RTPS_SUBMESSAGE_TYPE := DEFAULT_RTPS_SUBMESSAGE;
variable cc : CACHE_CHANGE_TYPE := DEFAULT_CACHE_CHANGE;
variable OUT_HEADER : OUTPUT_HEADER_TYPE := DEFAULT_OUTPUT_HEADER;
variable rtps_header : RTPS_HEADER_TYPE := DEFAULT_RTPS_HEADER;
alias idle_sig is <<signal uut.idle_sig : std_logic>>;
-- 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;
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;
impure function gen_key_hash return KEY_HASH_TYPE is
variable ret : KEY_HASH_TYPE := KEY_HASH_NIL;
begin
for i in 0 to KEY_HASH_TYPE'length-1 loop
ret(i) := RV.RandSlv(WORD_WIDTH);
end loop;
return ret;
end function;
impure function gen_payload return TEST_PACKET_TYPE is
variable ret : TEST_PACKET_TYPE := EMPTY_TEST_PACKET;
begin
for i in 0 to RV.RandInt(1,10) loop
ret.data(ret.length) := RV.RandSlv(WORD_WIDTH);
ret.length := ret.length + 1;
end loop;
ret.last(ret.length-1) := '1';
return ret;
end function;
procedure start_meta_test is
begin
start_meta <= '1';
wait until rising_edge(clk);
start_meta <= '0';
wait until rising_edge(clk);
end procedure;
procedure start_user_test is
begin
start_user <= '1';
wait until rising_edge(clk);
start_user <= '0';
wait until rising_edge(clk);
end procedure;
procedure wait_on_meta_sent is
begin
wait until rising_edge(packet_sent_meta);
end procedure;
procedure wait_on_user_sent is
begin
wait until rising_edge(packet_sent_user);
end procedure;
procedure wait_on_out_check is
begin
if (out_check_done /= '1') then
wait until out_check_done = '1';
end if;
end procedure;
procedure wait_on_hc_check is
begin
if (hc_check_done /= '1') then
wait until hc_check_done = '1';
end if;
end procedure;
procedure wait_on_completion is
begin
if (test_done /= '1') then
wait until test_done = '1';
end if;
end procedure;
procedure wait_on_idle is
begin
if (idle_sig /= '1') then
wait until idle_sig = '1';
end if;
end procedure;
procedure push_hc(opcode : in HISTORY_CACHE_OPCODE_TYPE; sn : in SEQUENCENUMBER_TYPE) is
begin
SB_hc.push(std_logic_vector(to_unsigned(HISTORY_CACHE_OPCODE_TYPE'pos(opcode),WORD_WIDTH)));
SB_hc.push(std_logic_vector(sn(0)));
SB_hc.push(std_logic_vector(sn(1)));
end procedure;
procedure gen_header(endpoint : in ENDPOINT_DATA_TYPE) is
begin
reference := EMPTY_TEST_PACKET;
-- OUTPUT HEADER
OUT_HEADER := DEFAULT_OUTPUT_HEADER;
OUT_HEADER := (dest => get_loc(endpoint), src => DEST_LOC.user.locator(1));
gen_output_header(OUT_HEADER, reference);
-- RTPS HEADER
rtps_header := DEFAULT_RTPS_HEADER;
rtps_header.guidPrefix := GUIDPREFIX;
gen_rtps_header(rtps_header, reference);
end procedure;
procedure gen_data(endpoint : in ENDPOINT_DATA_TYPE; ref : in CACHE_CHANGE_TYPE) is
begin
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_DATA;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := ENTITYID_UNKNOWN;
sub.submessageLength := (others => '0');
sub.writerSN := ref.seq_nr;
sub.flags(SUBMESSAGE_DATA_FLAG_POS) := '1' when (ref.kind = ALIVE) else '0';
sub.flags(SUBMESSAGE_KEY_FLAG_POS) := '1' when (ref.kind /= ALIVE) else '0';
sub.flags(SUBMESSAGE_INLINE_QOS_FLAG_POS) := '1';
gen_inline_qos(ref, gen_endpoint(NUM_READERS+7), (endpoint.expectsInlineQoS(0) = '1'), '0', sub.inlineQos);
gen_sentinel(sub.inlineQos);
assert (ref.payload /= EMPTY_TEST_PACKET) severity FAILURE;
sub.data := ref.payload;
gen_rtps_submessage(sub, reference);
end procedure;
procedure gen_ts(ts : TIME_TYPE) is
begin
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_INFO_TS;
sub.timestamp := ts;
gen_rtps_submessage(sub, reference);
end procedure;
procedure gen_gap(first : SEQUENCENUMBER_TYPE; last : SEQUENCENUMBER_TYPE) is
begin
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_GAP;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := ENTITYID_UNKNOWN;
sub.gapStart := first;
sub.gapList := (base => last, numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
gen_rtps_submessage(sub, reference);
end procedure;
procedure push_reference is
begin
fix_output_packet(reference);
for i in 0 to reference.length-1 loop
SB_out.Push(reference.data(i));
end loop;
end procedure;
begin
SetAlertLogName("rtps_writer - Level 1 - (Volatile, Reliable, Keyed, By Reception Timestamp, Push Mode) - RTPS Output (DATA & GAP)");
SetAlertEnable(FAILURE, TRUE);
SetAlertEnable(ERROR, TRUE);
SetAlertEnable(WARNING, TRUE);
SetLogEnable(DEBUG, FALSE);
SetLogEnable(PASSED, FALSE);
SetLogEnable(INFO, TRUE);
RV.InitSeed(RV'instance_name);
-- Endpoint 0
e0 := DEFAULT_ENDPOINT_DATA;
e0.nr := 0;
e0.match := MATCH;
e0.entityid := RV.RandSlv(ENTITYID_WIDTH);
e0.participant.guidPrefix := gen_rand_guid_prefix;
e0.unicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
-- Endpoint 1
e1 := DEFAULT_ENDPOINT_DATA;
e1.nr := 1;
e1.match := MATCH;
e1.entityid := RV.RandSlv(ENTITYID_WIDTH);
e1.participant.guidPrefix := gen_rand_guid_prefix;
e1.unicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
e1.reliability := BEST_EFFORT_RELIABILITY_QOS;
-- Endpoint 2
e2 := DEFAULT_ENDPOINT_DATA;
e2.nr := 2;
e2.match := MATCH;
e2.entityid := RV.RandSlv(ENTITYID_WIDTH);
e2.participant.guidPrefix := gen_rand_guid_prefix;
e2.unicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
e2.expectsInlineQoS(0) := '1';
-- Endpoint 3
e3 := DEFAULT_ENDPOINT_DATA;
e3.nr := 3;
e3.match := MATCH;
e3.entityid := RV.RandSlv(ENTITYID_WIDTH);
e3.participant.guidPrefix := gen_rand_guid_prefix;
e3.unicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
e3.durability := TRANSIENT_LOCAL_DURABILITY_QOS;
-- Endpoint 4
e4 := DEFAULT_ENDPOINT_DATA;
e4.nr := 4;
e4.match := MATCH;
e4.entityid := RV.RandSlv(ENTITYID_WIDTH);
e4.participant.guidPrefix := gen_rand_guid_prefix;
e4.unicastLocatorList := (numLocators => int(1,CDR_LONG_WIDTH), locator => (0 => gen_rand_loc_2, others => EMPTY_LOCATOR));
e4.expectsInlineQoS(0) := '1';
e4.durability := TRANSIENT_LOCAL_DURABILITY_QOS;
e4.reliability := BEST_EFFORT_RELIABILITY_QOS;
Log("Initiating Test", INFO);
Log("Current Time: 0s", INFO);
count <= 1;
test_time <= TIME_ZERO;
new_cc <= '0';
stim_done <= '0';
start_meta <= '0';
start_user <= '0';
reset <= '1';
wait until rising_edge(clk);
wait until rising_edge(clk);
reset <= '0';
Log("Insert Endpoint 0,1", INFO);
gen_endpoint_match_frame(e0, stimulus_meta);
gen_endpoint_match_frame(e1, stimulus_meta);
start_meta_test;
wait_on_meta_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Add Cache Change [SN 1] (Send DATA to Endpoint 0,1)", INFO);
test_cc(0).kind <= ALIVE;
test_cc(0).instance <= gen_key_hash;
test_cc(0).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(0).seq_nr <= gen_sn(1);
test_cc(0).src_timestamp <= gen_duration(1,0);
test_cc(0).payload <= gen_payload;
test_cc_fill <= 1;
new_cc <= '1';
wait until rising_edge(clk);
new_cc <= '0';
wait until rising_edge(clk);
gen_header(e0);
gen_data(e0, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(0));
push_reference;
wait_on_out_check;
wait_on_idle;
Log("Endpoint 0 sent ACKNACK [ACK SN <2] (Remove SN 1)", INFO);
endpoint := e0;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(2), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
push_hc(REMOVE_CACHE_CHANGE, gen_sn(1));
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
test_cc_fill <= 0;
Log("Add Cache Change [SN 2,3] (Send DATA to Endpoint 0,1)", INFO);
test_cc(0).kind <= ALIVE;
test_cc(0).instance <= gen_key_hash;
test_cc(0).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(0).seq_nr <= gen_sn(2);
test_cc(0).src_timestamp <= gen_duration(2,0);
test_cc(0).payload <= gen_payload;
test_cc(1).kind <= ALIVE;
test_cc(1).instance <= gen_key_hash;
test_cc(1).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(1).seq_nr <= gen_sn(3);
test_cc(1).src_timestamp <= gen_duration(3,0);
test_cc(1).payload <= gen_payload;
test_cc_fill <= 2;
new_cc <= '1';
wait until rising_edge(clk);
new_cc <= '0';
wait until rising_edge(clk);
gen_header(e0);
gen_data(e0, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(1));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(1));
push_reference;
wait_on_out_check;
wait_on_idle;
Log("Insert Endpoint 2,3", INFO);
gen_endpoint_match_frame(e2, stimulus_meta);
gen_endpoint_match_frame(e3, stimulus_meta);
start_meta_test;
wait_on_meta_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Endpoint 0 sent ACKNACK [ACK SN <4]", INFO);
endpoint := e0;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(4), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Endpoint 3 sent ACKNACK [ACK SN <2]", INFO);
endpoint := e3;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(2), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Add Cache Change [SN 4] (Send DATA to Endpoint 0,1,2,3)", INFO);
test_cc(2).kind <= ALIVE_FILTERED;
test_cc(2).instance <= gen_key_hash;
test_cc(2).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(2).seq_nr <= gen_sn(4);
test_cc(2).src_timestamp <= gen_duration(4,0);
test_cc(2).payload <= gen_payload;
test_cc_fill <= 3;
new_cc <= '1';
wait until rising_edge(clk);
new_cc <= '0';
wait until rising_edge(clk);
gen_header(e0);
gen_data(e0, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_data(e2, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(2));
push_reference;
wait_on_out_check;
wait_on_idle;
Log("Endpoint 3 sent ACKNACK [ACK SN <5] (Remove SN 2,3)", INFO);
endpoint := e3;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(5), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
push_hc(REMOVE_CACHE_CHANGE, gen_sn(2));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(3));
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
test_cc(0) <= test_cc(2);
test_cc_fill <= 1;
Log("Endpoint 0 sent ACKNACK [ACK SN <5]", INFO);
endpoint := e0;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(5), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Endpoint 2 sent ACKNACK [ACK SN <5] (Remove SN 4)", INFO);
endpoint := e2;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(5), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
push_hc(REMOVE_CACHE_CHANGE, gen_sn(4));
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
test_cc_fill <= 0;
Log("Add Cache Change [SN 10,11,15,46,50], (Send DATA to Endpoint 0,1,2,3)", INFO);
test_cc(0).kind <= ALIVE;
test_cc(0).instance <= gen_key_hash;
test_cc(0).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(0).seq_nr <= gen_sn(10);
test_cc(0).src_timestamp <= gen_duration(5,0);
test_cc(0).payload <= gen_payload;
test_cc(1).kind <= NOT_ALIVE_DISPOSED;
test_cc(1).instance <= gen_key_hash;
test_cc(1).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(1).seq_nr <= gen_sn(11);
test_cc(1).src_timestamp <= gen_duration(6,0);
test_cc(1).payload <= gen_payload;
test_cc(2).kind <= NOT_ALIVE_UNREGISTERED;
test_cc(2).instance <= gen_key_hash;
test_cc(2).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(2).seq_nr <= gen_sn(15);
test_cc(2).src_timestamp <= gen_duration(7,0);
test_cc(2).payload <= gen_payload;
test_cc(3).kind <= NOT_ALIVE_DISPOSED;
test_cc(3).instance <= gen_key_hash;
test_cc(3).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(3).seq_nr <= gen_sn(37);
test_cc(3).src_timestamp <= gen_duration(8,0);
test_cc(3).payload <= gen_payload;
test_cc(4).kind <= ALIVE;
test_cc(4).instance <= gen_key_hash;
test_cc(4).writer_guid <= to_guid(GUIDPREFIX, DEFAULT_WRITER_ENTITYID);
test_cc(4).seq_nr <= gen_sn(50);
test_cc(4).src_timestamp <= gen_duration(9,0);
test_cc(4).payload <= gen_payload;
test_cc_fill <= 5;
new_cc <= '1';
wait until rising_edge(clk);
new_cc <= '0';
wait until rising_edge(clk);
gen_header(e0);
gen_data(e0, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_data(e2, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(1));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(1));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_data(e2, test_cc(1));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(1));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_data(e2, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(3));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(3));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_data(e2, test_cc(3));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(3));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(4));
push_reference;
wait_on_out_check;
gen_header(e1);
gen_data(e1, test_cc(4));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_data(e2, test_cc(4));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(4));
push_reference;
wait_on_out_check;
wait_on_out_check;
wait_on_idle;
Log("Endpoint 0 sent ACKNACK [Request SN 10,15,37]", INFO);
endpoint := e0;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(5), numBits => int(35, CDR_LONG_WIDTH), bitmap => (5 => '1', 10 => '1', 32 => '1', others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Current Time: 1s", INFO);
Log("Send SN 10,15,37 to Endpoint 0", INFO);
test_time <= gen_duration(1,0);
wait until rising_edge(clk);
wait until rising_edge(clk); -- Allow idle_sig to go low
gen_header(e0);
gen_data(e0, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e0);
gen_data(e0, test_cc(3));
push_reference;
wait_on_out_check;
wait_on_idle;
Log("Endpoint 0 sent ACKNACK [ACK SN <15]", INFO);
endpoint := e0;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(15), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Endpoint 2 sent ACKNACK [ACK SN <10, Request SN 10]", INFO);
endpoint := e2;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(10), numBits => int(1, CDR_LONG_WIDTH), bitmap => (0 => '1', others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Current Time: 1.5s", INFO);
test_time <= gen_duration(1,500);
wait until rising_edge(clk);
wait until rising_edge(clk); -- Allow idle_sig to go low
wait_on_idle;
Log("Endpoint 2 sent ACKNACK [ACK SN <15, Request SN 15,16,47]", INFO);
endpoint := e2;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(15), numBits => int(33, CDR_LONG_WIDTH), bitmap => (0 => '1', 1 => '1', 32 => '1', others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Current Time: 2s", INFO);
Log("Send SN 15 to Endpoint 0 (GAP for SN 16, and ignore Request for SN 47)", INFO);
test_time <= gen_duration(2,0);
wait until rising_edge(clk);
wait until rising_edge(clk); -- Allow idle_sig to go low
gen_header(e2);
gen_data(e2, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e2);
gen_gap(gen_sn(16), gen_sn(17));
push_reference;
wait_on_out_check;
wait_on_idle;
Log("Endpoint 3 sent ACKNACK [Request SN 1-32]", INFO);
endpoint := e3;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(1), numBits => int(32, CDR_LONG_WIDTH), bitmap => (0 to 31 => '1', others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Current Time: 3s", INFO);
Log("Send SN 10,11,15 to Endpoint 3 (GAPs for Rest)", INFO);
test_time <= gen_duration(3,0);
wait until rising_edge(clk);
wait until rising_edge(clk); -- Allow idle_sig to go low
gen_header(e3);
gen_gap(gen_sn(1), gen_sn(10));
gen_data(e3, test_cc(0));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_data(e3, test_cc(1));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_gap(gen_sn(12), gen_sn(15));
gen_data(e3, test_cc(2));
push_reference;
wait_on_out_check;
gen_header(e3);
gen_gap(gen_sn(16), gen_sn(32));
push_reference;
wait_on_out_check;
wait_on_idle;
Log("Insert Endpoint 4", INFO);
gen_endpoint_match_frame(e4, stimulus_meta);
start_meta_test;
wait_on_meta_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
Log("Endpoint 3 sent ACKNACK [ACK SN <15] (Remove SN 5,6,7,8,9,10,11,12,13,14)", INFO);
endpoint := e3;
sub := DEFAULT_RTPS_SUBMESSAGE;
sub.submessageID := SID_ACKNACK;
sub.writerId := DEFAULT_WRITER_ENTITYID;
sub.readerId := endpoint.entityid;
sub.count := std_logic_vector(to_unsigned(count, CDR_LONG_WIDTH));
sub.readerSNState := (base => gen_sn(15), numBits => int(0, CDR_LONG_WIDTH), bitmap => (others => '0'));
sub.flags(SUBMESSAGE_FINAL_FLAG_POS) := '1';
gen_rtps_handler_out(sub, get_loc(endpoint), FALSE, TIME_INVALID, endpoint.participant.guidPrefix, stimulus_user);
push_hc(REMOVE_CACHE_CHANGE, gen_sn(5));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(6));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(7));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(8));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(9));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(10));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(11));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(12));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(13));
push_hc(REMOVE_CACHE_CHANGE, gen_sn(14));
start_user_test;
wait_on_user_sent;
stimulus_meta := EMPTY_TEST_PACKET;
stimulus_user := EMPTY_TEST_PACKET;
wait_on_idle;
stim_done <= '1';
wait_on_completion;
TranscriptOpen(RESULTS_FILE, APPEND_MODE);
SetTranscriptMirror;
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;
empty_meta_prc : process
begin
empty_meta <= '0';
wait until rd_meta = '1';
wait until rising_edge(clk);
empty_meta <= '1';
wait until rising_edge(clk);
end process;
empty_user_prc : process
begin
empty_user <= '0';
wait until rd_user = '1';
wait until rising_edge(clk);
empty_user <= '1';
wait until rising_edge(clk);
end process;
rtps_full_prc : process
begin
full <= '0';
wait until wr_sig = '1';
wait until rising_edge(clk);
full <= '1';
wait until rising_edge(clk);
end process;
alert_prc : process(all)
begin
if rising_edge(clk) then
alertif(empty_meta = '1' and rd_meta = '1', "Input FIFO read signal high while empty signal high (meta)", ERROR);
alertif(empty_user = '1' and rd_user = '1', "Input FIFO read signal high while empty signal high (user)", ERROR);
alertif(full = '1' and wr_sig = '1', "Output FIFO write signal high while full signal high", ERROR);
end if;
end process;
input_meta_prc : process(all)
begin
data_in_meta <= stimulus_meta.data(cnt_stim_meta);
last_word_in_meta <= stimulus_meta.last(cnt_stim_meta);
if rising_edge(clk) then
if (reset = '1') then
cnt_stim_meta <= 0;
stim_stage_meta <= IDLE;
packet_sent_meta <= '1';
else
case (stim_stage_meta) is
when IDLE =>
if (start_meta = '1' and stimulus_meta.length /= 0) then
stim_stage_meta <= BUSY;
packet_sent_meta <= '0';
end if;
when BUSY =>
if (rd_meta = '1') then
if (cnt_stim_meta = stimulus_meta.length-1) then
stim_stage_meta <= IDLE;
packet_sent_meta <= '1';
cnt_stim_meta <= 0;
else
cnt_stim_meta <= cnt_stim_meta + 1;
end if;
end if;
end case;
end if;
end if;
end process;
input_user_prc : process(all)
begin
data_in_user <= stimulus_user.data(cnt_stim_user);
last_word_in_user <= stimulus_user.last(cnt_stim_user);
if rising_edge(clk) then
if (reset = '1') then
cnt_stim_user <= 0;
stim_stage_user <= IDLE;
packet_sent_user <= '1';
else
case (stim_stage_user) is
when IDLE =>
if (start_user = '1' and stimulus_user.length /= 0) then
stim_stage_user <= BUSY;
packet_sent_user <= '0';
end if;
when BUSY =>
if (rd_user = '1') then
if (cnt_stim_user = stimulus_user.length-1) then
stim_stage_user <= IDLE;
packet_sent_user <= '1';
cnt_stim_user <= 0;
else
cnt_stim_user <= cnt_stim_user + 1;
end if;
end if;
end case;
end if;
end if;
end process;
done_proc : process(clk)
begin
if rising_edge(clk) then
if (stim_done = '1' and SB_out.empty and SB_hc.empty) then
test_done <= '1';
else
test_done <= '0';
end if;
end if;
end process;
hc_prc : process (all)
variable stimulus : TEST_PACKET_TYPE := EMPTY_TEST_PACKET;
variable bool : boolean := FALSE;
begin
if (new_cc = '1') then
data_available <= '1';
end if;
if rising_edge(clk) then
hc_check_done <= '0';
case (stage_hc) is
when IDLE =>
if (start_hc = '1') then
ack_hc <= '1';
case (opcode_hc) is
when GET_CACHE_CHANGE =>
bool := FALSE;
for i in 0 to test_cc_fill-1 loop
if (test_cc(i).seq_nr = seq_nr_hc) then
cc_instance_handle <= test_cc(i).instance;
cc_source_timestamp <= test_cc(i).src_timestamp;
cc_kind <= test_cc(i).kind;
stimulus := test_cc(i).payload;
stage_hc <= DONE;
bool := TRUE;
end if;
end loop;
if (not bool) then
stage_hc <= INVALID;
end if;
when GET_MIN_SN =>
stimulus := EMPTY_TEST_PACKET;
cc_seq_nr <= test_cc(0).seq_nr;
stage_hc <= DONE;
when GET_MAX_SN =>
data_available <= '0';
stimulus := EMPTY_TEST_PACKET;
cc_seq_nr <= test_cc(test_cc_fill-1).seq_nr when (test_cc_fill /= 0) else SEQUENCENUMBER_UNKNOWN;
stage_hc <= DONE;
when others =>
SB_hc.Check(std_logic_vector(to_unsigned(HISTORY_CACHE_OPCODE_TYPE'pos(opcode_hc), WORD_WIDTH)));
SB_hc.Check(std_logic_vector(seq_nr_hc(0)));
SB_hc.Check(std_logic_vector(seq_nr_hc(1)));
hc_check_done <= '1';
stage_hc <= DONE;
end case;
end if;
when DONE =>
if (get_data_hc = '1') then
alertif(stimulus = EMPTY_TEST_PACKET, "Requested empty Payload", FAILURE);
stage_hc <= PUSH;
cnt <= 0;
else
stage_hc <= IDLE;
end if;
when PUSH =>
if (ready_in_hc = '1') then
cnt <= cnt + 1;
if (cnt = stimulus.length-1) then
stage_hc <= IDLE;
end if;
end if;
when INVALID =>
stage_hc <= IDLE;
when others =>
null;
end case;
end if;
-- DEFAULT
ack_hc <= '0';
valid_in_hc <= '0';
data_in_hc <= (others => '0');
last_word_in_hc <= '0';
done_hc <= '0';
ret_hc <= ERROR;
case (stage_hc) is
when IDLE =>
if (start_hc = '1') then
ack_hc <= '1';
end if;
when DONE =>
done_hc <= '1';
ret_hc <= OK;
when PUSH =>
valid_in_hc <= '1';
data_in_hc <= stimulus.data(cnt);
last_word_in_hc <= stimulus.last(cnt);
when INVALID =>
done_hc <= '1';
ret_hc <= INVALID;
when others =>
null;
end case;
end process;
output_check_prc : process(all)
begin
if (SB_out.empty) then
out_check_done <= '1';
else
out_check_done <= '0';
end if;
if rising_edge(clk) then
if (wr_sig = '1') then
SB_out.Check(data_out);
end if;
end if;
end process;
watchdog : process
begin
wait for 1 ms;
Alert("Test timeout", FAILURE);
std.env.stop;
end process;
end architecture;