近点以及状态更新

This commit is contained in:
Glz
2024-05-24 20:42:56 +08:00
parent 2ac6683128
commit d4afb39f8f
8 changed files with 324 additions and 219 deletions

View File

@@ -6,8 +6,8 @@ void get_corners()
{
Lpt0_found = Lpt1_found = false;
Lpt_in0_found = Lpt_in1_found = false;
is_straight0 = pts_resample_left_count > 1.0 / RESAMPLEDIST;
is_straight1 = pts_resample_right_count > 1.0 / RESAMPLEDIST;
is_straight0 = pts_resample_left_count > 0.8 / RESAMPLEDIST;
is_straight1 = pts_resample_right_count > 0.8 / RESAMPLEDIST;
// is_turn0_l = is_turn1_l = is_turn0_r = is_turn1_r = 0;
for (int i = 0; i < pts_resample_left_count; i++) {
if (angle_new_left[i] == 0) continue;