-- altera vhdl_input_version vhdl_2008
-- XXX: QSYS Fix (https://www.intel.com/content/www/us/en/support/programmable/articles/000079458.html)

library ieee;
use ieee.std_logic_1164.all;
use ieee.numeric_std.all;

use work.rtps_package.all;
use work.user_config.all;
use work.rtps_config_package.all;
use work.Type1_package.all;

entity L2_Testbench_Lib4 is
    port (
        -- SYSTEM
        clk         : in std_logic;
        reset       : in std_logic;
        time        : in TIME_TYPE;
        -- INPUT
        empty       : in std_logic;
        read        : out std_logic;
        data_in     : in std_logic_vector(WORD_WIDTH-1 downto 0);
        -- OUTPUT
        full        : in std_logic;
        write       : out std_logic;
        data_out    : out std_logic_vector(WORD_WIDTH-1 downto 0)
    );
end entity;

architecture arch of L2_Testbench_Lib4 is
    
    -- TODO: Better Names?
    type EARRAY_DATA_TYPE is array (0 to NUM_ENDPOINTS-1) of std_logic_vector(WORD_WIDTH downto 0);
    type HISTORY_CACHE_OPCODE_RARRAY_TYPE is array (0 to NUM_READERS-1) of HISTORY_CACHE_OPCODE_TYPE;
    type HISTORY_CACHE_OPCODE_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of HISTORY_CACHE_OPCODE_TYPE;
    type HISTORY_CACHE_RESPONSE_RARRAY_TYPE is array (0 to NUM_READERS-1) of HISTORY_CACHE_RESPONSE_TYPE;
    type HISTORY_CACHE_RESPONSE_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of HISTORY_CACHE_RESPONSE_TYPE;
    type RARRAY_DATA_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(WORD_WIDTH downto 0);
    type WARRAY_DATA_TYPE is array (0 to NUM_WRITERS-1) of std_logic_vector(WORD_WIDTH downto 0);
    type SEQUENCENUMBER_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of SEQUENCENUMBER_TYPE;
    type INSTANCE_HANDLE_RARRAY_TYPE is array (0 to NUM_READERS-1) of INSTANCE_HANDLE_TYPE;
    type INSTANCE_HANDLE_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of INSTANCE_HANDLE_TYPE;
    type CACHE_CHANGE_KIND_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of CACHE_CHANGE_KIND_TYPE;
    type TIME_RARRAY_TYPE is array (0 to NUM_READERS-1) of TIME_TYPE;
    type TIME_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of TIME_TYPE;
    type DDS_READER_OPCODE_RARRAY_TYPE is array (0 to NUM_READERS-1) of DDS_READER_OPCODE_TYPE;
    type DDS_WRITER_OPCODE_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of DDS_WRITER_OPCODE_TYPE;
    type INSTANCE_STATE_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(INSTANCE_STATE_KIND_WIDTH-1 downto 0);
    type VIEW_STATE_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(VIEW_STATE_KIND_WIDTH-1 downto 0);
    type SAMPLE_STATE_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(SAMPLE_STATE_KIND_WIDTH-1 downto 0);
    type MAX_SAMPLES_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(MAX_SAMPLES_WIDTH-1 downto 0);
    type RETURN_CODE_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(RETURN_CODE_WIDTH-1 downto 0);
    type RETURN_CODE_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of std_logic_vector(RETURN_CODE_WIDTH-1 downto 0);
    type DISPOSED_GENERATION_COUNT_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(DISPOSED_GENERATION_COUNT_WIDTH-1 downto 0);
    type NO_WRITERS_GENERATION_COUNT_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(NO_WRITERS_GENERATION_COUNT_WIDTH-1 downto 0);
    type SAMPLE_RANK_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(SAMPLE_RANK_WIDTH-1 downto 0);
    type GENERATION_RANK_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(GENERATION_RANK_WIDTH-1 downto 0);
    type ABSOLUTE_GENERATION_RANK_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(ABSOLUTE_GENERATION_COUNT_WIDTH-1 downto 0);
    type STATUS_KIND_RARRAY_TYPE is array (0 to NUM_READERS-1) of std_logic_vector(STATUS_KIND_WIDTH-1 downto 0);
    type STATUS_KIND_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of std_logic_vector(STATUS_KIND_WIDTH-1 downto 0);
    type DURATION_WARRAY_TYPE is array (0 to NUM_WRITERS-1) of DURATION_TYPE;
    
    signal full_fire_rh, write_rh_fire : std_logic_vector(0 to NUM_ENDPOINTS-1);
    signal data_rh_fire, data_rh_firb : std_logic_vector(WORD_WIDTH downto 0);
    signal full_firb_rh, write_rh_firb : std_logic;
    signal read_rb_firb, empty_firb_rb : std_logic;
    signal data_firb_rb : std_logic_vector(WORD_WIDTH downto 0);
    signal read_re_fire, empty_fire_re : std_logic_vector(0 to NUM_ENDPOINTS);
    signal data_fire_re : EARRAY_DATA_TYPE;
    signal alive_re_rb, full_frbre_re, write_rb_frbre : std_logic_vector(0 to NUM_ENDPOINTS-1);
    signal data_rb_frbre , data_rb_firo : std_logic_vector(WORD_WIDTH downto 0);
    signal full_firo_rb, write_rb_firo : std_logic;
    signal empty_frbre_re, read_re_frbre : std_logic_vector(0 to NUM_ENDPOINTS-1);
    signal data_frbre_re : EARRAY_DATA_TYPE;
    signal full_firo_re, write_re_firo : std_logic_vector(0 to NUM_ENDPOINTS-1);
    signal data_re_firo : EARRAY_DATA_TYPE;
    signal start_rr_dr, ack_dr_rr, done_dr_rr, valid_rr_dr, ready_dr_rr : std_logic_vector(0 to NUM_READERS-1);
    signal opcode_rr_dr : HISTORY_CACHE_OPCODE_RARRAY_TYPE;
    signal ret_dr_rr : HISTORY_CACHE_RESPONSE_RARRAY_TYPE;
    signal data_rr_dr : RARRAY_DATA_TYPE;
    signal liveliness_assertion_dw_rw, data_available_dw_rw, start_rw_dw, ack_dw_rw, done_rw_dw, get_data_rw_dw, valid_dw_rw, ready_rw_dw : std_logic_vector(0 to NUM_WRITERS-1);
    signal opcode_rw_dw : HISTORY_CACHE_OPCODE_WARRAY_TYPE;
    signal seq_nr_rw_dw, cc_seq_nr_dw_rw : SEQUENCENUMBER_WARRAY_TYPE;
    signal ret_dw_rw : HISTORY_CACHE_RESPONSE_WARRAY_TYPE;
    signal data_dw_rw : WARRAY_DATA_TYPE;
    signal cc_instance_handle_dw_rw : INSTANCE_HANDLE_WARRAY_TYPE;
    signal cc_kind_dw_rw : CACHE_CHANGE_KIND_WARRAY_TYPE;
    signal cc_source_timestamp_dw_rw : TIME_WARRAY_TYPE;
    signal start_ri_dr, ack_dr_ri, get_data_ri_dr, done_dr_ri, ready_ri_dr, valid_dr_ri, si_valid_data_dr_ri, si_valid_dr_ri, si_ack_ri_dr, eoc_dr_ri : std_logic_vector(0 to NUM_READERS-1);
    signal opcode_ri_dr : DDS_READER_OPCODE_RARRAY_TYPE;
    signal instance_state_ri_dr, si_instance_state_dr_ri : INSTANCE_STATE_RARRAY_TYPE;
    signal view_state_ri_dr, si_view_state_dr_ri : VIEW_STATE_RARRAY_TYPE;
    signal sample_state_ri_dr, si_sample_state_dr_ri : SAMPLE_STATE_RARRAY_TYPE;
    signal instance_handle_ri_dr, si_instance_handle_dr_ri, si_publication_handle_dr_ri : INSTANCE_HANDLE_RARRAY_TYPE;
    signal max_samples_ri_dr : MAX_SAMPLES_RARRAY_TYPE;
    signal return_code_dr_ri : RETURN_CODE_RARRAY_TYPE;
    signal data_dr_ri : RARRAY_DATA_TYPE;
    signal si_source_timestamp_dr_ri : TIME_RARRAY_TYPE;
    signal si_disposed_generation_count_dr_ri : DISPOSED_GENERATION_COUNT_RARRAY_TYPE;
    signal si_no_writers_generation_count_dr_ri : NO_WRITERS_GENERATION_COUNT_RARRAY_TYPE;
    signal si_sample_rank_dr_ri : SAMPLE_RANK_RARRAY_TYPE;
    signal si_generation_rank_dr_ri : GENERATION_RANK_RARRAY_TYPE;
    signal si_absolute_generation_rank_dr_ri : ABSOLUTE_GENERATION_RANK_RARRAY_TYPE;
    signal status_dr_ri : STATUS_KIND_RARRAY_TYPE;
    signal start_wi_dw, ack_dw_wi, done_dw_wi, valid_wi_dw, valid_dw_wi, ready_wi_dw, ready_dw_wi : std_logic_vector(0 to NUM_WRITERS-1);
    signal opcode_wi_dw : DDS_WRITER_OPCODE_WARRAY_TYPE;
    signal instance_handle_wi_dw, instance_handle_dw_wi : INSTANCE_HANDLE_WARRAY_TYPE;
    signal source_ts_wi_dw : TIME_WARRAY_TYPE;
    signal max_wait_wi_dw : DURATION_WARRAY_TYPE;
    signal return_code_dw_wi : RETURN_CODE_WARRAY_TYPE;
    signal data_dw_wi, data_wi_dw : WARRAY_DATA_TYPE;
    signal status_dw_wi : STATUS_KIND_WARRAY_TYPE;
    signal empty_firo_ro, read_ro_firo, last_word_firo_ro : std_logic_vector(0 to NUM_ENDPOINTS);
    signal data_firo_ro : RTPS_OUT_DATA_TYPE;
    signal start_user_ri, ack_ri_user, get_data_user_ri, done_ri_user, si_valid_data_ri_user, si_valid_ri_user, si_ack_user_ri, eoc_ri_user, decode_error_ri_user, valid_ri_user : std_logic;
    signal opcode_user_ri : DDS_READER_OPCODE_TYPE;
    signal instance_state_user_ri, si_instance_state_ri_user : std_logic_vector(INSTANCE_STATE_KIND_WIDTH-1 downto 0);
    signal view_state_user_ri, si_view_state_ri_user : std_logic_vector(VIEW_STATE_KIND_WIDTH-1 downto 0);
    signal sample_state_user_ri, si_sample_state_ri_user : std_logic_vector(SAMPLE_STATE_KIND_WIDTH-1 downto 0);
    signal max_samples_user_ri : std_logic_vector(MAX_SAMPLES_WIDTH-1 downto 0);
    signal instance_handle_user_ri, si_instance_handle_ri_user, si_publication_handle_ri_user : INSTANCE_HANDLE_TYPE;
    signal return_code_ri_user : std_logic_vector(RETURN_CODE_WIDTH-1 downto 0);
    signal si_source_timestamp_ri_user : TIME_TYPE;
    signal si_disposed_generation_count_ri_user : std_logic_vector(DISPOSED_GENERATION_COUNT_WIDTH-1 downto 0);
    signal si_no_writers_generation_count_ri_user : std_logic_vector(NO_WRITERS_GENERATION_COUNT_WIDTH-1 downto 0);
    signal si_sample_rank_ri_user : std_logic_vector(SAMPLE_RANK_WIDTH-1 downto 0);
    signal si_generation_rank_ri_user : std_logic_vector(GENERATION_RANK_WIDTH-1 downto 0);
    signal si_absolute_generation_rank_ri_user : std_logic_vector(ABSOLUTE_GENERATION_COUNT_WIDTH-1 downto 0);
    signal status_ri_user : std_logic_vector(STATUS_KIND_WIDTH-1 downto 0);
    signal id_ri_user, a_ri_user : std_logic_vector(CDR_LONG_WIDTH-1 downto 0);
    signal start_user_wi, ack_wi_user, done_wi_user : std_logic;
    signal opcode_user_wi : DDS_WRITER_OPCODE_TYPE;
    signal instance_handle_user_wi, instance_handle_wi_user : INSTANCE_HANDLE_TYPE;
    signal source_ts_user_wi : TIME_TYPE;
    signal max_wait_user_wi : DURATION_TYPE;
    signal return_code_wi_user : std_logic_vector(RETURN_CODE_WIDTH-1 downto 0);
    signal status_wi_user : std_logic_vector(STATUS_KIND_WIDTH-1 downto 0);
    signal id_user_wi, a_user_wi : std_logic_vector(CDR_LONG_WIDTH-1 downto 0);
    signal encode_done_wi_user : std_logic;
    
begin
    
    
    rtps_handler_inst : entity work.rtps_handler(arch)
        port map (
            -- SYSTEM
            clk                 => clk,
            reset               => reset,
            -- INPUT
            empty               => empty,
            rd                  => read,
            data_in             => data_in,
            -- TO DISCOVERY MODULE
            full_dm             => full_firb_rh,
            wr_dm               => write_rh_firb,
            data_out_dm         => data_rh_firb(WORD_WIDTH-1 downto 0),
            last_word_out_dm    => data_rh_firb(WORD_WIDTH),
            -- TO USER ENDPOINTS
            full_rtps             => full_fire_rh,
            wr_rtps               => write_rh_fire,
            data_out_rtps         => data_rh_fire(WORD_WIDTH-1 downto 0),
            last_word_out_rtps    => data_rh_fire(WORD_WIDTH)
        );
    
    
    fifo_in_rb_inst : configuration work.FWFT_FIFO_cfg
            generic map (
                FIFO_DEPTH  => 2,
                DATA_WIDTH  => WORD_WIDTH+1
            )
            port map (
                -- SYSTEM
                reset       => reset,
                clk         => clk,
                -- INPUT
                full        => full_firb_rh,
                write       => write_rh_firb,
                data_in     => data_rh_firb,
                -- OUTPUT
                empty       => empty_firb_rb,
                read        => read_rb_firb,
                data_out    => data_firb_rb,
                -- MISC
                free        => open
            );
    
    
    fifo_in_re_gen : for i in 0 to NUM_ENDPOINTS-1 generate
        fifo_in_re_inst : configuration work.FWFT_FIFO_cfg
            generic map (
                FIFO_DEPTH  => 2,
                DATA_WIDTH  => WORD_WIDTH+1
            )
            port map (
                -- SYSTEM
                reset       => reset,
                clk         => clk,
                -- INPUT
                full        => full_fire_rh(i),
                write       => write_rh_fire(i),
                data_in     => data_rh_fire, -- Multicast
                -- OUTPUT
                empty       => empty_fire_re(i),
                read        => read_re_fire(i),
                data_out    => data_fire_re(i),
                -- MISC
                free        => open
            );
    end generate;
    
    
    rtps_discovery_module_inst : entity work.rtps_discovery_module(arch)
        generic map (
            MAX_REMOTE_PARTICIPANTS => MAX_REMOTE_PARTICIPANTS,
            PREFER_MULTICAST        => PREFER_MULTICAST_LOCATORS
        )
        port map (
            clk                 => clk,
            reset               => reset,
            time                => time,
            -- FROM RTPS HANDLER
            empty               => empty_firb_rb,
            rd                  => read_rb_firb,
            data_in             => data_firb_rb(WORD_WIDTH-1 downto 0),
            last_word_in        => data_firb_rb(WORD_WIDTH),
            -- FROM USER ENDPOINTS
            alive               => alive_re_rb,
            -- TO USER ENDPOINTS
            full_rtps             => full_frbre_re,
            wr_rtps               => write_rb_frbre,
            data_out_rtps         => data_rb_frbre(WORD_WIDTH-1 downto 0),
            last_word_out_rtps    => data_rb_frbre(WORD_WIDTH),
            -- TO RTPS OUT
            full_ro             => full_firo_rb,
            wr_ro               => write_rb_firo,
            data_out_ro         => data_rb_firo(WORD_WIDTH-1 downto 0),
            last_word_out_ro    => data_rb_firo(WORD_WIDTH)
        );
    
    
    fifo_rb_re_gen : for i in 0 to NUM_ENDPOINTS-1 generate
        fifo_rb_re_inst : configuration work.FWFT_FIFO_cfg
            generic map (
                FIFO_DEPTH  => 2,
                DATA_WIDTH  => WORD_WIDTH+1
            )
            port map (
                -- SYSTEM
                reset       => reset,
                clk         => clk,
                -- INPUT
                full        => full_frbre_re(i),
                write       => write_rb_frbre(i),
                data_in     => data_rb_frbre, -- Multicast
                -- OUTPUT
                empty       => empty_frbre_re(i),
                read        => read_re_frbre(i),
                data_out    => data_frbre_re(i),
                -- MISC
                free        => open
            );
    end generate;
    
    
    rtps_endpoint_gen : for i in 0 to NUM_ENDPOINTS-1 generate
        rtps_endpoint_if : if (i < NUM_READERS) generate
            rtps_reader_inst : entity work.rtps_reader(arch)
                generic map (
                    ENTITYID                    => ENTITYID(i),
                    RELIABILITY_QOS             => ENDPOINT_CONFIG(i).RELIABILITY_QOS,
                    LIVELINESS_QOS              => ENDPOINT_CONFIG(i).LIVELINESS_QOS,
                    DURABILITY_QOS              => ENDPOINT_CONFIG(i).DURABILITY_QOS,
                    HEARTBEAT_RESPONSE_DELAY    => ENDPOINT_CONFIG(i).HEARTBEAT_RESPONSE_DELAY,
                    HEARTBEAT_SUPPRESSION_DELAY => ENDPOINT_CONFIG(i).HEARTBEAT_SUPPRESSION_DELAY,
                    LEASE_DURATION              => ENDPOINT_CONFIG(i).LEASE_DURATION,
                    WITH_KEY                    => ENDPOINT_CONFIG(i).WITH_KEY,
                    MAX_REMOTE_ENDPOINTS        => MAX_REMOTE_ENDPOINTS
                )
                port map (
                    -- SYSTEM
                    clk                     => clk,
                    reset                   => reset,
                    time                    => time,
                    -- FROM RTPS_HANDLER (USER TRAFFIC)
                    empty_user              => empty_fire_re(i),
                    rd_user                 => read_re_fire(i),
                    data_in_user            => data_fire_re(i)(WORD_WIDTH-1 downto 0),
                    last_word_in_user       => data_fire_re(i)(WORD_WIDTH),
                    -- FROM DISCOVERY MODULE (META TRAFFIC)
                    empty_meta              => empty_frbre_re(i),
                    rd_meta                 => read_re_frbre(i),
                    data_in_meta            => data_frbre_re(i)(WORD_WIDTH-1 downto 0),
                    last_word_in_meta       => data_frbre_re(i)(WORD_WIDTH),
                    -- RTPS OUTPUT
                    full_ro                 => full_firo_re(i),
                    wr_ro                   => write_re_firo(i),
                    data_out_ro             => data_re_firo(i)(WORD_WIDTH-1 downto 0),
                    last_word_out_ro        => data_re_firo(i)(WORD_WIDTH),
                    -- TO HISTORY CACHE
                    start_hc                => start_rr_dr(i),
                    opcode_hc               => opcode_rr_dr(i),
                    ack_hc                  => ack_dr_rr(i),
                    done_hc                 => done_dr_rr(i),
                    ret_hc                  => ret_dr_rr(i),
                    valid_out_hc            => valid_rr_dr(i),
                    ready_out_hc            => ready_dr_rr(i),
                    data_out_hc             => data_rr_dr(i)(WORD_WIDTH-1 downto 0),
                    last_word_out_hc        => data_rr_dr(i)(WORD_WIDTH)
                );
            
            -- Set Alive Signals of Readers to Zero
            alive_re_rb(i) <= ('0');
        else generate
            rtps_writer_inst : entity work.rtps_writer(arch)
                generic map (
                    RELIABILITY_QOS             => ENDPOINT_CONFIG(i).RELIABILITY_QOS,
                    LIVELINESS_QOS              => ENDPOINT_CONFIG(i).LIVELINESS_QOS,
                    DURABILITY_QOS              => ENDPOINT_CONFIG(i).DURABILITY_QOS,
                    DESTINATION_ORDER_QOS       => ENDPOINT_CONFIG(i).DESTINATION_ORDER_QOS,
                    ACKNACK_RESPONSE_DELAY      => ENDPOINT_CONFIG(i).ACKNACK_RESPONSE_DELAY,
                    ACKNACK_SUPPRESSION_DELAY   => ENDPOINT_CONFIG(i).ACKNACK_SUPPRESSION_DELAY,
                    LEASE_DURATION              => ENDPOINT_CONFIG(i).LEASE_DURATION,
                    HEARTBEAT_PERIOD            => ENDPOINT_CONFIG(i).HEARTBEAT_PERIOD,
                    ENTITYID                    => ENTITYID(i),
                    WITH_KEY                    => ENDPOINT_CONFIG(i).WITH_KEY,
                    PUSH_MODE                   => ENDPOINT_CONFIG(i).PUSH_MODE,
                    INLINE_QOS                  => gen_inline_qos(i),
                    MAX_REMOTE_ENDPOINTS        => MAX_REMOTE_ENDPOINTS
                )
                port map (
                    -- SYSTEM
                    clk                     => clk,
                    reset                   => reset,
                    time                    => time,
                    -- FROM RTPS_HANDLER (USER TRAFFIC)
                    empty_user              => empty_fire_re(i),
                    rd_user                 => read_re_fire(i),
                    data_in_user            => data_fire_re(i)(WORD_WIDTH-1 downto 0),
                    last_word_in_user       => data_fire_re(i)(WORD_WIDTH),
                    -- FROM DISCOVERY MODULE (META TRAFFIC)
                    empty_meta              => empty_frbre_re(i),
                    rd_meta                 => read_re_frbre(i),
                    data_in_meta            => data_frbre_re(i)(WORD_WIDTH-1 downto 0),
                    last_word_in_meta       => data_frbre_re(i)(WORD_WIDTH),
                    -- TO DISCOVERY MODULE (META TRAFFIC)
                    alive_sig               => alive_re_rb(i),
                    -- RTPS OUTPUT
                    full_ro                 => full_firo_re(i),
                    wr_ro                   => write_re_firo(i),
                    data_out_ro             => data_re_firo(i)(WORD_WIDTH-1 downto 0),
                    last_word_out_ro        => data_re_firo(i)(WORD_WIDTH),
                    -- FROM HC
                    liveliness_assertion    => liveliness_assertion_dw_rw(i-NUM_READERS),
                    data_available          => data_available_dw_rw(i-NUM_READERS),
                    start_hc                => start_rw_dw(i-NUM_READERS),
                    opcode_hc               => opcode_rw_dw(i-NUM_READERS),
                    ack_hc                  => ack_dw_rw(i-NUM_READERS),
                    seq_nr_hc               => seq_nr_rw_dw(i-NUM_READERS),
                    done_hc                 => done_rw_dw(i-NUM_READERS),
                    ret_hc                  => ret_dw_rw(i-NUM_READERS),
                    get_data_hc             => get_data_rw_dw(i-NUM_READERS),
                    valid_in_hc             => valid_dw_rw(i-NUM_READERS),
                    ready_in_hc             => ready_rw_dw(i-NUM_READERS),
                    data_in_hc              => data_dw_rw(i-NUM_READERS)(WORD_WIDTH-1 downto 0),
                    last_word_in_hc         => data_dw_rw(i-NUM_READERS)(WORD_WIDTH),
                    cc_instance_handle      => cc_instance_handle_dw_rw(i-NUM_READERS),
                    cc_kind                 => cc_kind_dw_rw(i-NUM_READERS),
                    cc_source_timestamp     => cc_source_timestamp_dw_rw(i-NUM_READERS),
                    cc_seq_nr               => cc_seq_nr_dw_rw(i-NUM_READERS)
                );
        end generate;
    end generate;
    
    
    dds_endpoint_gen : for i in 0 to NUM_ENDPOINTS-1 generate
        dds_endpoint_if : if (i < NUM_READERS) generate
            dds_reader_inst : entity work.dds_reader(arch)
                generic map (
                    TIME_BASED_FILTER_QOS       => ENDPOINT_CONFIG(i).TIME_BASED_FILTER_QOS,
                    DEADLINE_QOS                => ENDPOINT_CONFIG(i).DEADLINE_QOS,
                    MAX_INSTANCES               => ENDPOINT_CONFIG(i).MAX_INSTANCES,
                    MAX_SAMPLES_PER_INSTANCE    => ENDPOINT_CONFIG(i).MAX_SAMPLES_PER_INSTANCE,
                    MAX_SAMPLES                 => ENDPOINT_CONFIG(i).MAX_SAMPLES,
                    HISTORY_QOS                 => ENDPOINT_CONFIG(i).HISTORY_QOS,
                    RELIABILITY_QOS             => ENDPOINT_CONFIG(i).RELIABILITY_QOS,
                    PRESENTATION_QOS            => ENDPOINT_CONFIG(i).PRESENTATION_QOS,
                    DESTINATION_ORDER_QOS       => ENDPOINT_CONFIG(i).DESTINATION_ORDER_QOS,
                    COHERENT_ACCESS             => ENDPOINT_CONFIG(i).COHERENT_ACCESS,
                    ORDERED_ACCESS              => ENDPOINT_CONFIG(i).ORDERED_ACCESS,
                    WITH_KEY                    => ENDPOINT_CONFIG(i).WITH_KEY,
                    PAYLOAD_FRAME_SIZE          => ENDPOINT_CONFIG(i).MAX_PAYLOAD_SIZE,
                    MAX_REMOTE_ENDPOINTS        => MAX_REMOTE_ENDPOINTS
                )
                port map (
                    -- SYSTEM
                    clk                             => clk,
                    reset                           => reset,
                    time                            => time,
                    -- FROM RTPS ENDPOINT
                    start_rtps                      => start_rr_dr(i),
                    opcode_rtps                     => opcode_rr_dr(i),
                    ack_rtps                        => ack_dr_rr(i),
                    done_rtps                       => done_dr_rr(i),
                    ret_rtps                        => ret_dr_rr(i),
                    valid_in_rtps                   => valid_rr_dr(i),
                    ready_in_rtps                   => ready_dr_rr(i),
                    data_in_rtps                    => data_rr_dr(i)(WORD_WIDTH-1 downto 0),
                    last_word_in_rtps               => data_rr_dr(i)(WORD_WIDTH),
                    -- TO USER ENTITY
                    start_dds                       => start_ri_dr(i),
                    ack_dds                         => ack_dr_ri(i),
                    opcode_dds                      => opcode_ri_dr(i),
                    instance_state_dds              => instance_state_ri_dr(i),
                    view_state_dds                  => view_state_ri_dr(i),
                    sample_state_dds                => sample_state_ri_dr(i),
                    instance_handle_dds             => instance_handle_ri_dr(i),
                    max_samples_dds                 => max_samples_ri_dr(i),
                    get_data_dds                    => get_data_ri_dr(i),
                    done_dds                        => done_dr_ri(i),
                    return_code_dds                 => return_code_dr_ri(i),
                    valid_out_dds                   => valid_dr_ri(i),
                    ready_out_dds                   => ready_ri_dr(i),
                    data_out_dds                    => data_dr_ri(i)(WORD_WIDTH-1 downto 0),
                    last_word_out_dds               => data_dr_ri(i)(WORD_WIDTH),
                    -- Sample Info
                    si_sample_state                 => si_sample_state_dr_ri(i),
                    si_view_state                   => si_view_state_dr_ri(i),
                    si_instance_state               => si_instance_state_dr_ri(i),
                    si_source_timestamp             => si_source_timestamp_dr_ri(i),
                    si_instance_handle              => si_instance_handle_dr_ri(i),
                    si_publication_handle           => si_publication_handle_dr_ri(i),
                    si_disposed_generation_count    => si_disposed_generation_count_dr_ri(i),
                    si_no_writers_generation_count  => si_no_writers_generation_count_dr_ri(i),
                    si_sample_rank                  => si_sample_rank_dr_ri(i),
                    si_generation_rank              => si_generation_rank_dr_ri(i),
                    si_absolute_generation_rank     => si_absolute_generation_rank_dr_ri(i),
                    si_valid_data                   => si_valid_data_dr_ri(i),
                    si_valid                        => si_valid_dr_ri(i),
                    si_ack                          => si_ack_ri_dr(i),
                    eoc                             => eoc_dr_ri(i),
                    -- Communication Status
                    status                          => status_dr_ri(i)
                );
        else generate
            dds_writer_inst : entity work.dds_writer(arch)
                generic map (
                    HISTORY_QOS                 => ENDPOINT_CONFIG(i).HISTORY_QOS,
                    DEADLINE_QOS                => ENDPOINT_CONFIG(i).DEADLINE_QOS,
                    LIFESPAN_QOS                => ENDPOINT_CONFIG(i).LIFESPAN_QOS,
                    LEASE_DURATION              => ENDPOINT_CONFIG(i).LEASE_DURATION,
                    WITH_KEY                    => ENDPOINT_CONFIG(i).WITH_KEY,
                    MAX_SAMPLES                 => ENDPOINT_CONFIG(i).MAX_SAMPLES,
                    MAX_INSTANCES               => ENDPOINT_CONFIG(i).MAX_INSTANCES,
                    MAX_SAMPLES_PER_INSTANCE    => ENDPOINT_CONFIG(i).MAX_SAMPLES_PER_INSTANCE,
                    PAYLOAD_FRAME_SIZE          => ENDPOINT_CONFIG(i).MAX_PAYLOAD_SIZE
                )
                port map (
                    -- SYSTEM
                    clk                     => clk,
                    reset                   => reset,
                    time                    => time,
                    -- TO/FROM RTPS ENDPOINT
                    start_rtps              => start_rw_dw(i-NUM_READERS),
                    opcode_rtps             => opcode_rw_dw(i-NUM_READERS),
                    ack_rtps                => ack_dw_rw(i-NUM_READERS),
                    done_rtps               => done_rw_dw(i-NUM_READERS),
                    ret_rtps                => ret_dw_rw(i-NUM_READERS),
                    seq_nr_rtps             => seq_nr_rw_dw(i-NUM_READERS),
                    get_data_rtps           => get_data_rw_dw(i-NUM_READERS),
                    valid_out_rtps          => valid_dw_rw(i-NUM_READERS),
                    ready_out_rtps          => ready_rw_dw(i-NUM_READERS),
                    data_out_rtps           => data_dw_rw(i-NUM_READERS)(WORD_WIDTH-1 downto 0),
                    last_word_out_rtps      => data_dw_rw(i-NUM_READERS)(WORD_WIDTH),
                    liveliness_assertion    => liveliness_assertion_dw_rw(i-NUM_READERS),
                    data_available          => data_available_dw_rw(i-NUM_READERS),
                    -- Cache Change
                    cc_instance_handle      => cc_instance_handle_dw_rw(i-NUM_READERS),
                    cc_kind                 => cc_kind_dw_rw(i-NUM_READERS),
                    cc_source_timestamp     => cc_source_timestamp_dw_rw(i-NUM_READERS),
                    cc_seq_nr               => cc_seq_nr_dw_rw(i-NUM_READERS),
                    -- TO/FROM USER ENTITY
                    start_dds               => start_wi_dw(i-NUM_READERS),
                    ack_dds                 => ack_dw_wi(i-NUM_READERS),
                    opcode_dds              => opcode_wi_dw(i-NUM_READERS),
                    instance_handle_in_dds  => instance_handle_wi_dw(i-NUM_READERS),
                    source_ts_dds           => source_ts_wi_dw(i-NUM_READERS),
                    max_wait_dds            => max_wait_wi_dw(i-NUM_READERS),
                    done_dds                => done_dw_wi(i-NUM_READERS),
                    return_code_dds         => return_code_dw_wi(i-NUM_READERS),
                    instance_handle_out_dds => instance_handle_dw_wi(i-NUM_READERS),
                    valid_in_dds            => valid_wi_dw(i-NUM_READERS),
                    ready_in_dds            => ready_dw_wi(i-NUM_READERS),
                    data_in_dds             => data_wi_dw(i-NUM_READERS)(WORD_WIDTH-1 downto 0),
                    last_word_in_dds        => data_wi_dw(i-NUM_READERS)(WORD_WIDTH),
                    valid_out_dds           => valid_dw_wi(i-NUM_READERS),
                    ready_out_dds           => ready_wi_dw(i-NUM_READERS),
                    data_out_dds            => data_dw_wi(i-NUM_READERS)(WORD_WIDTH-1 downto 0),
                    last_word_out_dds       => data_dw_wi(i-NUM_READERS)(WORD_WIDTH),
                    -- Communication Status
                    status                  => status_dw_wi(i-NUM_READERS)
                );
        end generate;
    end generate;
    
    
    fifo_in_ro_gen : for i in 0 to NUM_ENDPOINTS generate
        fifo_in_ro_if : if (i = NUM_ENDPOINTS) generate
            fifo_in_ro_inst : configuration work.FWFT_FIFO_cfg
                generic map (
                    FIFO_DEPTH  => 2,
                    DATA_WIDTH  => WORD_WIDTH+1
                )
                port map (
                    -- SYSTEM
                    reset       => reset,
                    clk         => clk,
                    -- INPUT
                    full        => full_firo_rb,
                    write       => write_rb_firo,
                    data_in     => data_rb_firo,
                    -- OUTPUT
                    empty       => empty_firo_ro(i),
                    read        => read_ro_firo(i),
                    data_out(WORD_WIDTH)            => last_word_firo_ro(i),
                    data_out(WORD_WIDTH-1 downto 0) => data_firo_ro(i),
                    -- MISC
                    free        => open
                );
        else generate        
            fifo_in_ro_inst : configuration work.FWFT_FIFO_cfg
                generic map (
                    FIFO_DEPTH  => 2,
                    DATA_WIDTH  => WORD_WIDTH+1
                )
                port map (
                    -- SYSTEM
                    reset       => reset,
                    clk         => clk,
                    -- INPUT
                    full        => full_firo_re(i),
                    write       => write_re_firo(i),
                    data_in     => data_re_firo(i),
                    -- OUTPUT
                    empty       => empty_firo_ro(i),
                    read        => read_ro_firo(i),
                    data_out(WORD_WIDTH)            => last_word_firo_ro(i),
                    data_out(WORD_WIDTH-1 downto 0) => data_firo_ro(i),
                    -- MISC
                    free        => open
                );
        end generate;
    end generate;
    
    
    rtps_out_inst : entity work.rtps_out(arch)
        port map (
            -- SYSTEM
            clk             => clk,
            reset           => reset,
            -- INPUT
            empty           => empty_firo_ro,
            rd              => read_ro_firo,
            data_in         => data_firo_ro,
            last_word_in    => last_word_firo_ro,
            -- OUTPUT
            full            => full,
            wr              => write,
            data_out        => data_out
        );
    
    
    --#####################################################################
    
    
    Type1_reader_interface_inst : entity work.Type1_reader_interface(arch)
        port map (
            -- SYSTEM
            clk                                 => clk,
            reset                               => reset,
            -- FROM DDS READER
            start_dds                           => start_ri_dr(0),
            ack_dds                             => ack_dr_ri(0),
            opcode_dds                          => opcode_ri_dr(0),
            instance_state_dds                  => instance_state_ri_dr(0),
            view_state_dds                      => view_state_ri_dr(0),
            sample_state_dds                    => sample_state_ri_dr(0),
            instance_handle_dds                 => instance_handle_ri_dr(0),
            max_samples_dds                     => max_samples_ri_dr(0),
            get_data_dds                        => get_data_ri_dr(0),
            done_dds                            => done_dr_ri(0),
            return_code_dds                     => return_code_dr_ri(0),
            valid_in_dds                        => valid_dr_ri(0),
            ready_in_dds                        => ready_ri_dr(0),
            data_in_dds                         => data_dr_ri(0)(WORD_WIDTH-1 downto 0),
            last_word_in_dds                    => data_dr_ri(0)(WORD_WIDTH),
            -- Sample Info
            si_sample_state_dds                 => si_sample_state_dr_ri(0),
            si_view_state_dds                   => si_view_state_dr_ri(0),
            si_instance_state_dds               => si_instance_state_dr_ri(0),
            si_source_timestamp_dds             => si_source_timestamp_dr_ri(0),
            si_instance_handle_dds              => si_instance_handle_dr_ri(0),
            si_publication_handle_dds           => si_publication_handle_dr_ri(0),
            si_disposed_generation_count_dds    => si_disposed_generation_count_dr_ri(0),
            si_no_writers_generation_count_dds  => si_no_writers_generation_count_dr_ri(0),
            si_sample_rank_dds                  => si_sample_rank_dr_ri(0),
            si_generation_rank_dds              => si_generation_rank_dr_ri(0),
            si_absolute_generation_rank_dds     => si_absolute_generation_rank_dr_ri(0),
            si_valid_data_dds                   => si_valid_data_dr_ri(0),
            si_valid_dds                        => si_valid_dr_ri(0),
            si_ack_dds                          => si_ack_ri_dr(0),
            eoc_dds                             => eoc_dr_ri(0),
            -- Communication Status
            status_dds                          => status_dr_ri(0),
            -- TO USER ENTITY
            start_user                          => start_user_ri,
            ack_user                            => ack_ri_user,
            opcode_user                         => opcode_user_ri,
            instance_state_user                 => instance_state_user_ri,
            view_state_user                     => view_state_user_ri,
            sample_state_user                   => sample_state_user_ri,
            instance_handle_user                => instance_handle_user_ri,
            max_samples_user                    => max_samples_user_ri,
            get_data_user                       => get_data_user_ri,
            done_user                           => done_ri_user,
            return_code_user                    => return_code_ri_user,
            -- Sample Info
            si_sample_state_user                => si_sample_state_ri_user,
            si_view_state_user                  => si_view_state_ri_user,
            si_instance_state_user              => si_instance_state_ri_user,
            si_source_timestamp_user            => si_source_timestamp_ri_user,
            si_instance_handle_user             => si_instance_handle_ri_user,
            si_publication_handle_user          => si_publication_handle_ri_user,
            si_disposed_generation_count_user   => si_disposed_generation_count_ri_user,
            si_no_writers_generation_count_user => si_no_writers_generation_count_ri_user,
            si_sample_rank_user                 => si_sample_rank_ri_user,
            si_generation_rank_user             => si_generation_rank_ri_user,
            si_absolute_generation_rank_user    => si_absolute_generation_rank_ri_user,
            si_valid_data_user                  => si_valid_data_ri_user,
            si_valid_user                       => si_valid_ri_user,
            si_ack_user                         => si_ack_user_ri,
            eoc_user                            => eoc_ri_user,
            -- Communication Status
            status_user                         => status_ri_user,
            decode_error                        => decode_error_ri_user,
            -- ###GENERATED START###
            id                                  => id_ri_user,
            a                                   => a_ri_user,
            -- ###GENERATED END###
            valid                               => valid_ri_user
        );
    
    
    Type1_writer_interface_inst : entity work.Type1_writer_interface(arch)
        port map (
            -- SYSTEM
            clk                         => clk,
            reset                       => reset,
            -- FROM DDS WRITER
            start_dds                   => start_wi_dw(0),
            ack_dds                     => ack_dw_wi(0),
            opcode_dds                  => opcode_wi_dw(0),
            instance_handle_in_dds      => instance_handle_dw_wi(0),
            source_ts_dds               => source_ts_wi_dw(0),
            max_wait_dds                => max_wait_wi_dw(0),
            done_dds                    => done_dw_wi(0),
            return_code_dds             => return_code_dw_wi(0),
            instance_handle_out_dds     => instance_handle_wi_dw(0),
            valid_out_dds               => valid_wi_dw(0),
            ready_out_dds               => ready_dw_wi(0),
            data_out_dds                => data_wi_dw(0)(WORD_WIDTH-1 downto 0),
            last_word_out_dds           => data_wi_dw(0)(WORD_WIDTH),
            valid_in_dds                => valid_dw_wi(0),
            ready_in_dds                => ready_wi_dw(0),
            data_in_dds                 => data_dw_wi(0)(WORD_WIDTH-1 downto 0),
            last_word_in_dds            => data_dw_wi(0)(WORD_WIDTH),
            -- Communication Status
            status_dds                  => status_dw_wi(0),
            -- TO USER ENTITY
            start_user                  => start_user_wi,
            ack_user                    => ack_wi_user,
            opcode_user                 => opcode_user_wi,
            instance_handle_in_user     => instance_handle_user_wi,
            source_ts_user              => source_ts_user_wi,
            max_wait_user               => max_wait_user_wi,
            done_user                   => done_wi_user,
            return_code_user            => return_code_wi_user,
            instance_handle_out_user    => instance_handle_wi_user,
            -- Communication Status
            status_user                 => status_wi_user,
            -- ###GENERATED START###
            id                          => id_user_wi,
            a                           => a_user_wi,
            -- ###GENERATED END###
            encode_done                 => encode_done_wi_user
        );
    
    
    test_loopback_inst : entity work.test_loopback(arch)
        port map (
            -- SYSTEM
            clk                                 => clk,
            reset                               => reset,
            -- READER
            start_r                             => start_user_ri,
            ack_r                               => ack_ri_user,
            opcode_r                            => opcode_user_ri,
            instance_state_r                    => instance_state_user_ri,
            view_state_r                        => view_state_user_ri,
            sample_state_r                      => sample_state_user_ri,
            instance_handle_r                   => instance_handle_user_ri,
            max_samples_r                       => max_samples_user_ri,
            get_data_r                          => get_data_user_ri,
            done_r                              => done_ri_user,
            return_code_r                       => return_code_ri_user,
            si_sample_state_r                   => si_sample_state_ri_user,
            si_view_state_r                     => si_view_state_ri_user,
            si_instance_state_r                 => si_instance_state_ri_user,
            si_source_timestamp_r               => si_source_timestamp_ri_user,
            si_instance_handle_r                => si_instance_handle_ri_user,
            si_publication_handle_r             => si_publication_handle_ri_user,
            si_disposed_generation_count_r      => si_disposed_generation_count_ri_user,
            si_no_writers_generation_count_r    => si_no_writers_generation_count_ri_user,
            si_sample_rank_r                    => si_sample_rank_ri_user,
            si_generation_rank_r                => si_generation_rank_ri_user,
            si_absolute_generation_rank_r       => si_absolute_generation_rank_ri_user,
            si_valid_data_r                     => si_valid_data_ri_user,
            si_valid_r                          => si_valid_ri_user,
            si_ack_r                            => si_ack_user_ri,
            eoc_r                               => eoc_ri_user,
            status_r                            => status_ri_user,
            decode_error_r                      => decode_error_ri_user,
            id_r                                => id_ri_user,
            a_r                                 => a_ri_user,
            valid_r                             => valid_ri_user,
            -- WRITER
            start_w                             => start_user_wi,
            ack_w                               => ack_wi_user,
            opcode_w                            => opcode_user_wi,
            instance_handle_out_w               => instance_handle_user_wi,
            source_ts_w                         => source_ts_user_wi,
            max_wait_w                          => max_wait_user_wi,
            done_w                              => done_wi_user,
            return_code_w                       => return_code_wi_user,
            instance_handle_in_w                => instance_handle_wi_user,
            status_w                            => status_wi_user,
            id_w                                => id_user_wi,
            a_w                                 => a_user_wi,
            encode_done_w                       => encode_done_wi_user
        );
    
end architecture;