1
0
forked from tanchou/Verilog

New TB for ultrasonic but not working fine

This commit is contained in:
Gamenight77
2025-04-25 10:51:44 +02:00
parent c6d33d278e
commit 8c00b9d747
5 changed files with 67599 additions and 23 deletions

View File

@@ -3,19 +3,17 @@
module tb_ultrasonic_fpga;
reg clk = 0;
reg rst = 1;
reg start = 0;
wire sig;
wire [8:0] distance;
time t_start, t_end;
wire [15:0] distance;
// Clock 27MHz => periode = 37ns
always #18 clk = ~clk;
parameter CLK_FREQ = 27_000_000; // 27 MHz
ultrasonic_fpga uut (
.clk(clk),
.rst(rst),
.start(start),
.sig(sig),
.distance(distance)
@@ -30,10 +28,6 @@ module tb_ultrasonic_fpga;
$dumpfile("ultrasonic.vcd");
$dumpvars(0, tb_ultrasonic_fpga);
// Reset
#100;
rst = 0;
// Start
#100;
start = 1;
@@ -41,8 +35,8 @@ module tb_ultrasonic_fpga;
start = 0;
// Attendre que la distance soit mesurée
wait (distance > 0);
#10; // petite marge pour stabiliser
// wait (distance > 0);
#600000; // petite marge pour stabiliser
$display("Distance mesurée: %d cm", distance);

View File

@@ -0,0 +1,471 @@
#!
:ivl_version "13.0 (devel)" "(s20250103-31-g7e238e7ca-dirty)";
:ivl_delay_selection "TYPICAL";
:vpi_time_precision - 12;
:vpi_module "C:\Users\louis\Desktop\Stage\OSS-CA~1\lib\ivl\system.vpi";
:vpi_module "C:\Users\louis\Desktop\Stage\OSS-CA~1\lib\ivl\vhdl_sys.vpi";
:vpi_module "C:\Users\louis\Desktop\Stage\OSS-CA~1\lib\ivl\vhdl_textio.vpi";
:vpi_module "C:\Users\louis\Desktop\Stage\OSS-CA~1\lib\ivl\v2005_math.vpi";
:vpi_module "C:\Users\louis\Desktop\Stage\OSS-CA~1\lib\ivl\va_math.vpi";
S_000001b750674ff0 .scope module, "tb_ultrasonic_fpga" "tb_ultrasonic_fpga" 2 3;
.timescale -9 -12;
P_000001b75066f080 .param/l "CLK_FREQ" 0 2 13, +C4<00000001100110111111110011000000>;
v000001b7506ef330_0 .var "clk", 0 0;
v000001b7506ef970_0 .net "distance", 15 0, v000001b7506ef5b0_0; 1 drivers
RS_000001b75069f0b8 .resolv tri, L_000001b7506efc90, L_000001b7506f1530;
v000001b7506ef470_0 .net8 "sig", 0 0, RS_000001b75069f0b8; 2 drivers
v000001b7506ef650_0 .var "start", 0 0;
S_000001b750675390 .scope module, "sensor" "ultrasonic_sensor" 2 22, 3 1 0, S_000001b750674ff0;
.timescale -9 -12;
.port_info 0 /INPUT 1 "clk";
.port_info 1 /INOUT 1 "signal";
P_000001b750672df0 .param/l "CLK_FREQ" 0 3 5, +C4<00000001100110111111110011000000>;
P_000001b750672e28 .param/l "S_MEASURE_TRIG" 1 3 20, C4<001>;
P_000001b750672e60 .param/l "S_SEND_ECHO" 1 3 21, C4<010>;
P_000001b750672e98 .param/l "S_WAIT_TRIG" 1 3 19, C4<000>;
P_000001b750672ed0 .param/l "TRIG_PULSE_CYCLES" 1 3 23, +C4<00000000000000000000000100001110>;
o000001b75069ef98 .functor BUFZ 1, c4<z>; HiZ drive
; Elide local net with no drivers, v000001b75074a970_0 name=_ivl_0
v000001b75074ae10_0 .net "clk", 0 0, v000001b7506ef330_0; 1 drivers
v000001b75074af30_0 .var "echo_delay_counter", 15 0;
v000001b75068feb0_0 .var "echo_sended", 0 0;
v000001b750675520_0 .var "next_state", 2 0;
v000001b7506755c0_0 .var "sig_dir", 0 0;
v000001b7506effb0_0 .net8 "signal", 0 0, RS_000001b75069f0b8; alias, 2 drivers
v000001b7506ef830_0 .var "signal_out", 0 0;
v000001b7506ef510_0 .var "state", 2 0;
v000001b7506ef0b0_0 .var "trig_counter", 15 0;
v000001b7506efdd0_0 .var "valid_trig", 0 0;
E_000001b750670380 .event posedge, v000001b75074ae10_0;
E_000001b75066fac0 .event anyedge, v000001b7506ef510_0, v000001b7506effb0_0, v000001b7506efdd0_0, v000001b75068feb0_0;
L_000001b7506f1530 .functor MUXZ 1, o000001b75069ef98, v000001b7506ef830_0, v000001b7506755c0_0, C4<>;
S_000001b75074d480 .scope module, "uut" "ultrasonic_fpga" 2 15, 4 1 0, S_000001b750674ff0;
.timescale -9 -12;
.port_info 0 /INPUT 1 "clk";
.port_info 1 /INPUT 1 "start";
.port_info 2 /INOUT 1 "sig";
.port_info 3 /OUTPUT 16 "distance";
.port_info 4 /OUTPUT 3 "state";
P_000001b75074d610 .param/l "CLK_FREQ" 0 4 2, +C4<00000001100110111111110011000000>;
P_000001b75074d648 .param/l "DIST_DIVISOR" 1 4 31, +C4<00000000000000000000011000011110>;
P_000001b75074d680 .param/l "DONE" 1 4 27, C4<101>;
P_000001b75074d6b8 .param/l "IDLE" 1 4 22, C4<000>;
P_000001b75074d6f0 .param/l "MAX_CM" 1 4 32, +C4<00000000000000000000000101011110>;
P_000001b75074d728 .param/l "MEASURE_ECHO" 1 4 26, C4<100>;
P_000001b75074d760 .param/l "TIMEOUT_CYCLES" 1 4 33, +C4<11111111111111111111100110001001>;
P_000001b75074d798 .param/l "TRIG_HIGH" 1 4 23, C4<001>;
P_000001b75074d7d0 .param/l "TRIG_LOW" 1 4 24, C4<010>;
P_000001b75074d808 .param/l "TRIG_PULSE_CYCLES" 1 4 30, +C4<00000000000000000000000100001110>;
P_000001b75074d840 .param/l "WAIT_ECHO" 1 4 25, C4<011>;
P_000001b75074d878 .param/l "WAIT_NEXT" 1 4 28, C4<110>;
P_000001b75074d8b0 .param/l "WAIT_NEXT_CYCLES" 1 4 35, +C4<0000000000000000000000000000000000000000001010010011001011100000>;
o000001b75069f208 .functor BUFZ 1, c4<z>; HiZ drive
; Elide local net with no drivers, v000001b7506ef150_0 name=_ivl_0
v000001b7506efa10_0 .net "clk", 0 0, v000001b7506ef330_0; alias, 1 drivers
v000001b7506ef5b0_0 .var "distance", 15 0;
v000001b7506ef6f0_0 .var "distance_counter", 15 0;
v000001b7506eff10_0 .var "echo_counter", 31 0;
v000001b7506efbf0_0 .var "echo_div_counter", 31 0;
v000001b7506ef790_0 .net8 "sig", 0 0, RS_000001b75069f0b8; alias, 2 drivers
v000001b7506ef1f0_0 .var "sig_dir", 0 0;
v000001b7506ef3d0_0 .var "sig_int", 0 0;
v000001b7506efd30_0 .var "sig_ok", 0 0;
v000001b7506ef8d0_0 .var "sig_out", 0 0;
v000001b7506efab0_0 .net "start", 0 0, v000001b7506ef650_0; 1 drivers
v000001b7506ef290_0 .var "state", 2 0;
v000001b7506efe70_0 .var "trig_counter", 15 0;
v000001b7506efb50_0 .var "wait_counter", 31 0;
L_000001b7506efc90 .functor MUXZ 1, o000001b75069f208, v000001b7506ef8d0_0, v000001b7506ef1f0_0, C4<>;
.scope S_000001b75074d480;
T_0 ;
%wait E_000001b750670380;
%load/vec4 v000001b7506ef790_0;
%assign/vec4 v000001b7506ef3d0_0, 0;
%load/vec4 v000001b7506ef3d0_0;
%assign/vec4 v000001b7506efd30_0, 0;
%jmp T_0;
.thread T_0;
.scope S_000001b75074d480;
T_1 ;
%wait E_000001b750670380;
%load/vec4 v000001b7506ef290_0;
%dup/vec4;
%pushi/vec4 0, 0, 3;
%cmp/u;
%jmp/1 T_1.0, 6;
%dup/vec4;
%pushi/vec4 1, 0, 3;
%cmp/u;
%jmp/1 T_1.1, 6;
%dup/vec4;
%pushi/vec4 2, 0, 3;
%cmp/u;
%jmp/1 T_1.2, 6;
%dup/vec4;
%pushi/vec4 3, 0, 3;
%cmp/u;
%jmp/1 T_1.3, 6;
%dup/vec4;
%pushi/vec4 4, 0, 3;
%cmp/u;
%jmp/1 T_1.4, 6;
%dup/vec4;
%pushi/vec4 5, 0, 3;
%cmp/u;
%jmp/1 T_1.5, 6;
%dup/vec4;
%pushi/vec4 6, 0, 3;
%cmp/u;
%jmp/1 T_1.6, 6;
%pushi/vec4 0, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
%jmp T_1.8;
T_1.0 ;
%pushi/vec4 0, 0, 1;
%assign/vec4 v000001b7506ef8d0_0, 0;
%pushi/vec4 1, 0, 1;
%assign/vec4 v000001b7506ef1f0_0, 0;
%pushi/vec4 0, 0, 16;
%assign/vec4 v000001b7506ef5b0_0, 0;
%load/vec4 v000001b7506efab0_0;
%flag_set/vec4 8;
%jmp/0xz T_1.9, 8;
%pushi/vec4 1, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
%pushi/vec4 0, 0, 16;
%assign/vec4 v000001b7506efe70_0, 0;
T_1.9 ;
%jmp T_1.8;
T_1.1 ;
%pushi/vec4 1, 0, 1;
%assign/vec4 v000001b7506ef8d0_0, 0;
%pushi/vec4 1, 0, 1;
%assign/vec4 v000001b7506ef1f0_0, 0;
%load/vec4 v000001b7506efe70_0;
%pad/u 32;
%cmpi/u 270, 0, 32;
%jmp/0xz T_1.11, 5;
%load/vec4 v000001b7506efe70_0;
%addi 1, 0, 16;
%assign/vec4 v000001b7506efe70_0, 0;
%jmp T_1.12;
T_1.11 ;
%pushi/vec4 0, 0, 16;
%assign/vec4 v000001b7506efe70_0, 0;
%pushi/vec4 2, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
T_1.12 ;
%jmp T_1.8;
T_1.2 ;
%pushi/vec4 0, 0, 1;
%assign/vec4 v000001b7506ef8d0_0, 0;
%pushi/vec4 0, 0, 1;
%assign/vec4 v000001b7506ef1f0_0, 0;
%pushi/vec4 3, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
%jmp T_1.8;
T_1.3 ;
%load/vec4 v000001b7506efd30_0;
%flag_set/vec4 8;
%jmp/0xz T_1.13, 8;
%pushi/vec4 0, 0, 32;
%assign/vec4 v000001b7506eff10_0, 0;
%pushi/vec4 4, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
%jmp T_1.14;
T_1.13 ;
%load/vec4 v000001b7506eff10_0;
%cmpi/u 4294965641, 0, 32;
%flag_inv 5; GE is !LT
%jmp/0xz T_1.15, 5;
%pushi/vec4 0, 0, 16;
%assign/vec4 v000001b7506ef5b0_0, 0;
%pushi/vec4 5, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
%jmp T_1.16;
T_1.15 ;
%load/vec4 v000001b7506eff10_0;
%addi 1, 0, 32;
%assign/vec4 v000001b7506eff10_0, 0;
T_1.16 ;
T_1.14 ;
%jmp T_1.8;
T_1.4 ;
%load/vec4 v000001b7506efd30_0;
%flag_set/vec4 8;
%jmp/0xz T_1.17, 8;
%load/vec4 v000001b7506eff10_0;
%cmpi/u 4294965641, 0, 32;
%jmp/0xz T_1.19, 5;
%load/vec4 v000001b7506eff10_0;
%addi 1, 0, 32;
%assign/vec4 v000001b7506eff10_0, 0;
%jmp T_1.20;
T_1.19 ;
%pushi/vec4 0, 0, 16;
%assign/vec4 v000001b7506ef5b0_0, 0;
%pushi/vec4 5, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
T_1.20 ;
%jmp T_1.18;
T_1.17 ;
%load/vec4 v000001b7506eff10_0;
%addi 1, 0, 32;
%assign/vec4 v000001b7506eff10_0, 0;
%load/vec4 v000001b7506efbf0_0;
%cmpi/u 1565, 0, 32;
%flag_inv 5; GE is !LT
%jmp/0xz T_1.21, 5;
%pushi/vec4 0, 0, 32;
%assign/vec4 v000001b7506efbf0_0, 0;
%load/vec4 v000001b7506ef6f0_0;
%addi 1, 0, 16;
%assign/vec4 v000001b7506ef6f0_0, 0;
%jmp T_1.22;
T_1.21 ;
%load/vec4 v000001b7506efbf0_0;
%addi 1, 0, 32;
%assign/vec4 v000001b7506efbf0_0, 0;
T_1.22 ;
%load/vec4 v000001b7506ef6f0_0;
%assign/vec4 v000001b7506ef5b0_0, 0;
%pushi/vec4 5, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
T_1.18 ;
%jmp T_1.8;
T_1.5 ;
%load/vec4 v000001b7506efab0_0;
%flag_set/vec4 8;
%jmp/0xz T_1.23, 8;
%pushi/vec4 0, 0, 32;
%assign/vec4 v000001b7506efb50_0, 0;
%pushi/vec4 6, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
%jmp T_1.24;
T_1.23 ;
%pushi/vec4 0, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
T_1.24 ;
%jmp T_1.8;
T_1.6 ;
%load/vec4 v000001b7506efb50_0;
%addi 1, 0, 32;
%assign/vec4 v000001b7506efb50_0, 0;
%load/vec4 v000001b7506efb50_0;
%pad/u 64;
%cmpi/u 2700000, 0, 64;
%flag_inv 5; GE is !LT
%jmp/0xz T_1.25, 5;
%pushi/vec4 1, 0, 3;
%assign/vec4 v000001b7506ef290_0, 0;
T_1.25 ;
%jmp T_1.8;
T_1.8 ;
%pop/vec4 1;
%jmp T_1;
.thread T_1;
.scope S_000001b750675390;
T_2 ;
%pushi/vec4 0, 0, 3;
%store/vec4 v000001b7506ef510_0, 0, 3;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506efdd0_0, 0, 1;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b75068feb0_0, 0, 1;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506ef830_0, 0, 1;
%end;
.thread T_2;
.scope S_000001b750675390;
T_3 ;
%wait E_000001b75066fac0;
%load/vec4 v000001b7506ef510_0;
%dup/vec4;
%pushi/vec4 0, 0, 3;
%cmp/u;
%jmp/1 T_3.0, 6;
%dup/vec4;
%pushi/vec4 1, 0, 3;
%cmp/u;
%jmp/1 T_3.1, 6;
%dup/vec4;
%pushi/vec4 2, 0, 3;
%cmp/u;
%jmp/1 T_3.2, 6;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506755c0_0, 0, 1;
%pushi/vec4 0, 0, 3;
%store/vec4 v000001b750675520_0, 0, 3;
%jmp T_3.4;
T_3.0 ;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506755c0_0, 0, 1;
%load/vec4 v000001b7506effb0_0;
%pad/u 32;
%cmpi/e 1, 0, 32;
%jmp/0xz T_3.5, 4;
%pushi/vec4 1, 0, 3;
%store/vec4 v000001b750675520_0, 0, 3;
%jmp T_3.6;
T_3.5 ;
%pushi/vec4 0, 0, 3;
%store/vec4 v000001b750675520_0, 0, 3;
T_3.6 ;
%jmp T_3.4;
T_3.1 ;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506755c0_0, 0, 1;
%load/vec4 v000001b7506efdd0_0;
%flag_set/vec4 8;
%jmp/0xz T_3.7, 8;
%pushi/vec4 2, 0, 3;
%store/vec4 v000001b750675520_0, 0, 3;
T_3.7 ;
%jmp T_3.4;
T_3.2 ;
%pushi/vec4 1, 0, 1;
%store/vec4 v000001b7506755c0_0, 0, 1;
%load/vec4 v000001b75068feb0_0;
%flag_set/vec4 8;
%jmp/0xz T_3.9, 8;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b75068feb0_0, 0, 1;
%pushi/vec4 0, 0, 3;
%store/vec4 v000001b750675520_0, 0, 3;
%jmp T_3.10;
T_3.9 ;
%pushi/vec4 2, 0, 3;
%store/vec4 v000001b750675520_0, 0, 3;
T_3.10 ;
%jmp T_3.4;
T_3.4 ;
%pop/vec4 1;
%jmp T_3;
.thread T_3, $push;
.scope S_000001b750675390;
T_4 ;
%wait E_000001b750670380;
%load/vec4 v000001b750675520_0;
%assign/vec4 v000001b7506ef510_0, 0;
%jmp T_4;
.thread T_4;
.scope S_000001b750675390;
T_5 ;
%wait E_000001b750670380;
%load/vec4 v000001b7506ef510_0;
%cmpi/e 1, 0, 3;
%jmp/0xz T_5.0, 4;
%load/vec4 v000001b7506effb0_0;
%pad/u 32;
%cmpi/e 1, 0, 32;
%jmp/0xz T_5.2, 4;
%load/vec4 v000001b7506ef0b0_0;
%addi 1, 0, 16;
%assign/vec4 v000001b7506ef0b0_0, 0;
%jmp T_5.3;
T_5.2 ;
%load/vec4 v000001b7506ef0b0_0;
%pad/u 32;
%cmpi/u 4294947566, 0, 32;
%flag_inv 5; GE is !LT
%flag_get/vec4 5;
%jmp/0 T_5.6, 5;
%load/vec4 v000001b7506ef0b0_0;
%pad/u 32;
%cmpi/u 20270, 0, 32;
%flag_get/vec4 4;
%flag_get/vec4 5;
%or;
%and;
T_5.6;
%flag_set/vec4 8;
%jmp/0xz T_5.4, 8;
%pushi/vec4 1, 0, 1;
%assign/vec4 v000001b7506efdd0_0, 0;
%jmp T_5.5;
T_5.4 ;
%pushi/vec4 0, 0, 1;
%assign/vec4 v000001b7506efdd0_0, 0;
T_5.5 ;
T_5.3 ;
T_5.0 ;
%jmp T_5;
.thread T_5;
.scope S_000001b750675390;
T_6 ;
%wait E_000001b750670380;
%load/vec4 v000001b7506ef510_0;
%cmpi/e 2, 0, 3;
%jmp/0xz T_6.0, 4;
%load/vec4 v000001b75074af30_0;
%pad/u 32;
%cmpi/e 5800, 0, 32;
%jmp/0xz T_6.2, 4;
%pushi/vec4 0, 0, 1;
%assign/vec4 v000001b7506ef830_0, 0;
%pushi/vec4 1, 0, 1;
%assign/vec4 v000001b75068feb0_0, 0;
%jmp T_6.3;
T_6.2 ;
%pushi/vec4 1, 0, 1;
%assign/vec4 v000001b7506ef830_0, 0;
%load/vec4 v000001b75074af30_0;
%addi 1, 0, 16;
%assign/vec4 v000001b75074af30_0, 0;
T_6.3 ;
%jmp T_6.1;
T_6.0 ;
%pushi/vec4 0, 0, 16;
%assign/vec4 v000001b75074af30_0, 0;
T_6.1 ;
%jmp T_6;
.thread T_6;
.scope S_000001b750674ff0;
T_7 ;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506ef330_0, 0, 1;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506ef650_0, 0, 1;
%end;
.thread T_7;
.scope S_000001b750674ff0;
T_8 ;
%delay 18000, 0;
%load/vec4 v000001b7506ef330_0;
%inv;
%store/vec4 v000001b7506ef330_0, 0, 1;
%jmp T_8;
.thread T_8;
.scope S_000001b750674ff0;
T_9 ;
%vpi_call 2 28 "$dumpfile", "ultrasonic.vcd" {0 0 0};
%vpi_call 2 29 "$dumpvars", 32'sb00000000000000000000000000000000, S_000001b750674ff0 {0 0 0};
%delay 100000, 0;
%pushi/vec4 1, 0, 1;
%store/vec4 v000001b7506ef650_0, 0, 1;
%delay 40000, 0;
%pushi/vec4 0, 0, 1;
%store/vec4 v000001b7506ef650_0, 0, 1;
%delay 600000000, 0;
%vpi_call 2 40 "$display", "Distance mesur\303\251e: %d cm", v000001b7506ef970_0 {0 0 0};
%load/vec4 v000001b7506ef970_0;
%pad/u 32;
%cmpi/u 0, 0, 32;
%flag_or 5, 4; GT is !LE
%flag_inv 5;
%jmp/0xz T_9.0, 5;
%vpi_call 2 45 "$display", "Distance measured: %d cm", v000001b7506ef970_0 {0 0 0};
%jmp T_9.1;
T_9.0 ;
%vpi_call 2 47 "$display", "No distance measured." {0 0 0};
T_9.1 ;
%vpi_call 2 50 "$finish" {0 0 0};
%end;
.thread T_9;
# The file index is used to find the file name in the following table.
:file_names 5;
"N/A";
"<interactive>";
"tb_ultrasonic_fpga.v";
"ultrasonic_sensor.v";
"ultrasonic_fpga.v";

File diff suppressed because it is too large Load Diff

View File

@@ -5,7 +5,7 @@ module ultrasonic_fpga #(
input wire start,
inout wire sig, // Broche bidirectionnelle vers le capteur
output reg [15:0] distance, // Distance mesurée en cm
output reg [2:0] state = IDLE
output reg [2:0] state
);
reg [15:0] trig_counter;
reg [31:0] echo_counter;
@@ -19,8 +19,6 @@ module ultrasonic_fpga #(
reg sig_int, sig_ok;
always_ff(@posedge clk) {sig_ok, sig_int} = {sig_int, sig};
localparam IDLE = 3'd0,
TRIG_HIGH = 3'd1,
TRIG_LOW = 3'd2,
@@ -38,6 +36,11 @@ module ultrasonic_fpga #(
reg [31:0] wait_counter;
always @(posedge clk) begin
sig_int <= sig;
sig_ok <= sig_int;
end
always @(posedge clk) begin // FSM
case (state)
@@ -120,6 +123,9 @@ module ultrasonic_fpga #(
end
end
default: begin
state <= IDLE; // Reset to IDLE state in case of an error
end
endcase
end

