diff --git a/Vision/camera_coordinate_dete.py b/Vision/camera_coordinate_dete.py index f10bb2e..564f075 100644 --- a/Vision/camera_coordinate_dete.py +++ b/Vision/camera_coordinate_dete.py @@ -252,6 +252,7 @@ class Detection: if np.isnan(point_x): # 点云值为无效值 continue else: + if Box_isPoint == True: box_list.append( [[box_point_x1, box_point_y1, box_point_z1], diff --git a/Vision/camera_coordinate_dete_img.py b/Vision/camera_coordinate_dete_img.py index b43005d..11b6f53 100644 --- a/Vision/camera_coordinate_dete_img.py +++ b/Vision/camera_coordinate_dete_img.py @@ -231,7 +231,6 @@ class Detection: box_point_x4, box_point_y4, box_point_z4 = remove_nan_mean_value(pm, box[3][0][1], box[3][0][0]) else: pass - x_rotation_center = int((box[0][0][0] + box[1][0][0] + box[2][0][0] + box[3][0][0]) / 4) y_rotation_center = int((box[0][0][1] + box[1][0][1] + box[2][0][1] + box[3][0][1]) / 4) point_x, point_y, point_z = remove_nan_mean_value(pm, y_rotation_center, x_rotation_center)