diff --git a/applications/lofar2/libraries/sdp/hdllib.cfg b/applications/lofar2/libraries/sdp/hdllib.cfg index 97a713a2e7a5ee6c639742c4d31f72639ebc19f5..843a49247a740b06c32a726543192f50f3590cc8 100644 --- a/applications/lofar2/libraries/sdp/hdllib.cfg +++ b/applications/lofar2/libraries/sdp/hdllib.cfg @@ -14,6 +14,7 @@ synth_files = src/vhdl/sdp_info.vhd src/vhdl/sdp_beamformer_output.vhd src/vhdl/sdp_statistics_offload.vhd + src/vhdl/sdp_crosslets_subband_select.vhd src/vhdl/node_sdp_adc_input_and_timing.vhd src/vhdl/node_sdp_filterbank.vhd src/vhdl/node_sdp_beamformer.vhd @@ -21,10 +22,12 @@ synth_files = test_bench_files = tb/vhdl/tb_sdp_info.vhd tb/vhdl/tb_sdp_statistics_offload.vhd + tb/vhdl/tb_sdp_crosslets_subband_select.vhd regression_test_vhdl = tb/vhdl/tb_sdp_info.vhd tb/vhdl/tb_sdp_statistics_offload.vhd + tb/vhdl/tb_sdp_crosslets_subband_select.vhd [modelsim_project_file] diff --git a/applications/lofar2/libraries/sdp/src/vhdl/sdp_crosslets_subband_select.vhd b/applications/lofar2/libraries/sdp/src/vhdl/sdp_crosslets_subband_select.vhd index c61f2da4efb1a15841813d40c6a289920f091c27..e911d130bf1baad72463ae57084666afc9b71618 100644 --- a/applications/lofar2/libraries/sdp/src/vhdl/sdp_crosslets_subband_select.vhd +++ b/applications/lofar2/libraries/sdp/src/vhdl/sdp_crosslets_subband_select.vhd @@ -22,7 +22,10 @@ -- -- Author: R. van der Walle -- Purpose: +-- Select subbands from incoming blocks -- Description: +-- The Crosslet subband select selects N_crosslets from each incoming block. Per +-- crosslet there are S_pn = 12 subbands, one from each signal input of the PN. -- Remark: -- . ------------------------------------------------------------------------------- @@ -37,54 +40,279 @@ USE work.sdp_pkg.ALL; ENTITY sdp_crosslets_subband_select IS GENERIC ( - g_sim : BOOLEAN := FALSE; - g_beamset_id : NATURAL := 0; - g_scope_selected_beamlet : NATURAL := 0 + g_N_crosslets : NATURAL := c_sdp_N_crosslets ); PORT ( dp_clk : IN STD_LOGIC; dp_rst : IN STD_LOGIC; in_sosi_arr : IN t_dp_sosi_arr(c_sdp_P_pfb-1 DOWNTO 0); - bf_udp_sosi : OUT t_dp_sosi; - bf_udp_siso : IN t_dp_siso; - bst_udp_sosi : OUT t_dp_sosi; + out_sosi : OUT t_dp_sosi; mm_rst : IN STD_LOGIC; mm_clk : IN STD_LOGIC; + reg_crosslets_info_mosi : IN t_mem_mosi := c_mem_mosi_rst; + reg_crosslets_info_miso : OUT t_mem_miso := c_mem_miso_rst; + + reg_bsn_scheduler_xsub_mosi : IN t_mem_mosi := c_mem_mosi_rst; + reg_bsn_scheduler_xsub_miso : OUT t_mem_miso := c_mem_miso_rst; + + out_crosslets_info : OUT STD_LOGIC_VECTOR(c_sdp_crosslets_info_reg_w-1 DOWNTO 0) ); END sdp_crosslets_subband_select; ARCHITECTURE str OF sdp_crosslets_subband_select IS + + + CONSTANT c_crosslets_info_dly : NATURAL := 1; + CONSTANT c_row_select_slv_w : NATURAL := ceil_log2(c_Sdp_P_pfb); + CONSTANT c_row_select_pipeline : NATURAL := 1; + CONSTANT c_out_sosi_pipeline : NATURAL := 1; + + TYPE t_crosslets_control_reg IS RECORD -- local registers + i_offset : NATURAL; + i_row : NATURAL; + i_col : NATURAL; + step : NATURAL RANGE 0 TO c_sdp_N_sub-1; + offsets : t_natural_arr(g_N_crosslets-1 DOWNTO 0); + started : STD_LOGIC; + row_select_slv : STD_LOGIC_VECTOR(c_row_select_slv_w-1 DOWNTO 0); + col_select_mosi : t_mem_mosi; + sync_detected : STD_LOGIC; + END RECORD; + CONSTANT c_reg_rst : t_crosslets_control_reg := ( 0, 0, 0, 0, (OTHERS => 0), '0', (OTHERS => '0'), c_mem_mosi_rst, '0'); + + -- Define the local registers in t_crosslets_control_reg record + SIGNAL r : t_crosslets_control_reg; + SIGNAL nxt_r : t_crosslets_control_reg; + SIGNAL start_trigger : STD_LOGIC := '0'; + + SIGNAL col_select_mosi : t_mem_mosi := c_mem_mosi_rst; + SIGNAL col_select_miso : t_mem_miso := c_mem_miso_rst; + SIGNAL row_select_slv : STD_LOGIC_VECTOR(c_row_select_slv_w-1 DOWNTO 0); + + SIGNAL col_sosi_arr : t_dp_sosi_arr(c_sdp_P_pfb-1 DOWNTO 0); + SIGNAL row_sosi : t_dp_sosi; + + SIGNAL crosslets_info_reg : STD_LOGIC_VECTOR(c_sdp_crosslets_info_reg_w-1 DOWNTO 0) := (OTHERS=>'0'); + SIGNAL active_crosslets_info : STD_LOGIC_VECTOR(c_sdp_crosslets_info_reg_w-1 DOWNTO 0) := (OTHERS => '0'); BEGIN + + --------------------------------------------------------------- + -- BSN scheduler + --------------------------------------------------------------- + u_bsn_scheduler : ENTITY dp_lib.mms_dp_bsn_scheduler + GENERIC MAP ( + g_cross_clock_domain => TRUE, + g_bsn_w => c_dp_stream_bsn_w + ) + PORT MAP ( + -- Memory-mapped clock domain + mm_rst => mm_rst, + mm_clk => mm_clk, + + reg_mosi => reg_bsn_scheduler_xsub_mosi, + reg_miso => reg_bsn_scheduler_xsub_miso, + + -- Streaming clock domain + dp_rst => dp_rst, + dp_clk => dp_clk, + + snk_in => in_sosi_arr(0), -- only uses eop (= block sync), bsn[] + trigger_out => start_trigger + ); + + --------------------------------------------------------------- + -- Crosslets info + --------------------------------------------------------------- + u_crosslets_info : ENTITY common_lib.mms_common_reg + GENERIC MAP( + g_mm_reg => c_sdp_mm_reg_crosslets_info + ) + PORT MAP( + -- Clocks and reset + mm_rst => mm_rst, + mm_clk => mm_clk, + st_rst => dp_rst, + st_clk => dp_clk, + + -- MM bus access in memory-mapped clock domain + reg_mosi => reg_crosslets_info_mosi, + reg_miso => reg_crosslets_info_miso, + + in_reg => crosslets_info_reg, + out_reg => crosslets_info_reg + ); + + --------------------------------------------------------------- + -- Crosslets control process + --------------------------------------------------------------- + p_regs_crosslets_control : PROCESS(dp_rst, dp_clk) + BEGIN + IF dp_rst='1' THEN + r <= c_reg_rst; + ELSIF rising_edge(dp_clk) THEN + r <= nxt_r; + END IF; + END PROCESS; + + p_comb_crosslets_control : PROCESS(r, start_trigger, crosslets_info_reg, in_sosi_arr, col_select_miso) + VARIABLE v : t_crosslets_control_reg; + VARIABLE v_offsets : t_natural_arr(g_N_crosslets-1 DOWNTO 0); -- Use extra variable to simplify col_select_mosi address selection + BEGIN + v := r; + v.col_select_mosi := c_mem_mosi_rst; + + IF start_trigger = '1' THEN + v.started := '1'; + v.i_offset := 0; + v.i_row := 0; + v.i_col := 0; + v.sync_detected := '0'; + + v.step := TO_UINT(crosslets_info_reg(c_sdp_crosslets_info_reg_w-1 DOWNTO c_sdp_crosslets_info_reg_w - c_sdp_crosslets_index_w)); + FOR I IN 0 TO g_N_crosslets-1 LOOP + v_offsets(I) := TO_UINT(crosslets_info_reg((I+1)*c_sdp_crosslets_index_w-1 DOWNTO I*c_sdp_crosslets_index_w)); + END LOOP; + END IF; + + IF in_sosi_arr(0).sync = '1' AND start_trigger = '0' THEN + v.sync_detected := '1'; + END IF; + + IF r.started = '1' AND in_sosi_arr(0).eop = '1' AND r.sync_detected = '1' THEN -- change offsets 1 packet after the sync due to the buffered packet in reorder_col_wide_select + v.sync_detected := '0'; + FOR I IN 0 TO g_N_crosslets-1 LOOP + v_offsets(I) := r.offsets(I) + TO_UINT(crosslets_info_reg(c_sdp_crosslets_info_reg_w-1 DOWNTO c_sdp_crosslets_info_reg_w - c_sdp_crosslets_index_w)); + END LOOP; + END IF; + + IF col_select_miso.waitrequest = '0' AND r.started = '1' THEN + IF r.i_col >= c_sdp_Q_fft-1 THEN + v.i_col := 0; + IF r.i_row >= c_sdp_P_pfb-1 THEN + v.i_row := 0; + IF r.i_offset >= g_N_crosslets-1 THEN + v.i_offset := 0; + ELSE + v.i_offset := r.i_offset+1; + END IF; + ELSE + v.i_row := r.i_row+1; + END IF; + ELSE + v.i_col := r.i_col+1; + END IF; + + v.col_select_mosi.rd := '1'; + v.col_select_mosi.address(c_sdp_crosslets_index_w-1 DOWNTO 0) := TO_UVEC(c_sdp_Q_fft*v_offsets(r.i_offset) + r.i_col, c_sdp_crosslets_index_w); + v.row_select_slv := TO_UVEC(r.i_row, c_row_select_slv_w); + END IF; + v.offsets := v_offsets; + nxt_r <= v; + END PROCESS; + + col_select_mosi <= r.col_select_mosi; + + u_pipe_row_select : ENTITY common_lib.common_pipeline + GENERIC MAP( + g_pipeline => c_row_select_pipeline, + g_in_dat_w => c_row_select_slv_w, + g_out_dat_w => c_row_select_slv_w + ) + PORT MAP( + rst => dp_rst, + clk => dp_clk, + in_dat => r.row_select_slv, + out_dat => row_select_slv + ); + + active_crosslets_info(c_sdp_crosslets_info_reg_w-1 DOWNTO c_sdp_crosslets_info_reg_w - c_sdp_crosslets_index_w) <= TO_UVEC(r.step, c_sdp_crosslets_index_w); + gen_crosslets_info : FOR I IN 0 TO g_N_crosslets-1 GENERATE + active_crosslets_info((I+1)*c_sdp_crosslets_index_w-1 DOWNTO I*c_sdp_crosslets_index_w) <= TO_UVEC(r.offsets(I), c_sdp_crosslets_index_w); + END GENERATE; + --------------------------------------------------------------- - -- Beamlet Subband Select + -- Crosslet Select --------------------------------------------------------------- - u_reorder_col_wide : ENTITY reorder_lib.reorder_col_wide + u_reorder_col_wide_select : ENTITY reorder_lib.reorder_col_wide_select GENERIC MAP ( - g_wb_factor => c_sdp_P_pfb, -- g_wb_factor is only used for number of parallel streams + g_nof_inputs => c_sdp_P_pfb, g_dsp_data_w => c_sdp_W_subband, g_nof_ch_in => c_sdp_N_sub * c_sdp_Q_fft, - g_nof_ch_sel => c_sdp_S_sub_bf * c_sdp_Q_fft, - g_select_file_prefix => c_bf_select_file_prefix, - g_use_complex => TRUE + g_nof_ch_sel => g_N_crosslets * c_sdp_S_pn ) - PORT MAP( - input_sosi_arr => in_sosi_arr, - output_sosi_arr => bsel_sosi_arr, + PORT MAP ( + dp_rst => dp_rst, + dp_clk => dp_clk, + + -- Memory Mapped + col_select_mosi => col_select_mosi, + col_select_miso => col_select_miso, + + -- Streaming + input_sosi_arr => in_sosi_arr, + + output_sosi_arr => col_sosi_arr + ); + + u_reorder_row_select : ENTITY reorder_lib.reorder_row_select + GENERIC MAP ( + g_dsp_data_w => c_sdp_W_subband, + g_nof_inputs => c_sdp_P_pfb, + g_nof_outputs => 1, + g_pipeline_in => 0, + g_pipeline_in_m => 1, + g_pipeline_out => 1 + ) + PORT MAP ( + dp_rst => dp_rst, + dp_clk => dp_clk, - ram_ss_ss_wide_mosi => ram_ss_ss_wide_mosi, - ram_ss_ss_wide_miso => ram_ss_ss_wide_miso, + in_select => row_select_slv, + + -- Streaming + input_sosi_arr => col_sosi_arr, + + output_sosi_arr(0) => row_sosi + ); + - mm_rst => mm_rst, - mm_clk => mm_clk, - dp_clk => dp_clk, - dp_rst => dp_rst + --------------------------------------------------------------- + -- Out Crosslet info pipeline + --------------------------------------------------------------- + u_common_pipeline : ENTITY common_lib.common_pipeline + GENERIC MAP( + g_pipeline => c_crosslets_info_dly, + g_in_dat_w => c_sdp_crosslets_info_reg_w, + g_out_dat_w => c_sdp_crosslets_info_reg_w + ) + PORT MAP( + rst => dp_rst, + clk => dp_clk, + in_en => row_sosi.sync, + in_dat => active_crosslets_info, + out_dat => out_crosslets_info ); + --------------------------------------------------------------- + -- Out sosi pipeline + --------------------------------------------------------------- + u_dp_pipeline : ENTITY dp_lib.dp_pipeline + GENERIC MAP ( + g_pipeline => c_out_sosi_pipeline + ) + PORT MAP ( + rst => dp_rst, + clk => dp_clk, + -- ST sink + snk_in => row_sosi, + -- ST source + src_out => out_sosi + ); END str; diff --git a/applications/lofar2/libraries/sdp/src/vhdl/sdp_pkg.vhd b/applications/lofar2/libraries/sdp/src/vhdl/sdp_pkg.vhd index c2914456898e87400450a1f40aca3b31c17f431b..ec3adddaca9ca51e970444e88f0616352f871d03 100644 --- a/applications/lofar2/libraries/sdp/src/vhdl/sdp_pkg.vhd +++ b/applications/lofar2/libraries/sdp/src/vhdl/sdp_pkg.vhd @@ -71,6 +71,7 @@ PACKAGE sdp_pkg is -- L3 SDP Decision: SDP Parameter definitions CONSTANT c_sdp_f_adc_MHz : NATURAL := 200; CONSTANT c_sdp_N_beamsets : NATURAL := 2; + CONSTANT c_sdp_N_crosslets : NATURAL := 1; CONSTANT c_sdp_N_fft : NATURAL := 1024; CONSTANT c_sdp_N_pn_lb : NATURAL := 16; CONSTANT c_sdp_N_pol : NATURAL := 2; @@ -170,6 +171,16 @@ PACKAGE sdp_pkg is -- SST UDP offload MM address widths CONSTANT c_sdp_reg_stat_enable_addr_w :NATURAL := 1; + -- XSUB + CONSTANT c_sdp_crosslets_index_w : NATURAL := ceil_log2(c_sdp_N_sub); --8 + CONSTANT c_sdp_mm_reg_crosslets_info : t_c_mem := (latency => 1, + adr_w => 4, + dat_w => c_sdp_crosslets_index_w, + nof_dat => 16, -- 15 offsets + 1 step + init_sl => '0'); + CONSTANT c_sdp_crosslets_info_reg_w : NATURAL := c_sdp_mm_reg_crosslets_info.nof_dat*c_sdp_mm_reg_crosslets_info.dat_w; + + -- 10GbE offload (cep = central processor) CONSTANT c_sdp_cep_eth_src_mac_47_16 : STD_LOGIC_VECTOR(31 DOWNTO 0) := x"00228608"; -- 47:16, 15:8 = backplane, 7:0 = node CONSTANT c_sdp_cep_ip_src_addr_31_16 : STD_LOGIC_VECTOR(15 DOWNTO 0) := x"C0A8"; -- 31:16, 15:8 = backplane, 7:0 = node + 1 = 192.168.xx.yy diff --git a/applications/lofar2/libraries/sdp/tb/vhdl/tb_sdp_crosslets_subband_select.vhd b/applications/lofar2/libraries/sdp/tb/vhdl/tb_sdp_crosslets_subband_select.vhd new file mode 100644 index 0000000000000000000000000000000000000000..34ac777614a8543c4a3826c9f6252494c1a45c48 --- /dev/null +++ b/applications/lofar2/libraries/sdp/tb/vhdl/tb_sdp_crosslets_subband_select.vhd @@ -0,0 +1,247 @@ +------------------------------------------------------------------------------- +-- +-- Copyright 2021 +-- ASTRON (Netherlands Institute for Radio Astronomy) <http://www.astron.nl/> +-- P.O.Box 2, 7990 AA Dwingeloo, The Netherlands +-- +-- Licensed under the Apache License, Version 2.0 (the "License"); +-- you may not use this file except in compliance with the License. +-- You may obtain a copy of the License at +-- +-- http://www.apache.org/licenses/LICENSE-2.0 +-- +-- Unless required by applicable law or agreed to in writing, software +-- distributed under the License is distributed on an "AS IS" BASIS, +-- WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. +-- See the License for the specific language governing permissions and +-- limitations under the License. +-- +------------------------------------------------------------------------------- + +------------------------------------------------------------------------------- +-- Author : R vd Walle +-- Purpose: Verify sdp_crosslets_subband_select. +-- Usage: +-- > as 10 +-- > run -all +-- * The tb is self stopping and self checking,tb_end will stop the simulation by +-- stopping the clk and thus all toggling. +-- +-- Description: The tb verifies out_sosi and out_crosslets_info of the dut. + +LIBRARY IEEE, common_lib, dp_lib; +USE IEEE.std_logic_1164.ALL; +USE common_lib.common_pkg.ALL; +USE common_lib.common_mem_pkg.ALL; +USE common_lib.tb_common_pkg.ALL; +USE common_lib.tb_common_mem_pkg.ALL; +USE common_lib.common_lfsr_sequences_pkg.ALL; +USE dp_lib.dp_stream_pkg.ALL; +USE dp_lib.tb_dp_pkg.ALL; +USE work.sdp_pkg.ALL; + +ENTITY tb_sdp_crosslets_subband_select IS + +END tb_sdp_crosslets_subband_select; + + +ARCHITECTURE tb OF tb_sdp_crosslets_subband_select IS + + CONSTANT c_clk_period : TIME := 10 ns; + CONSTANT c_mm_clk_period : TIME := 20 ns; + CONSTANT c_rl : NATURAL := 1; + CONSTANT c_nof_sync : NATURAL := 5; + CONSTANT c_nof_block_per_sync : NATURAL := 4; + CONSTANT c_nof_ch_in : NATURAL := 1024; -- nof input words per block, identical for all input streams. + CONSTANT c_dsp_data_w : NATURAL := c_sdp_W_subband; + CONSTANT c_nof_ch_sel_row : NATURAL := c_sdp_P_pfb; + + CONSTANT c_N_crosslets : NATURAL := 2; + CONSTANT c_ch_sel_offsets : t_natural_arr(0 TO c_N_crosslets-1) := (0, 15); + CONSTANT c_nof_ch_sel_col : NATURAL := c_sdp_Q_fft; -- nof of sequential collums to select per row. + CONSTANT c_ch_sel_step : NATURAL := 3; -- offset step size to increase per sync interval + + CONSTANT c_nof_ch_sel : NATURAL :=c_N_crosslets*c_nof_ch_sel_col*c_nof_ch_sel_row; + CONSTANT scheduled_bsn : NATURAL := 11; + + SIGNAL rst : STD_LOGIC; + SIGNAL clk : STD_LOGIC := '1'; + SIGNAL mm_clk : STD_LOGIC := '1'; + SIGNAL tb_end : STD_LOGIC; + + SIGNAL mm_mosi : t_mem_mosi; + SIGNAL mm_miso : t_mem_miso; + + SIGNAL mm_trigger_mosi : t_mem_mosi := c_mem_mosi_rst; + SIGNAL mm_trigger_miso : t_mem_miso; + + SIGNAL st_en : STD_LOGIC := '1'; + SIGNAL st_siso_arr : t_dp_siso_arr(c_sdp_P_pfb-1 DOWNTO 0) := (OTHERS => c_dp_siso_rdy); + SIGNAL st_sosi_arr : t_dp_sosi_arr(c_sdp_P_pfb-1 DOWNTO 0) := (OTHERS => c_dp_sosi_rst); + SIGNAL exp_sosi : t_dp_sosi := c_dp_sosi_rst; + + SIGNAL bsn : NATURAL := scheduled_bsn-1; + + SIGNAL in_sosi_arr : t_dp_sosi_arr(c_sdp_P_pfb-1 DOWNTO 0) := (OTHERS => c_dp_sosi_rst); + + SIGNAL out_siso_arr : t_dp_siso_arr(c_sdp_P_pfb-1 DOWNTO 0) := (OTHERS => c_dp_siso_rdy); + SIGNAL out_sosi : t_dp_sosi; + + SIGNAL exp_crosslets_info : STD_LOGIC_VECTOR(c_sdp_crosslets_info_reg_w-1 DOWNTO 0) := (OTHERS => '0'); + SIGNAL out_crosslets_info : STD_LOGIC_VECTOR(c_sdp_crosslets_info_reg_w-1 DOWNTO 0) := (OTHERS => '0'); +BEGIN + + clk <= (NOT clk) OR tb_end AFTER c_clk_period/2; + mm_clk <= (NOT mm_clk) OR tb_end AFTER c_mm_clk_period/2; + rst <= '1', '0' AFTER c_clk_period*7; + + p_select_stimuli : PROCESS + VARIABLE k : NATURAL; + BEGIN + + proc_common_wait_until_low(mm_clk, rst); + proc_common_wait_some_cycles(mm_clk, 50); -- Give dut some time to start + -- BSN Scheduler + proc_mem_mm_bus_wr(0, scheduled_bsn, mm_clk, mm_trigger_miso, mm_trigger_mosi); + proc_mem_mm_bus_wr(1, 0, mm_clk, mm_trigger_miso, mm_trigger_mosi); + + -- crosslet info + FOR I IN 0 TO c_N_crosslets-1 LOOP + proc_mem_mm_bus_wr(I, c_ch_sel_offsets(I), mm_clk, mm_miso, mm_mosi); --offsets + END LOOP; + proc_mem_mm_bus_wr(15, c_ch_sel_step, mm_clk, mm_miso, mm_mosi); --step + WAIT; + END PROCESS; + + ------------------------------------------------------------------------------ + -- Data blocks + ------------------------------------------------------------------------------ + gen_stimuli : FOR K IN 0 TO c_sdp_P_pfb-1 GENERATE + p_st_stimuli : PROCESS + VARIABLE v_re : NATURAL := 0+k*2**5; + VARIABLE v_im : NATURAL := 1+k*2**5; + BEGIN + tb_end <= '0'; + st_sosi_arr(K) <= c_dp_sosi_rst; + proc_common_wait_until_low(clk, rst); + + -- Run some sync intervals with DSP counter data for the real and imag fields + WAIT UNTIL rising_edge(clk); + FOR I IN 0 TO c_nof_sync-1 LOOP + proc_dp_gen_block_data(c_rl, FALSE, c_dsp_data_w, c_dsp_data_w, 0, v_re, v_im, c_nof_ch_in, 0, 0, '1', "0", clk, st_en, st_siso_arr(K), st_sosi_arr(K)); -- next sync + v_re := v_re + c_nof_ch_in; + v_im := v_im + c_nof_ch_in; + FOR J IN 0 TO c_nof_block_per_sync-2 LOOP -- provide sop and eop for block reference + proc_dp_gen_block_data(c_rl, FALSE, c_dsp_data_w, c_dsp_data_w, 0, v_re, v_im, c_nof_ch_in, 0, 0, '0', "0", clk, st_en, st_siso_arr(K), st_sosi_arr(K)); -- no sync + v_re := v_re + c_nof_ch_in; + v_im := v_im + c_nof_ch_in; + END LOOP; + END LOOP; + st_sosi_arr(K) <= c_dp_sosi_rst; + proc_common_wait_some_cycles(clk, c_nof_ch_in); + proc_common_wait_some_cycles(clk, 10); + tb_end <= '1'; + WAIT; + END PROCESS; + END GENERATE; + + -- Time stimuli + bsn <= bsn + 1 WHEN rising_edge(clk) AND (st_sosi_arr(0).eop='1'); + + -- Add BSN to the ST data + p_in_sosi : PROCESS(st_sosi_arr, bsn) + BEGIN + FOR I IN 0 TO c_sdp_P_pfb-1 LOOP + in_sosi_arr(I) <= st_sosi_arr(I); + in_sosi_arr(I).bsn <= TO_DP_BSN(bsn); + END LOOP; + END PROCESS; + + ------------------------------------------------------------------------------ + -- Verification + ------------------------------------------------------------------------------ + p_generate_exp_data : PROCESS + VARIABLE v_col : NATURAL := 0; + VARIABLE v_row : NATURAL := 0; + VARIABLE v_offset : NATURAL := 0; + VARIABLE v_sync_ix : NATURAL := 0; + VARIABLE v_k : NATURAL := 0; + BEGIN + FOR I IN 0 TO c_nof_sync*c_nof_block_per_sync-1 LOOP + v_sync_ix := I / c_nof_block_per_sync; + exp_sosi <= c_dp_sosi_rst; + WAIT UNTIL rising_edge(out_sosi.sop); + + exp_crosslets_info(c_sdp_crosslets_info_reg_w-1 DOWNTO c_sdp_crosslets_info_reg_w - c_sdp_crosslets_index_w) <= TO_UVEC(c_ch_sel_step, c_sdp_crosslets_index_w); + FOR C IN 0 TO c_nof_ch_sel_col-1 LOOP + exp_crosslets_info((C+1)*c_sdp_crosslets_index_w-1 DOWNTO C*c_sdp_crosslets_index_w) <= TO_UVEC(c_ch_sel_offsets(C) + v_sync_ix * c_ch_sel_step, c_sdp_crosslets_index_w); + END LOOP; + + FOR J IN 0 TO c_nof_ch_sel-1 LOOP + v_offset := J / (c_nof_ch_sel_col*c_nof_ch_sel_row); + v_col := J MOD c_nof_ch_sel_col; + v_row := (J/c_nof_ch_sel_col) MOD c_nof_ch_sel_row; + v_k := c_nof_ch_sel_col * v_sync_ix * c_ch_sel_step; + + exp_sosi <= c_dp_sosi_rst; + exp_sosi.valid <= '1'; + IF J = 0 THEN + exp_sosi.sop <= '1'; + IF I MOD c_nof_block_per_sync = 0 THEN + exp_sosi.sync <= '1'; + + END IF; + ELSIF j = c_nof_ch_sel-1 THEN + exp_sosi.eop <= '1'; + END IF; + + exp_sosi.re <= TO_DP_DSP_DATA( I * c_nof_ch_in + v_k + c_nof_ch_sel_col*c_ch_sel_offsets(v_offset) + v_col + v_row*2**5); + exp_sosi.im <= TO_DP_DSP_DATA(1+ I * c_nof_ch_in + v_k + c_nof_ch_sel_col*c_ch_sel_offsets(v_offset) + v_col + v_row*2**5); + proc_common_wait_some_cycles(clk, 1); + + END LOOP; + exp_sosi <= c_dp_sosi_rst; + END LOOP; + WAIT; + END PROCESS; + + p_verify_out_data : PROCESS(clk) + BEGIN + IF rising_edge(clk) THEN + ASSERT out_sosi.valid = exp_sosi.valid REPORT "Wrong out_sosi.valid" SEVERITY ERROR; + ASSERT out_sosi.sop = exp_sosi.sop REPORT "Wrong out_sosi.sop" SEVERITY ERROR; + ASSERT out_sosi.eop = exp_sosi.eop REPORT "Wrong out_sosi.eop" SEVERITY ERROR; + ASSERT out_sosi.sync = exp_sosi.sync REPORT "Wrong out_sosi.sync" SEVERITY ERROR; + ASSERT out_crosslets_info = exp_crosslets_info REPORT "Wrong out_crosslets_info" SEVERITY ERROR; + IF exp_sosi.valid = '1' THEN + ASSERT out_sosi.re = exp_sosi.re REPORT "Wrong out_sosi.re" SEVERITY ERROR; + ASSERT out_sosi.im = exp_sosi.im REPORT "Wrong out_sosi.im" SEVERITY ERROR; + END IF; + END IF; + END PROCESS; + + u_dut : ENTITY work.sdp_crosslets_subband_select + GENERIC MAP ( + g_N_crosslets => c_N_crosslets + ) + PORT MAP ( + dp_rst => rst, + dp_clk => clk, + + mm_rst => rst, + mm_clk => mm_clk, + + reg_crosslets_info_mosi => mm_mosi, + reg_crosslets_info_miso => mm_miso, + + reg_bsn_scheduler_xsub_mosi => mm_trigger_mosi, + reg_bsn_scheduler_xsub_miso => mm_trigger_miso, + + -- Streaming + in_sosi_arr => in_sosi_arr, + out_sosi => out_sosi, + + out_crosslets_info => out_crosslets_info + ); + +END tb;