From fb53ad99c67e082af0deca9efdf99e287002ffeb Mon Sep 17 00:00:00 2001
From: Martin Prudek <prudemar@fel.cvut.cz>
Date: Sun, 4 Oct 2015 16:05:28 +0200
Subject: [PATCH] Dff3 filter added to irc inputs.

---
 pmsm-control/dff3.vhdl             | 53 ++++++++++++++++++++++++++++++
 pmsm-control/rpi_pmsm_control.vhdl | 30 +++++++++++++++--
 2 files changed, 81 insertions(+), 2 deletions(-)
 create mode 100644 pmsm-control/dff3.vhdl

diff --git a/pmsm-control/dff3.vhdl b/pmsm-control/dff3.vhdl
new file mode 100644
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 13ffb97..177029f 100644
--- 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
-- 
2.39.2