View File

@@ -1,18 +1,19 @@
module ultrasonic_sensor( // Simulation of an ultrasonic sensor
input wire clk,
inout wire signal, // Signal from the ultrasonic sensor
inout wire signal // Signal from the ultrasonic sensor
);
parameter integer CLK_FREQ = 27_000_000;
reg [2:0] state, next_state;
reg [2:0] state = 3'd0; // State of the FSM
reg [2:0] next_state;
reg sig_dir; // 1: output, 0: input
reg [15:0] trig_counter; // Counter for the trigger pulse
reg [31:0] echo_counter; // Echo signal
reg valid_trig; // Valid trigger signal
reg valid_trig = 0; // Valid trigger signal
reg echo_sended; // Flag to indicate if echo has been sent
reg echo_sended = 0; // Flag to indicate if echo has been sent
reg signal_out;
reg signal_out = 0;
assign signal = sig_dir ? signal_out : 1'bz; // Assign the signal to the output if sig_dir is high, otherwise set it to high impedance
localparam S_WAIT_TRIG = 3'd0,
@@ -59,9 +60,6 @@ module ultrasonic_sensor( // Simulation of an ultrasonic sensor
always @(posedge clk) begin
state <= next_state;
if (~sig_dir) begin
signal <= 1'bz;
end
end
always @(posedge clk) begin
@@ -69,7 +67,7 @@ module ultrasonic_sensor( // Simulation of an ultrasonic sensor
if (signal == 1) begin
trig_counter <= trig_counter + 1;
end else begin
if (trig_counter >= TRIG_PULSE_CYCLES-2 && trig_counter <= TRIG_PULSE_CYCLES+2) begin
if (trig_counter >= TRIG_PULSE_CYCLES-20000 && trig_counter <= TRIG_PULSE_CYCLES+20000) begin
valid_trig <= 1;
end else begin
valid_trig <= 0;