Dff3 filter added to irc inputs.

diff --git a/pmsm-control/dff3.vhdl b/pmsm-control/dff3.vhdl
new file mode 100644 (file)
index 0000000..7066f83
--- /dev/null
+++ b/pmsm-control/dff3.vhdl
@@ -0,0 +1,53 @@
+library ieee;
+use ieee.std_logic_1164.all;
+use ieee.std_logic_arith.all;
+use ieee.std_logic_unsigned.all;
+use ieee.numeric_std.all;
+use work.lx_rocon_pkg.all;
+
+-- D circuit (filtered)
+
+entity dff3 is
+  port
+       (
+    clk_i   : in std_logic;
+    d_i     : in std_logic;
+    q_o     : out std_logic
+  );
+end dff3;
+
+architecture behavioral of dff3 is
+       signal d_3r   : std_logic;
+       signal d_2r   : std_logic;
+       signal d_r    : std_logic;
+       signal data_s : std_logic;
+
+       -- XST attributes
+       --potlaceni duplikace klupnych obvodu ve fazi optimalizace
+       --attribute REGISTER_DUPLICATION : string;
+       --attribute REGISTER_DUPLICATION of d_3r : signal is "NO";
+       --attribute REGISTER_DUPLICATION of d_2r : signal is "NO";
+       --attribute REGISTER_DUPLICATION of d_r  : signal is "NO";
+       
+       attribute syn_keep : boolean;
+       attribute syn_keep of d_3r : signal is true;
+       attribute syn_keep of d_2r : signal is true;
+       attribute syn_keep of d_r : signal is true;
+       
+begin
+  q_o <= data_s;
+
+seq:
+       process
+       begin
+    wait until clk_i'event and clk_i = '1';
+               if d_3r = d_2r and d_2r = d_r then
+                       data_s <= d_3r;
+               end if;
+
+               d_3r <= d_2r;
+               d_2r <= d_r;
+               d_r  <= d_i;
+  end process;
+
+end behavioral;

diff --git a/pmsm-control/rpi_pmsm_control.vhdl b/pmsm-control/rpi_pmsm_control.vhdl
index 13ffb97cda27f6aae95c4f46c00f45b6c5100fe6..177029f4b2e35c0ce8ed48a90c55ab6f649afc3f 100644 (file)
--- a/pmsm-control/rpi_pmsm_control.vhdl
+++ b/pmsm-control/rpi_pmsm_control.vhdl
@@ -173,6 +173,14 @@ architecture behavioral of rpi_pmsm_control is
        );
        end component;
        
+       component dff3 is
+       port(
+               clk_i   : in std_logic;
+               d_i     : in std_logic;
+               q_o     : out std_logic
+       );
+       end component;
+       
        
        signal adc_channels: std_logic_vector(71 downto 0);
        signal adc_m_count: std_logic_vector(8 downto 0);
@@ -217,6 +225,10 @@ architecture behavioral of rpi_pmsm_control is
        -- irc signals processing
        signal irc_i_prev: std_logic;
        
+       --filetered irc signals
+       signal irc_a_dff3: std_logic;
+       signal irc_b_dff3: std_logic;
+       
        --  attribute syn_noprune of gpio2 : signal is true;
        --  attribute syn_preserve of gpio2 : signal is true;
        --  attribute syn_keep of gpio2 : signal is true;
@@ -250,8 +262,8 @@ begin
        port map (
                clock => gpio_clk,
                reset => '0',
-               a0 => irc_a,
-               b0 => irc_b,
+               a0 => irc_a_dff3,
+               b0 => irc_b_dff3,
                qcount => position,
                a_rise => open,
                a_fall => open,
@@ -311,6 +323,20 @@ begin
                measur_count => adc_m_count
                
        );
+       
+       dff3_a: dff3
+       port map(       
+               clk_i => gpio_clk,
+               d_i   => irc_a,
+               q_o   => irc_a_dff3 
+       );
+       
+       dff3_b: dff3
+       port map(       
+               clk_i => gpio_clk,
+               d_i   => irc_b,
+               q_o   => irc_b_dff3 
+       );
 
        dummy_unused <= gpio2 and gpio3 and
                gpio5 and gpio6 and