diff --git a/app/gl_get_corners.c b/app/gl_get_corners.c index c7b3e56..aa29cc0 100644 --- a/app/gl_get_corners.c +++ b/app/gl_get_corners.c @@ -14,9 +14,10 @@ void get_corners() int im1 = clip(i - (int)round(ANGLEDIST / RESAMPLEDIST), 0, pts_resample_left_count - 1); int ip1 = clip(i + (int)round(ANGLEDIST / RESAMPLEDIST), 0, pts_resample_left_count - 1); float conf = fabs(angle_left[i]) - (fabs(angle_left[im1]) + fabs(angle_left[ip1])) / 2; - // ips114_show_float(120, 80, conf, 3, 4); - // L 角点阈值 - if (Lpt0_found == false && (66. / 180. * PI32) < conf && conf < (140. / 180. * PI32) && i < 0.5 / RESAMPLEDIST) { + // 114_show_float(120, 80, conf, 3, 4); + // L 角点阈值 + if (Lpt0_found == false && (66. / 180. * PI32) < conf && conf < (140. / 180. * PI32) && i < 0.5 / RESAMPLEDIST) + { Lpt0_rpts0s_id = i; Lpt0_found = true; // transform(pts_resample_left[Lpt0_rpts0s_id][1],pts_resample_left[Lpt0_rpts0s_id][0],&Lpt0[1],&Lpt0[0]); //待优化,是否用到,无用则删 @@ -46,10 +47,8 @@ void get_corners() // } //if (is_turn0) //{ - //state_type = TURN_LEFT_STATE; + // state_type = TURN_LEFT_STATE; //} - - Lpt0_found_barrier = Lpt1_found_barrier = false; Lpt0_found_barrier_in = Lpt1_found_barrier_in = false;