feat: 增加内角显示
This commit is contained in:
@@ -14,7 +14,7 @@
|
||||
#define FILTER_KERNELSIZE (7) // 滤波核大小
|
||||
#define SELFADAPT_OFFSET (8) // 适应性块大小
|
||||
#define PIXPERMETER (70.0f)
|
||||
#define PIXPERMETER_ACROSS (80.0f)
|
||||
#define PIXPERMETER_ACROSS (85.0f)
|
||||
#define RESAMPLEDIST (0.02f)
|
||||
#define ANGLEDIST (0.2f)
|
||||
#define ANGLEDIST_barrier (0.06f)
|
||||
|
||||
@@ -15,7 +15,7 @@ void get_corners() {
|
||||
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;
|
||||
|
||||
//L角点阈值
|
||||
//L 角点阈值
|
||||
if (Lpt0_found == false && (66. / 180. * PI32) < conf && conf < (140. / 180. * PI32) && i < 0.5 / RESAMPLEDIST) {
|
||||
Lpt0_rpts0s_id = i;
|
||||
Lpt0_found = true;
|
||||
@@ -38,7 +38,7 @@ void get_corners() {
|
||||
int ip1 = clip(i + (int) round(ANGLEDIST_barrier / RESAMPLEDIST), 0, pts_resample_left_count - 1);
|
||||
float conf = fabs(angle_left_barrier[i]) - (fabs(angle_left_barrier[im1]) + fabs(angle_left_barrier[ip1])) / 2;
|
||||
|
||||
//L角点阈值
|
||||
//L 角点阈值
|
||||
if (Lpt0_found_barrier == false && (66. / 180. * PI32) < conf && conf < (140. / 180. * PI32) && i < 0.5 / RESAMPLEDIST) {
|
||||
Lpt0_rpts0s_id_barrier = i;
|
||||
Lpt0_found_barrier = true;
|
||||
|
||||
@@ -30,8 +30,8 @@ static void Setup()
|
||||
ips200_show_string(5, 185, "pts_r:");
|
||||
ips200_show_string(5, 205, "con_l:");
|
||||
ips200_show_string(5, 224, "con_r:");
|
||||
ips200_show_string(100, 165, "dir_l:");
|
||||
ips200_show_string(100, 185, "dir_r:");
|
||||
ips200_show_string(100, 165, "lpt0: ");
|
||||
ips200_show_string(100, 185, "lpt1: ");
|
||||
}
|
||||
|
||||
/**
|
||||
@@ -55,8 +55,8 @@ static void Loop()
|
||||
ips200_show_uint(60, 185, pts_inv_r_count, 3);
|
||||
ips200_show_uint(60, 205, Lpt0_found, 3);
|
||||
ips200_show_uint(60, 224, Lpt1_found, 3);
|
||||
ips200_show_uint(160, 165, is_straight0, 3);
|
||||
ips200_show_uint(160, 185, is_straight1, 3);
|
||||
ips200_show_uint(160, 165, Lpt0_found_barrier, 3);
|
||||
ips200_show_uint(160, 185, Lpt1_found_barrier, 3);
|
||||
}
|
||||
|
||||
/**
|
||||
|
||||
Reference in New Issue
Block a user