|
|
@@ -0,0 +1,263 @@ |
|
|
|
LIBRARY ieee;
|
|
|
|
USE ieee.std_logic_1164.ALL;
|
|
|
|
USE ieee.numeric_std.ALL;
|
|
|
|
USE ieee.std_logic_unsigned.ALL;
|
|
|
|
USE ieee.std_logic_signed.ALL;
|
|
|
|
|
|
|
|
PACKAGE GENERAL_INCLUDES IS
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
FUNCTION log2_sup_integer (number : natural) RETURN natural;
|
|
|
|
FUNCTION log2_inf_integer (number : natural) RETURN natural;
|
|
|
|
|
|
|
|
-- -- CONSTANTS -- --
|
|
|
|
|
|
|
|
-- ADC
|
|
|
|
CONSTANT cst_w_in : natural := 6; -- ADC in bitwidth
|
|
|
|
CONSTANT cst_w_out : natural := 19;
|
|
|
|
|
|
|
|
CONSTANT cst_nb_samples_adc_in : natural := 10; -- ADC in nb samples
|
|
|
|
|
|
|
|
-- FILTER
|
|
|
|
--coefficients
|
|
|
|
CONSTANT cst_w_coeff : natural := 8; -- coeffs bitwidth
|
|
|
|
CONSTANT cst_nb_coeffs_filter_in : natural := 20*10;
|
|
|
|
CONSTANT cst_log2_sup_nb_coeffs_subfilter_in: natural:= 5;
|
|
|
|
|
|
|
|
-- FIR
|
|
|
|
-- POLYPHASE FILTER
|
|
|
|
CONSTANT cst_nb_subfilters : natural := 10;
|
|
|
|
|
|
|
|
-- -- CALCULATIONS -- --
|
|
|
|
|
|
|
|
-- SHIFT REG
|
|
|
|
|
|
|
|
CONSTANT cst_nb_coeffs_subfilter_in : natural := cst_nb_coeffs_filter_in/cst_nb_subfilters;
|
|
|
|
CONSTANT cst_nb_samples_shiftreg_temp_in : natural := cst_nb_coeffs_subfilter_in + cst_nb_samples_adc_in;
|
|
|
|
-- mult
|
|
|
|
CONSTANT cst_w_mult_out : natural := cst_w_coeff+cst_w_in;
|
|
|
|
-- adder
|
|
|
|
CONSTANT cst_log2_adder_stages : natural := cst_log2_sup_nb_coeffs_subfilter_in;
|
|
|
|
-- fir
|
|
|
|
CONSTANT cst_w_fir_adder_out : natural := cst_w_mult_out+cst_log2_adder_stages;
|
|
|
|
|
|
|
|
-- TYPES
|
|
|
|
|
|
|
|
-- ADC
|
|
|
|
SUBTYPE smpl_adc_data_in IS std_logic_vector(cst_w_in-1 DOWNTO 0);
|
|
|
|
SUBTYPE smpl_fir_data_out IS std_logic_vector(cst_w_out-1 DOWNTO 0);
|
|
|
|
|
|
|
|
|
|
|
|
-- SHIFT REG
|
|
|
|
|
|
|
|
TYPE vect_adc_data_out IS ARRAY (0 TO cst_nb_samples_adc_in-1) OF smpl_adc_data_in;
|
|
|
|
TYPE vect_fir_data_in IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF smpl_adc_data_in;
|
|
|
|
TYPE vect_reg_data IS ARRAY(0 TO cst_nb_samples_shiftreg_temp_in-1) OF smpl_adc_data_in;
|
|
|
|
|
|
|
|
TYPE matrix_reg_data_out IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF vect_fir_data_in;
|
|
|
|
|
|
|
|
-- FILTER
|
|
|
|
|
|
|
|
SUBTYPE smpl_coeff IS std_logic_vector(cst_w_coeff-1 DOWNTO 0);
|
|
|
|
|
|
|
|
-- mult
|
|
|
|
SUBTYPE smpl_mult_data_out IS std_logic_vector(cst_w_mult_out-1 DOWNTO 0);
|
|
|
|
SUBTYPE smpl_mult_data_out_signed IS signed(cst_w_mult_out-1 DOWNTO 0);
|
|
|
|
SUBTYPE smpl_coeffs_signed IS signed(cst_w_coeff-1 DOWNTO 0);
|
|
|
|
SUBTYPE smpl_mult_data_in_signed IS signed(cst_w_in-1 DOWNTO 0);
|
|
|
|
|
|
|
|
TYPE vect_data_mult_in_signed IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF smpl_mult_data_in_signed;
|
|
|
|
TYPE vect_fir_coeffs_in IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF smpl_coeff ;
|
|
|
|
TYPE vect_mult_coeffs_signed IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF smpl_coeffs_signed;
|
|
|
|
TYPE vect_mult_data_out IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF smpl_mult_data_out;
|
|
|
|
TYPE vect_mult_data_out_signed IS ARRAY(0 TO cst_nb_coeffs_subfilter_in-1) OF smpl_mult_data_out_signed;
|
|
|
|
|
|
|
|
-- adder
|
|
|
|
TYPE vect_adder_generic IS ARRAY(0 TO 2**(cst_log2_adder_stages)-1) OF std_logic_vector(cst_w_fir_adder_out-1 DOWNTO 0);
|
|
|
|
TYPE vect_adder_generic_signed IS ARRAY(0 TO 2**(cst_log2_adder_stages)-1) OF signed(cst_w_fir_adder_out-1 DOWNTO 0);
|
|
|
|
TYPE matrix_adder_generic IS ARRAY(0 TO cst_log2_adder_stages) OF vect_adder_generic;
|
|
|
|
TYPE matrix_adder_generic_signed IS ARRAY(0 TO cst_log2_adder_stages) OF vect_adder_generic_signed;
|
|
|
|
|
|
|
|
-- fir
|
|
|
|
SUBTYPE smpl_fir_adder_data_out IS std_logic_vector(cst_w_fir_adder_out-1 DOWNTO 0);
|
|
|
|
TYPE vect_fir_adder_data_out IS ARRAY (0 TO cst_nb_samples_adc_in-1) OF smpl_fir_adder_data_out;
|
|
|
|
TYPE vect_fir_data_out IS array(0 TO cst_nb_samples_adc_in-1) OF smpl_fir_data_out;
|
|
|
|
|
|
|
|
-- POLYPHASE FILTER
|
|
|
|
|
|
|
|
-- TYPE matrix_coeffs_polyphase_filter IS array(0 to cst_nb_subfilters) OF vect_mult_coeffs;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
-- ---- CONSTANTS ----
|
|
|
|
--
|
|
|
|
-- -- data
|
|
|
|
-- CONSTANT w_x : natural := 6; -- input samples bitwidth
|
|
|
|
-- CONSTANT w_y : natural := 6; -- output data bitwidth
|
|
|
|
--
|
|
|
|
--
|
|
|
|
-- -- filter
|
|
|
|
-- CONSTANT filer_nb_coeffs : natural := 1000; -- total nb coefficients
|
|
|
|
-- CONSTANT filter_nb_channels : natural := 20; -- nb subfilters
|
|
|
|
-- CONSTANT w_coeffs : natural := 8; --
|
|
|
|
--
|
|
|
|
-- -- signal processing properties
|
|
|
|
-- CONSTANT downsampling_factor : natural := 8;
|
|
|
|
--
|
|
|
|
--
|
|
|
|
--
|
|
|
|
-- ---- CALCULATIONS ----
|
|
|
|
--
|
|
|
|
--
|
|
|
|
-- VARIABLE subfilter_coeffs_nb_temp : natural := filer_nb_coeffs/filter_nb_channels;
|
|
|
|
-- if(2**(log2_sup_integer(subfilter_coeffs_nb_temp)) != subfilter_coeffs_nb_temp) then -- if not power of 2
|
|
|
|
-- CONSTANT subfilter_coeffs_nb : natural := 2**(log2_sup_integer(subfilter_coeffs_nb_temp);
|
|
|
|
-- else
|
|
|
|
-- CONSTANT subfilter_coeffs_nb : natural := subfilter_coeffs_nb_temp;
|
|
|
|
-- end if;
|
|
|
|
--
|
|
|
|
-- CONSTANT log_subfilter_coeffs_nb : natural := log2_sup_integer(subfilter_coeffs_nb);
|
|
|
|
--
|
|
|
|
-- -- FIR
|
|
|
|
-- --multplier
|
|
|
|
-- CONSTANT data_mult_in_w : natural := w_x;
|
|
|
|
-- CONSTANT data_mult_out_w : natural := w_x+w_coeffs+1;
|
|
|
|
-- --adder
|
|
|
|
-- CONSTANT data_add_in_w : natural := data_mult_out_w;
|
|
|
|
-- CONSTANT data_P_G_stages : natural := natural(conv_std_logic_vector(data_add_in_w)'LENGTH) -- ca marche?
|
|
|
|
-- CONSTANT data_add_out_w : natural := data_add_in_w+log_subfilter_coeffs_nb;
|
|
|
|
--
|
|
|
|
--
|
|
|
|
-- ---- TYPES ----
|
|
|
|
--
|
|
|
|
-- -- filter coeffs
|
|
|
|
-- TYPE coeff IS std_logic_vector(w_coeffs-1 downto 0);
|
|
|
|
-- TYPE coeff_signed IS signed(w_coeffs-1 downto 0);
|
|
|
|
-- TYPE subfilter_coefficients IS array(0 to subfilter_coeffs_nb-1) OF coeff;
|
|
|
|
-- TYPE polyphase_filter_matrix IS array(0 to filter_nb_channels-1) OF subfilter_coefficients;
|
|
|
|
--
|
|
|
|
-- -- polyphase fill
|
|
|
|
-- polyphase_filter_matrix(others =>(others => 0); -- init;
|
|
|
|
--
|
|
|
|
-- for subfilter_nth_coeff in (0 to subfilter_coeffs_nb-1) loop -- fill subfilters
|
|
|
|
-- for lines in (0 to filter_nb_channels-1) loop
|
|
|
|
-- polyphase_filter_matrix(lines => (subfilter_nth_coeff => filter(lines*filter_nb_channels+subfilter_nth_coeff));
|
|
|
|
-- end loop;
|
|
|
|
-- end loop;
|
|
|
|
--
|
|
|
|
-- -- FIR
|
|
|
|
-- TYPE fir_data_in IS std_logic_vector(w_x-1 downto 0);
|
|
|
|
-- TYPE fir_data_out IS std_logic_vector(w_x+log_subfilter_coeffs_nb-1 downto 0);
|
|
|
|
-- --reg
|
|
|
|
-- TYPE data_reg_in IS data_in;
|
|
|
|
-- --multiplier
|
|
|
|
-- TYPE data_mult_in IS std_logic_vector(data_mult_in_w-1 downto 0);
|
|
|
|
-- TYPE data_mult_in_signed IS signed(data_mult_in_w-1 downto 0);
|
|
|
|
-- TYPE data_mult_out IS std_logic_vector(data_mult_out_w-1 downto 0);
|
|
|
|
-- TYPE data_mult_out_signed IS signed(data_mult_out_w-1 downto 0);
|
|
|
|
-- --adder
|
|
|
|
-- TYPE data_add_in IS data_mult_out;
|
|
|
|
-- TYPE data_add_out IS STD_LOGIC_VECTOR(data_add_out_w-1 downto 0);
|
|
|
|
-- --tree
|
|
|
|
-- TYPE mult_add_stage_array IS array(0 to subfilter_coeffs_nb-1) OF data_add_out;
|
|
|
|
-- TYPE mult_add_tree_matrix IS array(0 to log_subfilter_coeffs_nb) OF mult_add_stage_array;
|
|
|
|
-- --DFT
|
|
|
|
-- TYPE input_DFT_data IS data_add_out;
|
|
|
|
-- TYPE output_DFT_data IS
|
|
|
|
--
|
|
|
|
-- --TYPE step_nb_channels IS array (0 to filter_nb_channels-1) of signed (w_x-1 downto 0);
|
|
|
|
-- --TYPE filter_coeffs IS array (0 to filer_nb_coeffs-1) of signed (w_x-1 downto 0);
|
|
|
|
-- --TYPE type_data_fir IS signed(w_x-1 downto 0);
|
|
|
|
-- --TYPE type_coeff_fir IS signed
|
|
|
|
|
|
|
|
|
|
|
|
END;
|
|
|
|
|
|
|
|
PACKAGE BODY GENERAL_INCLUDES IS
|
|
|
|
|
|
|
|
|
|
|
|
--functions
|
|
|
|
FUNCTION log2_sup_integer (number : natural) RETURN natural IS
|
|
|
|
VARIABLE result : natural;
|
|
|
|
BEGIN
|
|
|
|
|
|
|
|
IF(number <= 1) THEN
|
|
|
|
result := 0;
|
|
|
|
ELSIF(number = 2) THEN
|
|
|
|
result := 1;
|
|
|
|
ELSIF(number > 2 AND number <= 4) THEN
|
|
|
|
result := 2;
|
|
|
|
ELSIF(number > 4 AND number <= 8) THEN
|
|
|
|
result := 3;
|
|
|
|
ELSIF(number > 8 AND number <= 16) THEN
|
|
|
|
result := 4;
|
|
|
|
ELSIF(number > 16 AND number <= 32) THEN
|
|
|
|
result := 5;
|
|
|
|
ELSIF(number > 32 AND number <= 64) THEN
|
|
|
|
result := 6;
|
|
|
|
ELSIF(number > 64 AND number <= 128) THEN
|
|
|
|
result := 7;
|
|
|
|
ELSIF(number > 128 AND number <= 256) THEN
|
|
|
|
result := 8;
|
|
|
|
ELSIF(number > 256 AND number <= 512) THEN
|
|
|
|
result := 9;
|
|
|
|
ELSIF(number > 512 AND number <= 1024) THEN
|
|
|
|
result := 10;
|
|
|
|
ELSIF(number > 1024 AND number <= 2048) THEN
|
|
|
|
result := 11;
|
|
|
|
ELSIF(number > 2048 AND number <= 4096) THEN
|
|
|
|
result := 12;
|
|
|
|
ELSIF(number > 4096 AND number <= 8192) THEN
|
|
|
|
result := 13;
|
|
|
|
ELSIF(number > 8192 AND number <= 16384) THEN
|
|
|
|
result := 14;
|
|
|
|
ELSIF(number > 16384 AND number <= 32768) THEN
|
|
|
|
result := 15;
|
|
|
|
END IF;
|
|
|
|
RETURN result;
|
|
|
|
END FUNCTION;
|
|
|
|
|
|
|
|
FUNCTION log2_inf_integer (number : natural) RETURN natural IS
|
|
|
|
VARIABLE result : natural;
|
|
|
|
BEGIN
|
|
|
|
|
|
|
|
IF(number < 2) THEN
|
|
|
|
result := 0;
|
|
|
|
ELSIF(number >= 2 AND number < 4) THEN
|
|
|
|
result := 1;
|
|
|
|
ELSIF(number >= 4 AND number < 8) THEN
|
|
|
|
result := 2;
|
|
|
|
ELSIF(number >= 8 AND number < 16) THEN
|
|
|
|
result := 3;
|
|
|
|
ELSIF(number >= 16 AND number < 32) THEN
|
|
|
|
result := 4;
|
|
|
|
ELSIF(number >= 32 AND number < 64) THEN
|
|
|
|
result := 5;
|
|
|
|
ELSIF(number >= 64 AND number < 128) THEN
|
|
|
|
result := 6;
|
|
|
|
ELSIF(number >= 128 AND number < 256) THEN
|
|
|
|
result := 7;
|
|
|
|
ELSIF(number >= 256 AND number < 512) THEN
|
|
|
|
result := 8;
|
|
|
|
ELSIF(number >= 512 AND number < 1024) THEN
|
|
|
|
result := 9;
|
|
|
|
ELSIF(number >= 1024 AND number < 2048) THEN
|
|
|
|
result := 10;
|
|
|
|
ELSIF(number >= 2048 AND number < 4096) THEN
|
|
|
|
Result := 11;
|
|
|
|
ELSIF(Number >= 4096 AND number < 8192) THEN
|
|
|
|
result := 12;
|
|
|
|
ELSIF(number >= 8192 AND number < 16384) THEN
|
|
|
|
result := 13;
|
|
|
|
ELSIF(number >= 16384 AND number < 32768) THEN
|
|
|
|
result := 14;
|
|
|
|
END IF;
|
|
|
|
RETURN result;
|
|
|
|
END FUNCTION;
|
|
|
|
|
|
|
|
END PACKAGE BODY;
|