Run/Distance.vhd at main · skwcrd/Run · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
Library IEEE;
use IEEE.STD_LOGIC_1164.ALL;
use IEEE.STD_LOGIC_UNSIGNED.ALL;
use IEEE.STD_LOGIC_ARITH.ALL;

Entity Distance is
Port(
	CLK,Rstb : in std_logic;
	i1s : in std_logic;
	iPush,stop : in std_logic;
	iDigitD01,iDigitD10 : out std_logic_vector(3 downto 0);
	oLED : out std_logic_vector(7 downto 0)
);
End Distance;

Architecture Behavioral of Distance is
	constant speed : integer := 13889; ----- Speed 1.3889 m/s -----
	signal rCnt : integer := 0;
	signal wDigitD01,wDigitD10 : std_logic_vector(3 downto 0);
	signal wDist : std_logic_vector(7 downto 0);
	signal wPush : std_logic := '0';
Begin

	oLED <= wDist;

	u_Push : Process(CLK,Rstb)
	Begin
		if(Rstb='0') then
			wPush <= '0';
		elsif(rising_edge(CLK)) then
			if(stop='1') then
				wPush <= '0';
			elsif(iPush='1') then
				wPush <= not wPush;
			else
				wPush <= wPush;
			end if;
		end if;
	end Process;

	u_Dist : Process(CLK,Rstb,wPush)
	Begin
		if(Rstb='0') then
			wDist <= (others => '0');
			rCnt <= 0;
		elsif(rising_edge(CLK) and wPush='1') then

			---------- Count Distances ----------
			if(i1s='1' and rCnt>=500000) then
				rCnt <= rCnt + speed - 500000;
			elsif(i1s='1') then
				rCnt <= rCnt + speed;
			else
				rCnt <= rCnt;
			end if;

			---------- Assign LED 50 m/LED ----------
			if(i1s='1' and rCnt>=500000 and wDist="11111111") then
				wDist <= (0 => '1',others => '0');
			elsif(i1s='1' and rCnt>=500000) then
				wDist <= wDist(6 downto 0) & '1';
			else
				wDist <= wDist;
			end if;
		else
			wDist <= wDist;
			rCnt <= rCnt;
		end if;
	end Process;

	iDigitD01 <= wDigitD01;
	iDigitD10 <= wDigitD10;

	u_CountDist : Process(CLK,Rstb,wPush)
	Begin
		if(Rstb='0') then
			wDigitD01 <= (others => '0');
			wDigitD10 <= (others => '0');
		elsif(rising_edge(CLK) and wPush='1') then
			if(i1s='1' and rCnt>=500000 and wDist="11111111" and wDigitD01>=9 and wDigitD10>=9) then
				wDigitD01 <= (others => '0');
			elsif(i1s='1' and rCnt>=500000 and wDist="11111111" and wDigitD10>=9) then
				wDigitD01 <= wDigitD01 + 1;
			else
				wDigitD01 <= wDigitD01;
			end if;

			if(i1s='1' and rCnt>=500000 and wDist="11111111" and wDigitD10>=9) then
				wDigitD10 <= (others => '0');
			elsif(i1s='1' and rCnt>=500000 and wDist="11111111") then
				wDigitD10 <= wDigitD10 + 1;
			else
				wDigitD10 <= wDigitD10;
			end if;
		else
			wDigitD01 <= wDigitD01;
			wDigitD10 <= wDigitD10;
		end if;
	end Process;

End Behavioral;