btl143/QDAC-firmware
4
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

feat: 增加真正的内角点显示(大雾)

Browse Source
This commit is contained in:
bmy
2024-03-23 09:22:39 +08:00
parent 007d3c1f80
commit 200d67b8bd
2 changed files with 20 additions and 16 deletions
Download Patch File Download Diff File Expand all files Collapse all files

32
app/gl_get_corners.c
View File

@@ -44,14 +44,14 @@ void get_corners() {
Lpt0_found_barrier = true;
}
}
// if(Lpt0_found_barrier){
// float angle1 = calculate_vector_angle(pts_resample_left[Lpt0_rpts0s_id_barrier][1],pts_resample_left[Lpt0_rpts0s_id_barrier][0],pts_resample_left[Lpt0_rpts0s_id_barrier+5][1],pts_resample_left[Lpt0_rpts0s_id_barrier+5][0]);
// if(angle1 < 85.) {
// Lpt0_found_barrier_in = true;
// Lpt0_found_barrier = false;
// Lpt0_found_barrier_in_id = Lpt0_rpts0s_id_barrier;
// }
// }
if(Lpt0_found_barrier){
float angle1 = calculate_vector_angle(pts_resample_left[Lpt0_rpts0s_id_barrier][1],pts_resample_left[Lpt0_rpts0s_id_barrier][0],pts_resample_left[Lpt0_rpts0s_id_barrier+5][1],pts_resample_left[Lpt0_rpts0s_id_barrier+5][0]);
if(angle1 < 85.) {
Lpt0_found_barrier_in = true;
Lpt0_found_barrier = false;
Lpt0_found_barrier_in_id = Lpt0_rpts0s_id_barrier;
}
}
@@ -89,14 +89,14 @@ void get_corners() {
Lpt1_found_barrier = true;
}
}
// if(Lpt1_found_barrier){
// float angle2 = calculate_vector_angle(pts_resample_right[Lpt1_rpts1s_id_barrier][1],pts_resample_right[Lpt1_rpts1s_id_barrier][0],pts_resample_right[Lpt1_rpts1s_id_barrier+5][1],pts_resample_right[Lpt1_rpts1s_id_barrier+5][0]);
// if(angle2 > 100.) {
// Lpt1_found_barrier_in = true;
// Lpt1_found_barrier = false;
// Lpt1_found_barrier_in_id = Lpt1_rpts1s_id_barrier;
// }
// }
if(Lpt1_found_barrier){
float angle2 = calculate_vector_angle(pts_resample_right[Lpt1_rpts1s_id_barrier][1],pts_resample_right[Lpt1_rpts1s_id_barrier][0],pts_resample_right[Lpt1_rpts1s_id_barrier+5][1],pts_resample_right[Lpt1_rpts1s_id_barrier+5][0]);
if(angle2 > 100.) {
Lpt1_found_barrier_in = true;
Lpt1_found_barrier = false;
Lpt1_found_barrier_in_id = Lpt1_rpts1s_id_barrier;
}
}
}

4
app/page/page_rtcam.c
View File

@@ -32,6 +32,8 @@ static void Setup()
ips200_show_string(5, 224, "con_r:");
ips200_show_string(100, 165, "lpt0: ");
ips200_show_string(100, 185, "lpt1: ");
ips200_show_string(100, 205, "lptin0: ");
ips200_show_string(100, 224, "lptin1: ");
}
/**
@@ -57,6 +59,8 @@ static void Loop()
ips200_show_uint(60, 224, Lpt1_found, 3);
ips200_show_uint(160, 165, Lpt0_found_barrier, 3);
ips200_show_uint(160, 185, Lpt1_found_barrier, 3);
ips200_show_uint(160, 205, Lpt0_found_barrier_in, 3);
ips200_show_uint(160, 224, Lpt1_found_barrier_in, 3);
}
/**