preformatovani

[fpga/rpi-motor-control.git] / pmsm-control / qcounter.vhdl

diff --git a/pmsm-control/qcounter.vhdl b/pmsm-control/qcounter.vhdl
index e778264a464293e75c06856c9b0ef668ffd0e62d..c8e8d7761bd1b0dc9dd258c574915dce3ba96a56 100644 (file)
--- a/pmsm-control/qcounter.vhdl
+++ b/pmsm-control/qcounter.vhdl
@@ -6,89 +6,90 @@ use ieee.numeric_std.all;
 use work.dff.all;
 
 entity qcounter is
-  port (
-    clock: in std_logic;
-    reset: in std_logic;
-    a0, b0: in std_logic;
-    qcount: out std_logic_vector (31 downto 0);
-    a_rise, a_fall, b_rise, b_fall, ab_event: out std_logic;
-    ab_error: out std_logic
-  );
+port (
+       clock: in std_logic;
+       reset: in std_logic;
+       a0, b0: in std_logic;
+       qcount: out std_logic_vector (31 downto 0);
+       a_rise, a_fall, b_rise, b_fall, ab_event: out std_logic;
+       ab_error: out std_logic
+);
 end qcounter;
 
 architecture behavioral of qcounter is
-  component dff
-    port (
-      clock: in std_logic;
-      d: in std_logic;
-      q: out std_logic
-    );
-  end component;
+       component dff
+       port (
+               clock: in std_logic;
+               d: in std_logic;
+               q: out std_logic
+       );
+       end component;
 
-subtype std_logic4 is std_logic_vector (3 downto 0);
-  signal a, b, a_prev, b_prev: std_logic;
-  signal count_prev: std_logic_vector (29 downto 0)
-    := "000000000000000000000000000000";
-  signal count: std_logic_vector (29 downto 0);
+       subtype std_logic4 is std_logic_vector (3 downto 0);
+       signal a, b, a_prev, b_prev: std_logic;
+       signal count_prev: std_logic_vector (29 downto 0)
+               := "000000000000000000000000000000";
+       signal count: std_logic_vector (29 downto 0);
 begin
-  dff_a: dff
-    port map (
-      clock => clock,
-      d => a0,
-      q => a
-    );
-  dff_b: dff
-    port map (
-      clock => clock,
-      d => b0,
-      q => b
-    );
+       dff_a: dff
+       port map (
+               clock => clock,
+               d => a0,
+               q => a
+       );
+       
+       dff_b: dff
+       port map (
+               clock => clock,
+               d => b0,
+               q => b
+       );
   
-  qcount(0) <= a xor b;
-  qcount(1) <= b;
-  qcount(31 downto 2) <= count;
+       qcount(0) <= a xor b;
+       qcount(1) <= b;
+       qcount(31 downto 2) <= count;
   
-  comb_event: process (a_prev, b_prev, a, b)
-  begin
-    a_rise <= '0';
-    a_fall <= '0';
-    b_rise <= '0';
-    b_fall <= '0';
-    ab_event <= '0';
-    ab_error <= '0';
-    if ((a xor a_prev) and (b xor b_prev)) = '1' then
-      -- forbidden double transition
-      ab_error <= '1';
-    else
-      a_rise <= (a xor a_prev) and a;
-      a_fall <= (a xor a_prev) and not a;
-      b_rise <= (b xor b_prev) and b;
-      b_fall <= (b xor b_prev) and not b;
-      ab_event <= (a xor a_prev) or (b xor b_prev);
-    end if;
-  end process;
+       comb_event: process (a_prev, b_prev, a, b)
+       begin
+               a_rise <= '0';
+               a_fall <= '0';
+               b_rise <= '0';
+               b_fall <= '0';
+               ab_event <= '0';
+               ab_error <= '0';
+               if ((a xor a_prev) and (b xor b_prev)) = '1' then
+                       -- forbidden double transition
+                       ab_error <= '1';
+               else
+                       a_rise <= (a xor a_prev) and a;
+                       a_fall <= (a xor a_prev) and not a;
+                       b_rise <= (b xor b_prev) and b;
+                       b_fall <= (b xor b_prev) and not b;
+                       ab_event <= (a xor a_prev) or (b xor b_prev);
+               end if;
+       end process;
 
-  comb_count: process (a_prev, b_prev, a, b, count)
-  begin
-    if (a_prev = '0') and (b_prev = '1') and (a = '0') and (b = '0') then
-      count <= count_prev + 1;
-    elsif (a_prev = '0') and (b_prev = '0') and (a = '0') and (b = '1') then
-      count <= count_prev - 1;
-    else
-      count <= count_prev;
-    end if;
-  end process;
-
-  seq: process
-  begin
-    wait until clock'event and clock = '1';
-    if reset = '1' then
-      count_prev <= "000000000000000000000000000000";
-    else
-      count_prev <= count;
-    end if;
-    a_prev <= a;
-    b_prev <= b;
-  end process;
+       comb_count: process (a_prev, b_prev, a, b, count)
+       begin
+               if (a_prev = '0') and (b_prev = '1') and (a = '0') and (b = '0') then
+                       count <= count_prev + 1;
+               elsif (a_prev = '0') and (b_prev = '0') and (a = '0') and (b = '1') then
+                       count <= count_prev - 1;
+               else
+                       count <= count_prev;
+               end if;
+       end process;
 
+       seq: process
+       begin
+               wait until clock'event and clock = '1';
+               if reset = '1' then
+                       count_prev <= "000000000000000000000000000000";
+               else
+                       count_prev <= count;
+               end if;
+               a_prev <= a;
+               b_prev <= b;
+       end process;
+       
 end behavioral;