提交更新

TrackingRos.cpp

@@ -86,9 +86,9 @@ void CalculateGuassPos(float x, float y,float z,std::vector<std::vector<float>>&
     auto lidar_loc = (tail_pnt - head_pnt) * inter_len / (1.0 * total_len) + head_pnt;
 
     Eigen::Vector4f tranTmp;
-    float loc_x = lidar_loc[0];
-    float loc_y = lidar_loc[1];
-    float loc_z = lidar_loc[2];
+    float loc_x = lidar_loc[0][0];
+    float loc_y = lidar_loc[0][1];
+    float loc_z = lidar_loc[0][2];
     tranTmp << loc_x, loc_y, loc_z, 1;
 
     Eigen::Matrix4f Trans = Eigen::Matrix4f::Zero();