mirror of
https://github.com/RobotechLille/cdf2018-principal
synced 2024-11-16 13:26:03 +01:00
79 lines
2.6 KiB
VHDL
79 lines
2.6 KiB
VHDL
-- Process signals from HEDM-550X encoder
|
|
-- and output the value read
|
|
|
|
-- TODO Quelques modifications apportées depuis test avec les vraies codeuses
|
|
-- un nouveau test sera nécessaire (vérifier notamment le sens de parcours)
|
|
|
|
library IEEE;
|
|
use IEEE.STD_LOGIC_1164.ALL;
|
|
use ieee.numeric_std.all;
|
|
|
|
entity hedm is
|
|
Port (
|
|
clk : in STD_LOGIC; -- Horloge, la fréquence n'importe pas
|
|
chA : in STD_LOGIC; -- Canal A
|
|
chB : in STD_LOGIC; -- Canal B
|
|
reset : in STD_LOGIC; -- Hard reset
|
|
zero : in STD_LOGIC; -- Force la valeur à zéro sans réinitialiser le fonctionnement
|
|
counts : out integer
|
|
);
|
|
end hedm;
|
|
|
|
architecture Behavioral of hedm is
|
|
signal Ap, Bp : STD_LOGIC := '0'; -- Précédentes valeurs de A et B pour détecter les front montant
|
|
begin
|
|
processInput : process(clk, reset)
|
|
variable counter : integer := 0;
|
|
begin
|
|
if reset = '1' then
|
|
counter := 0;
|
|
counts <= 0;
|
|
Ap <= '0';
|
|
Bp <= '0';
|
|
elsif rising_edge(clk) then
|
|
|
|
if zero = '1' then
|
|
counter := 0;
|
|
end if;
|
|
|
|
-- On pourrait optimiser la logique avec un tableau de Karnaugh ou autres méthodes
|
|
-- de simplification d'algèbre de Boole, mais le synthétiseur pour FPGA fera un
|
|
-- tout aussi bon travail, on garde donc le code suivant pour la lisibilité
|
|
|
|
if (Ap = '0' and chA = '1') then -- Front montant A
|
|
if (chB = '0') then
|
|
counter := counter + 1;
|
|
else
|
|
counter := counter - 1;
|
|
end if;
|
|
elsif (Ap = '1' and chA = '0') then -- Front descendant A
|
|
if (chB = '1') then
|
|
counter := counter + 1;
|
|
else
|
|
counter := counter - 1;
|
|
end if;
|
|
elsif (Bp = '0' and chB = '1') then -- Front montant B
|
|
if (chA = '1') then
|
|
counter := counter + 1;
|
|
else
|
|
counter := counter - 1;
|
|
end if;
|
|
elsif (Bp = '1' and chB = '0') then -- Front descendant B
|
|
if (chA = '0') then
|
|
counter := counter + 1;
|
|
else
|
|
counter := counter - 1;
|
|
end if;
|
|
end if;
|
|
|
|
Ap <= chA;
|
|
Bp <= chB;
|
|
|
|
counts <= counter;
|
|
|
|
end if;
|
|
end process;
|
|
|
|
end Behavioral;
|
|
|