library IEEE;
use IEEE.STD_LOGIC_1164.ALL;
Use IEEE.std_logic_arith.all;
USE IEEE.NUMERIC_STD.ALL;

entity encoder_module is
    generic ( ROZDZIELCZOSC_ENCODERA : integer := 20;
                  ILOSC_TAKTOW_ZEGARA_NA_SEK : integer := 10000
             );
    Port ( clk10kHz : in  STD_LOGIC;
           A                 : in  STD_LOGIC;
           B                 : in  STD_LOGIC;
              obrot_w_prawo : out STD_LOGIC := '0'; --obrót zgodnie z ruchem wskazówek zegara
              obrot_w_lewo  : out STD_LOGIC := '0'; --obrót przeciwnie do ruchu wskazówek zegara
           obroty_na_sek : out  STD_LOGIC_VECTOR(7 downto 0) := "00000000"
             );
end encoder_module;

architecture Behavioral of encoder_module is

    signal AB                 : std_logic_vector(1 downto 0) := "00";
    signal AB_poprzednie   : std_logic_vector(1 downto 0) := "00";
    signal takty : integer := 0;
    signal stopien_obrotu  : integer :=0 ;

begin

    process(clk10kHz)
    begin

        if (clk10kHz'event and clk10kHz='1') then
            takty <= takty + 1;

            if takty >= ILOSC_TAKTOW_ZEGARA_NA_SEK  then
                obroty_na_sek <= conv_std_logic_vector(abs(stopien_obrotu*(2/(ROZDZIELCZOSC_ENCODERA*4))/2),8);
                                                                        -- obroty_na_sek =(stopien_obrotu / ROZDZIELCZOSC_ENCODERA *4)
                takty <= 0;
                stopien_obrotu <= 0;
            end if;

          AB_poprzednie <= AB;
          AB(0) <= A;
          AB(1) <= B;
          if (AB(0) = '1' and AB_poprzednie(0) = '0') then -- A zbocze rosnące
              if (B='0') then -- obrót w prawo
                 obrot_w_prawo <= '1';
                 obrot_w_lewo <= '0';
                      stopien_obrotu <= stopien_obrotu + 1;
              elsif (B='1') then -- obrót w lewo
                 obrot_w_prawo <= '0';
                 obrot_w_lewo <= '1';
                      stopien_obrotu <= stopien_obrotu - 1;
              end if;
          elsif (AB(1) = '1' and AB_poprzednie(1) = '0') then -- B zbocze rosnące
              if (A='1') then -- obrót w prawo
                 obrot_w_prawo <= '1';
                 obrot_w_lewo <= '0';
                      stopien_obrotu <= stopien_obrotu + 1;
              elsif (A='0') then -- obrót w lewo
                 obrot_w_prawo <= '0';
                 obrot_w_lewo <= '1';
                      stopien_obrotu <= stopien_obrotu - 1;
              end if;
          elsif (AB(0) = '0' and AB_poprzednie(0) = '1') then -- A zbocze opadające
              if (B='1') then -- obrót w prawo
                 obrot_w_prawo <= '1';
                 obrot_w_lewo <= '0';
                      stopien_obrotu <= stopien_obrotu + 1;
              elsif (B='0') then -- obrót w lewo
                 obrot_w_prawo <= '0';
                 obrot_w_lewo <= '1';
                      stopien_obrotu <= stopien_obrotu - 1;
              end if;
          elsif (AB(1) = '0' and AB_poprzednie(1) = '1') then -- B zbocze opadające
              if (A='0') then -- obrót w prawo
                 obrot_w_prawo <= '1';
                 obrot_w_lewo <= '0';
                      stopien_obrotu <= stopien_obrotu + 1;
              elsif (A='1') then -- obrót w lewo
                 obrot_w_prawo <= '0';
                 obrot_w_lewo <= '1';
                      stopien_obrotu <= stopien_obrotu - 1;
              end if;
          else
              obrot_w_prawo <= '0';
              obrot_w_lewo <= '0';
          end if;

        end if;

    end process;

end Behavioral;