Skip to content

Commit

Permalink
Correct target detection test reference
Browse files Browse the repository at this point in the history
  • Loading branch information
RoboticsYY committed Jun 8, 2020
1 parent 4e4ca46 commit 8045511
Showing 1 changed file with 2 additions and 2 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -129,8 +129,8 @@ TEST_F(MoveItHandEyeTargetTester, DetectArucoMarkerPose)
camera_transform = target_->getTransformStamped(camera_info->header.frame_id);
Eigen::Affine3d ret = tf2::transformToEigen(camera_transform);
std::cout << "Translation:\n" << ret.translation() << "\nRotation:\n" << ret.rotation().eulerAngles(0, 1, 2) << std::endl;
Eigen::Vector3d t(0.412949, -0.198895, 11.1761);
Eigen::Vector3d r(0.324172, -2.03144, 2.90114);
Eigen::Vector3d t(0.0148984, 0.0123107, 0.58609);
Eigen::Vector3d r(2.12328, -1.50481, -1.29729);
ASSERT_TRUE(ret.translation().isApprox(t, 0.01));
ASSERT_TRUE(ret.rotation().eulerAngles(0, 1, 2).isApprox(r, 0.01));
}
Expand Down

0 comments on commit 8045511

Please sign in to comment.