Skip to content
Snippets Groups Projects
Commit dc015a56 authored by jvallve's avatar jvallve
Browse files

bug in capture_laser

parent 5c8806e7
No related branches found
No related tags found
No related merge requests found
...@@ -138,7 +138,7 @@ void CaptureLaser2D::establishConstraintsMHTree() ...@@ -138,7 +138,7 @@ void CaptureLaser2D::establishConstraintsMHTree()
corners << -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2, -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2, corners << -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2, -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2,
-CONTAINER_WIDTH / 2, -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2, -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2, -CONTAINER_LENGTH / 2, -CONTAINER_WIDTH / 2, -CONTAINER_LENGTH / 2,
0, M_PI / 2, M_PI, -M_PI / 2; 0, M_PI / 2, M_PI, -M_PI / 2;
Eigen::MatrixXs rotated_corners = corners(3,4); Eigen::MatrixXs rotated_corners = corners;
Eigen::VectorXs squared_mahalanobis_distances; Eigen::VectorXs squared_mahalanobis_distances;
// COMPUTING ALL EXPECTED FEATURES // COMPUTING ALL EXPECTED FEATURES
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment