lpp_lfr_filter.vhd
419 lines
| 17.0 KiB
| text/x-vhdl
|
VhdlLexer
|
r493 | ------------------------------------------------------------------------------ | ||
-- This file is a part of the LPP VHDL IP LIBRARY | ||||
-- Copyright (C) 2009 - 2010, Laboratory of Plasmas Physic - CNRS | ||||
-- | ||||
-- This program is free software; you can redistribute it and/or modify | ||||
-- it under the terms of the GNU General Public License as published by | ||||
-- the Free Software Foundation; either version 3 of the License, or | ||||
-- (at your option) any later version. | ||||
-- | ||||
-- This program is distributed in the hope that it will be useful, | ||||
-- but WITHOUT ANY WARRANTY; without even the implied warranty of | ||||
-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||||
-- GNU General Public License for more details. | ||||
-- | ||||
-- You should have received a copy of the GNU General Public License | ||||
-- along with this program; if not, write to the Free Software | ||||
-- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||||
------------------------------------------------------------------------------- | ||||
-- Author : Jean-christophe Pellion | ||||
-- Mail : jean-christophe.pellion@lpp.polytechnique.fr | ||||
-- jean-christophe.pellion@easii-ic.com | ||||
---------------------------------------------------------------------------- | ||||
|
r212 | LIBRARY ieee; | ||
USE ieee.std_logic_1164.ALL; | ||||
USE ieee.numeric_std.ALL; | ||||
LIBRARY lpp; | ||||
USE lpp.lpp_ad_conv.ALL; | ||||
USE lpp.iir_filter.ALL; | ||||
USE lpp.FILTERcfg.ALL; | ||||
USE lpp.lpp_memory.ALL; | ||||
USE lpp.lpp_waveform_pkg.ALL; | ||||
|
r493 | USE lpp.cic_pkg.ALL; | ||
|
r499 | USE lpp.data_type_pkg.ALL; | ||
|
r212 | |||
LIBRARY techmap; | ||||
USE techmap.gencomp.ALL; | ||||
LIBRARY grlib; | ||||
USE grlib.amba.ALL; | ||||
USE grlib.stdlib.ALL; | ||||
USE grlib.devices.ALL; | ||||
USE GRLIB.DMA2AHB_Package.ALL; | ||||
ENTITY lpp_lfr_filter IS | ||||
GENERIC( | ||||
Mem_use : INTEGER := use_RAM | ||||
); | ||||
PORT ( | ||||
sample : IN Samples(7 DOWNTO 0); | ||||
sample_val : IN STD_LOGIC; | ||||
-- | ||||
clk : IN STD_LOGIC; | ||||
rstn : IN STD_LOGIC; | ||||
-- | ||||
data_shaping_SP0 : IN STD_LOGIC; | ||||
data_shaping_SP1 : IN STD_LOGIC; | ||||
data_shaping_R0 : IN STD_LOGIC; | ||||
data_shaping_R1 : IN STD_LOGIC; | ||||
|
r416 | data_shaping_R2 : IN STD_LOGIC; | ||
|
r212 | -- | ||
sample_f0_val : OUT STD_LOGIC; | ||||
sample_f1_val : OUT STD_LOGIC; | ||||
sample_f2_val : OUT STD_LOGIC; | ||||
sample_f3_val : OUT STD_LOGIC; | ||||
-- | ||||
sample_f0_wdata : OUT STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
sample_f1_wdata : OUT STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
sample_f2_wdata : OUT STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
sample_f3_wdata : OUT STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0) | ||||
); | ||||
END lpp_lfr_filter; | ||||
ARCHITECTURE tb OF lpp_lfr_filter IS | ||||
COMPONENT Downsampling | ||||
GENERIC ( | ||||
ChanelCount : INTEGER; | ||||
SampleSize : INTEGER; | ||||
DivideParam : INTEGER); | ||||
PORT ( | ||||
clk : IN STD_LOGIC; | ||||
rstn : IN STD_LOGIC; | ||||
sample_in_val : IN STD_LOGIC; | ||||
sample_in : IN samplT(ChanelCount-1 DOWNTO 0, SampleSize-1 DOWNTO 0); | ||||
sample_out_val : OUT STD_LOGIC; | ||||
sample_out : OUT samplT(ChanelCount-1 DOWNTO 0, SampleSize-1 DOWNTO 0)); | ||||
END COMPONENT; | ||||
----------------------------------------------------------------------------- | ||||
CONSTANT ChanelCount : INTEGER := 8; | ||||
----------------------------------------------------------------------------- | ||||
SIGNAL sample_val_delay : STD_LOGIC; | ||||
----------------------------------------------------------------------------- | ||||
CONSTANT Coef_SZ : INTEGER := 9; | ||||
CONSTANT CoefCntPerCel : INTEGER := 6; | ||||
CONSTANT CoefPerCel : INTEGER := 5; | ||||
CONSTANT Cels_count : INTEGER := 5; | ||||
|
r227 | --SIGNAL coefs : STD_LOGIC_VECTOR((Coef_SZ*CoefCntPerCel*Cels_count)-1 DOWNTO 0); | ||
|
r212 | SIGNAL coefs_v2 : STD_LOGIC_VECTOR((Coef_SZ*CoefPerCel*Cels_count)-1 DOWNTO 0); | ||
SIGNAL sample_filter_in : samplT(ChanelCount-1 DOWNTO 0, 17 DOWNTO 0); | ||||
|
r227 | --SIGNAL sample_filter_out : samplT(ChanelCount-1 DOWNTO 0, 17 DOWNTO 0); | ||
|
r212 | -- | ||
SIGNAL sample_filter_v2_out_val : STD_LOGIC; | ||||
SIGNAL sample_filter_v2_out : samplT(ChanelCount-1 DOWNTO 0, 17 DOWNTO 0); | ||||
----------------------------------------------------------------------------- | ||||
SIGNAL sample_data_shaping_out_val : STD_LOGIC; | ||||
SIGNAL sample_data_shaping_out : samplT(ChanelCount-1 DOWNTO 0, 17 DOWNTO 0); | ||||
SIGNAL sample_data_shaping_f0_s : STD_LOGIC_VECTOR(17 DOWNTO 0); | ||||
SIGNAL sample_data_shaping_f1_s : STD_LOGIC_VECTOR(17 DOWNTO 0); | ||||
SIGNAL sample_data_shaping_f2_s : STD_LOGIC_VECTOR(17 DOWNTO 0); | ||||
SIGNAL sample_data_shaping_f1_f0_s : STD_LOGIC_VECTOR(17 DOWNTO 0); | ||||
SIGNAL sample_data_shaping_f2_f1_s : STD_LOGIC_VECTOR(17 DOWNTO 0); | ||||
----------------------------------------------------------------------------- | ||||
SIGNAL sample_filter_v2_out_val_s : STD_LOGIC; | ||||
SIGNAL sample_filter_v2_out_s : samplT(ChanelCount-1 DOWNTO 0, 15 DOWNTO 0); | ||||
----------------------------------------------------------------------------- | ||||
-- SIGNAL sample_f0_val : STD_LOGIC; | ||||
SIGNAL sample_f0 : samplT(ChanelCount-1 DOWNTO 0, 15 DOWNTO 0); | ||||
|
r493 | SIGNAL sample_f0_s : sample_vector(5 DOWNTO 0, 15 DOWNTO 0); | ||
|
r212 | -- | ||
-- SIGNAL sample_f1_val : STD_LOGIC; | ||||
SIGNAL sample_f1 : samplT(ChanelCount-1 DOWNTO 0, 15 DOWNTO 0); | ||||
SIGNAL sample_f1_s : samplT(5 DOWNTO 0, 15 DOWNTO 0); | ||||
-- | ||||
-- SIGNAL sample_f2_val : STD_LOGIC; | ||||
|
r497 | SIGNAL sample_f2 : samplT(5 DOWNTO 0, 15 DOWNTO 0); | ||
SIGNAL sample_f2_cic_s : samplT(5 DOWNTO 0, 15 DOWNTO 0); | ||||
SIGNAL sample_f2_cic : sample_vector(5 DOWNTO 0, 15 DOWNTO 0); | ||||
SIGNAL sample_f2_cic_val : STD_LOGIC; | ||||
SIGNAL sample_f3 : samplT(5 DOWNTO 0, 15 DOWNTO 0); | ||||
SIGNAL sample_f3_cic_s : samplT(5 DOWNTO 0, 15 DOWNTO 0); | ||||
SIGNAL sample_f3_cic : sample_vector(5 DOWNTO 0, 15 DOWNTO 0); | ||||
SIGNAL sample_f3_cic_val : STD_LOGIC; | ||||
|
r212 | |||
----------------------------------------------------------------------------- | ||||
|
r227 | --SIGNAL data_f0_in_valid : STD_LOGIC_VECTOR(159 DOWNTO 0) := (OTHERS => '0'); | ||
--SIGNAL data_f1_in_valid : STD_LOGIC_VECTOR(159 DOWNTO 0) := (OTHERS => '0'); | ||||
--SIGNAL data_f2_in_valid : STD_LOGIC_VECTOR(159 DOWNTO 0) := (OTHERS => '0'); | ||||
--SIGNAL data_f3_in_valid : STD_LOGIC_VECTOR(159 DOWNTO 0) := (OTHERS => '0'); | ||||
|
r212 | ----------------------------------------------------------------------------- | ||
SIGNAL sample_f0_wdata_s : STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
SIGNAL sample_f1_wdata_s : STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
SIGNAL sample_f2_wdata_s : STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
SIGNAL sample_f3_wdata_s : STD_LOGIC_VECTOR((6*16)-1 DOWNTO 0); | ||||
SIGNAL sample_f0_val_s : STD_LOGIC; | ||||
SIGNAL sample_f1_val_s : STD_LOGIC; | ||||
BEGIN | ||||
----------------------------------------------------------------------------- | ||||
PROCESS (clk, rstn) | ||||
BEGIN -- PROCESS | ||||
IF rstn = '0' THEN -- asynchronous reset (active low) | ||||
sample_val_delay <= '0'; | ||||
ELSIF clk'EVENT AND clk = '1' THEN -- rising clock edge | ||||
sample_val_delay <= sample_val; | ||||
END IF; | ||||
END PROCESS; | ||||
----------------------------------------------------------------------------- | ||||
ChanelLoop : FOR i IN 0 TO ChanelCount-1 GENERATE | ||||
SampleLoop : FOR j IN 0 TO 15 GENERATE | ||||
sample_filter_in(i, j) <= sample(i)(j); | ||||
END GENERATE; | ||||
sample_filter_in(i, 16) <= sample(i)(15); | ||||
sample_filter_in(i, 17) <= sample(i)(15); | ||||
END GENERATE; | ||||
coefs_v2 <= CoefsInitValCst_v2; | ||||
IIR_CEL_CTRLR_v2_1 : IIR_CEL_CTRLR_v2 | ||||
GENERIC MAP ( | ||||
tech => 0, | ||||
Mem_use => Mem_use, -- use_RAM | ||||
Sample_SZ => 18, | ||||
Coef_SZ => Coef_SZ, | ||||
Coef_Nb => 25, | ||||
Coef_sel_SZ => 5, | ||||
Cels_count => Cels_count, | ||||
ChanelsCount => ChanelCount) | ||||
PORT MAP ( | ||||
rstn => rstn, | ||||
clk => clk, | ||||
virg_pos => 7, | ||||
coefs => coefs_v2, | ||||
sample_in_val => sample_val_delay, | ||||
sample_in => sample_filter_in, | ||||
sample_out_val => sample_filter_v2_out_val, | ||||
sample_out => sample_filter_v2_out); | ||||
----------------------------------------------------------------------------- | ||||
-- DATA_SHAPING | ||||
----------------------------------------------------------------------------- | ||||
all_data_shaping_in_loop : FOR I IN 17 DOWNTO 0 GENERATE | ||||
sample_data_shaping_f0_s(I) <= sample_filter_v2_out(0, I); | ||||
sample_data_shaping_f1_s(I) <= sample_filter_v2_out(1, I); | ||||
sample_data_shaping_f2_s(I) <= sample_filter_v2_out(2, I); | ||||
END GENERATE all_data_shaping_in_loop; | ||||
sample_data_shaping_f1_f0_s <= sample_data_shaping_f1_s - sample_data_shaping_f0_s; | ||||
sample_data_shaping_f2_f1_s <= sample_data_shaping_f2_s - sample_data_shaping_f1_s; | ||||
PROCESS (clk, rstn) | ||||
BEGIN -- PROCESS | ||||
IF rstn = '0' THEN -- asynchronous reset (active low) | ||||
sample_data_shaping_out_val <= '0'; | ||||
ELSIF clk'EVENT AND clk = '1' THEN -- rising clock edge | ||||
sample_data_shaping_out_val <= sample_filter_v2_out_val; | ||||
END IF; | ||||
END PROCESS; | ||||
SampleLoop_data_shaping : FOR j IN 0 TO 17 GENERATE | ||||
PROCESS (clk, rstn) | ||||
BEGIN | ||||
IF rstn = '0' THEN | ||||
sample_data_shaping_out(0, j) <= '0'; | ||||
sample_data_shaping_out(1, j) <= '0'; | ||||
sample_data_shaping_out(2, j) <= '0'; | ||||
sample_data_shaping_out(3, j) <= '0'; | ||||
sample_data_shaping_out(4, j) <= '0'; | ||||
sample_data_shaping_out(5, j) <= '0'; | ||||
sample_data_shaping_out(6, j) <= '0'; | ||||
sample_data_shaping_out(7, j) <= '0'; | ||||
ELSIF clk'EVENT AND clk = '1' THEN -- rising clock edge | ||||
sample_data_shaping_out(0, j) <= sample_filter_v2_out(0, j); | ||||
IF data_shaping_SP0 = '1' THEN | ||||
sample_data_shaping_out(1, j) <= sample_data_shaping_f1_f0_s(j); | ||||
ELSE | ||||
sample_data_shaping_out(1, j) <= sample_filter_v2_out(1, j); | ||||
END IF; | ||||
IF data_shaping_SP1 = '1' THEN | ||||
sample_data_shaping_out(2, j) <= sample_data_shaping_f2_f1_s(j); | ||||
ELSE | ||||
sample_data_shaping_out(2, j) <= sample_filter_v2_out(2, j); | ||||
END IF; | ||||
sample_data_shaping_out(3, j) <= sample_filter_v2_out(3, j); | ||||
sample_data_shaping_out(4, j) <= sample_filter_v2_out(4, j); | ||||
sample_data_shaping_out(5, j) <= sample_filter_v2_out(5, j); | ||||
sample_data_shaping_out(6, j) <= sample_filter_v2_out(6, j); | ||||
sample_data_shaping_out(7, j) <= sample_filter_v2_out(7, j); | ||||
END IF; | ||||
END PROCESS; | ||||
END GENERATE; | ||||
sample_filter_v2_out_val_s <= sample_data_shaping_out_val; | ||||
ChanelLoopOut : FOR i IN 0 TO 7 GENERATE | ||||
SampleLoopOut : FOR j IN 0 TO 15 GENERATE | ||||
sample_filter_v2_out_s(i, j) <= sample_data_shaping_out(i, j); | ||||
END GENERATE; | ||||
END GENERATE; | ||||
----------------------------------------------------------------------------- | ||||
-- F0 -- @24.576 kHz | ||||
----------------------------------------------------------------------------- | ||||
Downsampling_f0 : Downsampling | ||||
GENERIC MAP ( | ||||
ChanelCount => 8, | ||||
SampleSize => 16, | ||||
DivideParam => 4) | ||||
PORT MAP ( | ||||
clk => clk, | ||||
rstn => rstn, | ||||
sample_in_val => sample_filter_v2_out_val_s, | ||||
sample_in => sample_filter_v2_out_s, | ||||
sample_out_val => sample_f0_val_s, | ||||
sample_out => sample_f0); | ||||
sample_f0_val <= sample_f0_val_s; | ||||
all_bit_sample_f0 : FOR I IN 15 DOWNTO 0 GENERATE | ||||
sample_f0_wdata_s(I) <= sample_f0(0, I); -- V | ||||
sample_f0_wdata_s(16*1+I) <= sample_f0(1, I) WHEN data_shaping_R0 = '1' ELSE sample_f0(3, I); -- E1 | ||||
sample_f0_wdata_s(16*2+I) <= sample_f0(2, I) WHEN data_shaping_R0 = '1' ELSE sample_f0(4, I); -- E2 | ||||
sample_f0_wdata_s(16*3+I) <= sample_f0(5, I); -- B1 | ||||
sample_f0_wdata_s(16*4+I) <= sample_f0(6, I); -- B2 | ||||
sample_f0_wdata_s(16*5+I) <= sample_f0(7, I); -- B3 | ||||
END GENERATE all_bit_sample_f0; | ||||
--sample_f0_wen <= NOT(sample_f0_val) & | ||||
-- NOT(sample_f0_val) & | ||||
-- NOT(sample_f0_val) & | ||||
-- NOT(sample_f0_val) & | ||||
-- NOT(sample_f0_val) & | ||||
-- NOT(sample_f0_val); | ||||
----------------------------------------------------------------------------- | ||||
-- F1 -- @4096 Hz | ||||
----------------------------------------------------------------------------- | ||||
Downsampling_f1 : Downsampling | ||||
GENERIC MAP ( | ||||
ChanelCount => 8, | ||||
SampleSize => 16, | ||||
DivideParam => 6) | ||||
PORT MAP ( | ||||
clk => clk, | ||||
rstn => rstn, | ||||
sample_in_val => sample_f0_val_s , | ||||
sample_in => sample_f0, | ||||
sample_out_val => sample_f1_val_s, | ||||
sample_out => sample_f1); | ||||
|
r416 | sample_f1_val <= sample_f1_val_s; | ||
|
r212 | |||
all_bit_sample_f1 : FOR I IN 15 DOWNTO 0 GENERATE | ||||
sample_f1_wdata_s(I) <= sample_f1(0, I); -- V | ||||
sample_f1_wdata_s(16*1+I) <= sample_f1(1, I) WHEN data_shaping_R1 = '1' ELSE sample_f1(3, I); -- E1 | ||||
sample_f1_wdata_s(16*2+I) <= sample_f1(2, I) WHEN data_shaping_R1 = '1' ELSE sample_f1(4, I); -- E2 | ||||
sample_f1_wdata_s(16*3+I) <= sample_f1(5, I); -- B1 | ||||
sample_f1_wdata_s(16*4+I) <= sample_f1(6, I); -- B2 | ||||
sample_f1_wdata_s(16*5+I) <= sample_f1(7, I); -- B3 | ||||
END GENERATE all_bit_sample_f1; | ||||
--sample_f1_wen <= NOT(sample_f1_val) & | ||||
-- NOT(sample_f1_val) & | ||||
-- NOT(sample_f1_val) & | ||||
-- NOT(sample_f1_val) & | ||||
-- NOT(sample_f1_val) & | ||||
-- NOT(sample_f1_val); | ||||
----------------------------------------------------------------------------- | ||||
-- F2 -- @256 Hz | ||||
|
r493 | -- F3 -- @16 Hz | ||
|
r212 | ----------------------------------------------------------------------------- | ||
all_bit_sample_f0_s : FOR I IN 15 DOWNTO 0 GENERATE | ||||
sample_f0_s(0, I) <= sample_f0(0, I); -- V | ||||
sample_f0_s(1, I) <= sample_f0(1, I); -- E1 | ||||
sample_f0_s(2, I) <= sample_f0(2, I); -- E2 | ||||
sample_f0_s(3, I) <= sample_f0(5, I); -- B1 | ||||
sample_f0_s(4, I) <= sample_f0(6, I); -- B2 | ||||
sample_f0_s(5, I) <= sample_f0(7, I); -- B3 | ||||
END GENERATE all_bit_sample_f0_s; | ||||
|
r493 | |||
cic_lfr_1: cic_lfr | ||||
|
r212 | GENERIC MAP ( | ||
|
r493 | tech => 0, | ||
use_RAM_nCEL => Mem_use) | ||||
|
r212 | PORT MAP ( | ||
|
r493 | clk => clk, | ||
rstn => rstn, | ||||
run => '1', | ||||
data_in => sample_f0_s, | ||||
data_in_valid => sample_f0_val_s, | ||||
|
r497 | data_out_16 => sample_f2_cic, | ||
data_out_16_valid => sample_f2_cic_val, | ||||
|
r493 | |||
|
r497 | data_out_256 => sample_f3_cic, | ||
data_out_256_valid => sample_f3_cic_val); | ||||
----------------------------------------------------------------------------- | ||||
all_bit_sample_f2_cic : FOR I IN 15 DOWNTO 0 GENERATE | ||||
all_channel_sample_f2_cic : FOR J IN 5 DOWNTO 0 GENERATE | ||||
sample_f2_cic_s(J,I) <= sample_f2_cic(J,I); | ||||
END GENERATE all_channel_sample_f2_cic; | ||||
END GENERATE all_bit_sample_f2_cic; | ||||
Downsampling_f2 : Downsampling | ||||
GENERIC MAP ( | ||||
ChanelCount => 6, | ||||
SampleSize => 16, | ||||
DivideParam => 6) | ||||
PORT MAP ( | ||||
clk => clk, | ||||
rstn => rstn, | ||||
sample_in_val => sample_f2_cic_val , | ||||
sample_in => sample_f2_cic_s, | ||||
sample_out_val => sample_f2_val, | ||||
sample_out => sample_f2); | ||||
|
r212 | |||
all_bit_sample_f2 : FOR I IN 15 DOWNTO 0 GENERATE | ||||
|
r497 | all_channel_sample_f2 : FOR J IN 5 DOWNTO 0 GENERATE | ||
sample_f2_wdata_s(16*J+I) <= sample_f2(J,I); | ||||
END GENERATE all_channel_sample_f2; | ||||
|
r212 | END GENERATE all_bit_sample_f2; | ||
|
r497 | |||
----------------------------------------------------------------------------- | ||||
|
r499 | all_bit_sample_f3_cic : FOR I IN 15 DOWNTO 0 GENERATE | ||
all_channel_sample_f3_cic : FOR J IN 5 DOWNTO 0 GENERATE | ||||
|
r497 | sample_f3_cic_s(J,I) <= sample_f3_cic(J,I); | ||
|
r499 | END GENERATE all_channel_sample_f3_cic; | ||
END GENERATE all_bit_sample_f3_cic; | ||||
|
r497 | |||
Downsampling_f3 : Downsampling | ||||
GENERIC MAP ( | ||||
ChanelCount => 6, | ||||
SampleSize => 16, | ||||
DivideParam => 6) | ||||
PORT MAP ( | ||||
clk => clk, | ||||
rstn => rstn, | ||||
sample_in_val => sample_f3_cic_val , | ||||
sample_in => sample_f3_cic_s, | ||||
sample_out_val => sample_f3_val, | ||||
sample_out => sample_f3); | ||||
all_bit_sample_f3 : FOR I IN 15 DOWNTO 0 GENERATE | ||||
all_channel_sample_f3 : FOR J IN 5 DOWNTO 0 GENERATE | ||||
sample_f3_wdata_s(16*J+I) <= sample_f3(J,I); | ||||
END GENERATE all_channel_sample_f3; | ||||
END GENERATE all_bit_sample_f3; | ||||
|
r212 | |||
----------------------------------------------------------------------------- | ||||
-- | ||||
----------------------------------------------------------------------------- | ||||
sample_f0_wdata <= sample_f0_wdata_s; | ||||
sample_f1_wdata <= sample_f1_wdata_s; | ||||
sample_f2_wdata <= sample_f2_wdata_s; | ||||
sample_f3_wdata <= sample_f3_wdata_s; | ||||
|
r493 | END tb; | ||