This commit is contained in:
bmy
2024-03-23 09:17:04 +08:00
5 changed files with 33 additions and 5 deletions

View File

@@ -43,8 +43,15 @@ void get_corners() {
Lpt0_rpts0s_id_barrier = i;
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;
// }
// }
@@ -82,6 +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;
// }
// }
}