@pellion The GIAN array can't be COEFF_CEL_REAL because its size depend on the number of cells.
| @@ -0,0 +1,93 | |||
|
|
1 | ------------------------------------------------------------------------------ | |
|
|
2 | -- This file is a part of the LPP VHDL IP LIBRARY | |
|
|
3 | -- Copyright (C) 2009 - 2010, Laboratory of Plasmas Physic - CNRS | |
|
|
4 | -- | |
|
|
5 | -- This program is free software; you can redistribute it and/or modify | |
|
|
6 | -- it under the terms of the GNU General Public License as published by | |
|
|
7 | -- the Free Software Foundation; either version 3 of the License, or | |
|
|
8 | -- (at your option) any later version. | |
|
|
9 | -- | |
|
|
10 | -- This program is distributed in the hope that it will be useful, | |
|
|
11 | -- but WITHOUT ANY WARRANTY; without even the implied warranty of | |
|
|
12 | -- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
|
|
13 | -- GNU General Public License for more details. | |
|
|
14 | -- | |
|
|
15 | -- You should have received a copy of the GNU General Public License | |
|
|
16 | -- along with this program; if not, write to the Free Software | |
|
|
17 | -- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
|
|
18 | ------------------------------------------------------------------------------- | |
|
|
19 | -- Author : Jean-christophe Pellion | |
|
|
20 | -- Mail : jean-christophe.pellion@lpp.polytechnique.fr | |
|
|
21 | -- jean-christophe.pellion@easii-ic.com | |
|
|
22 | ---------------------------------------------------------------------------- | |
|
|
23 | LIBRARY ieee; | |
|
|
24 | USE ieee.std_logic_1164.ALL; | |
|
|
25 | USE ieee.numeric_std.ALL; | |
|
|
26 | USE ieee.math_real.ALL; | |
|
|
27 | ||
|
|
28 | PACKAGE lpp_lfr_filter_coeff IS | |
|
|
29 | ||
|
|
30 | --REAL | |
|
|
31 | TYPE COEFF_CEL_REAL IS ARRAY (1 TO 6) OF REAL; -- b0, b1, b2, a0, a1, a2 | |
|
|
32 | TYPE COEFF_CEL_ARRAY_REAL IS ARRAY (INTEGER RANGE <>) OF COEFF_CEL_REAL; | |
|
|
33 | --INTEGER | |
|
|
34 | TYPE COEFF_CEL_INTEGER IS ARRAY (1 TO 6) OF INTEGER; -- b0, b1, b2, a0, a1, a2 | |
|
|
35 | TYPE COEFF_CEL_ARRAY_INTEGER IS ARRAY (INTEGER RANGE <>) OF COEFF_CEL_INTEGER; | |
|
|
36 | ||
|
|
37 | ----------------------------------------------------------------------------- | |
|
|
38 | -- | |
|
|
39 | ----------------------------------------------------------------------------- | |
|
|
40 | FUNCTION get_IIR_CEL_FILTER_CONFIG ( | |
|
|
41 | COEFFICIENT_SIZE , POINT_POSITION, CEL_NUMBER : INTEGER; | |
|
|
42 | SOS_array : COEFF_CEL_ARRAY_REAL;--(INTEGER RANGE <>); | |
|
|
43 | GAIN_array : COEFF_CEL_REAL | |
|
|
44 | ) RETURN STD_LOGIC_VECTOR; | |
|
|
45 | ||
|
|
46 | ||
|
|
47 | END lpp_lfr_filter_coeff; | |
|
|
48 | ||
|
|
49 | PACKAGE BODY lpp_lfr_filter_coeff IS | |
|
|
50 | ||
|
|
51 | FUNCTION get_IIR_CEL_FILTER_CONFIG ( | |
|
|
52 | COEFFICIENT_SIZE , POINT_POSITION, CEL_NUMBER : INTEGER; | |
|
|
53 | SOS_array : COEFF_CEL_ARRAY_REAL;--(INTEGER RANGE <>); | |
|
|
54 | GAIN_array : COEFF_CEL_REAL | |
|
|
55 | ) RETURN STD_LOGIC_VECTOR IS | |
|
|
56 | ||
|
|
57 | VARIABLE config_vector : STD_LOGIC_VECTOR((CEL_NUMBER * 5 * COEFFICIENT_SIZE)-1 DOWNTO 0); | |
|
|
58 | VARIABLE SOS_with_gain_array : COEFF_CEL_ARRAY_REAL(1 TO CEL_NUMBER); | |
|
|
59 | ||
|
|
60 | VARIABLE SOS_with_gain_array_integer : COEFF_CEL_ARRAY_INTEGER(1 TO CEL_NUMBER); | |
|
|
61 | BEGIN | |
|
|
62 | ||
|
|
63 | all_cel: FOR I IN 1 TO CEL_NUMBER LOOP | |
|
|
64 | all_param_b : FOR J IN 1 TO 3 LOOP | |
|
|
65 | SOS_with_gain_array(I)(J) := SOS_array(I)(J) * GAIN_array(I); | |
|
|
66 | END LOOP all_param_b; | |
|
|
67 | all_param_a : FOR J IN 4 TO 6 LOOP | |
|
|
68 | SOS_with_gain_array(I)(J) := SOS_array(I)(J); | |
|
|
69 | END LOOP all_param_a; | |
|
|
70 | END LOOP all_cel; | |
|
|
71 | ||
|
|
72 | all_cel_int: FOR I IN 1 TO CEL_NUMBER LOOP | |
|
|
73 | all_param_int: FOR J IN 1 TO 6 LOOP | |
|
|
74 | SOS_with_gain_array_integer(I)(J) := INTEGER( SOS_with_gain_array(I)(J) * REAL(2**(POINT_POSITION)) ); | |
|
|
75 | END LOOP all_param_int; | |
|
|
76 | END LOOP all_cel_int; | |
|
|
77 | ||
|
|
78 | all_cel_output: FOR I IN 1 TO CEL_NUMBER LOOP | |
|
|
79 | all_param_b_out: FOR J IN 1 TO 3 LOOP | |
|
|
80 | config_vector( (((I-1)*5)+3-J)*COEFFICIENT_SIZE + COEFFICIENT_SIZE -1 DOWNTO (((I-1)*5)+3-J)*COEFFICIENT_SIZE ) | |
|
|
81 | := std_logic_vector(TO_SIGNED(SOS_with_gain_array_integer(I)(J),COEFFICIENT_SIZE )); | |
|
|
82 | END LOOP all_param_b_out; | |
|
|
83 | config_vector( (((I-1)*5)+3)*COEFFICIENT_SIZE + COEFFICIENT_SIZE -1 DOWNTO (((I-1)*5)+3)*COEFFICIENT_SIZE ) | |
|
|
84 | := std_logic_vector(TO_SIGNED(SOS_with_gain_array_integer(I)(6),COEFFICIENT_SIZE)); | |
|
|
85 | config_vector( (((I-1)*5)+4)*COEFFICIENT_SIZE + COEFFICIENT_SIZE -1 DOWNTO (((I-1)*5)+4)*COEFFICIENT_SIZE ) | |
|
|
86 | := std_logic_vector(TO_SIGNED(SOS_with_gain_array_integer(I)(5),COEFFICIENT_SIZE)); | |
|
|
87 | END LOOP all_cel_output; | |
|
|
88 | ||
|
|
89 | RETURN config_vector; | |
|
|
90 | ||
|
|
91 | END FUNCTION; | |
|
|
92 | ||
|
|
93 | END lpp_lfr_filter_coeff; | |
General Comments 0
You need to be logged in to leave comments.
Login now