本文整理汇总了C++中eigen::Matrix4d::isApprox方法的典型用法代码示例。如果您正苦于以下问题：C++ Matrix4d::isApprox方法的具体用法？C++ Matrix4d::isApprox怎么用？C++ Matrix4d::isApprox使用的例子？那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类eigen::Matrix4d的用法示例。
在下文中一共展示了Matrix4d::isApprox方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: cos
TEST(TfEigen, ConvertTransform)
{
Eigen::Matrix4d tm;
double alpha = M_PI/4.0;
double theta = M_PI/6.0;
double gamma = M_PI/12.0;
tm << cos(theta)*cos(gamma),-cos(theta)*sin(gamma),sin(theta), 1, //
cos(alpha)*sin(gamma)+sin(alpha)*sin(theta)*cos(gamma),cos(alpha)*cos(gamma)-sin(alpha)*sin(theta)*sin(gamma),-sin(alpha)*cos(theta), 2, //
sin(alpha)*sin(gamma)-cos(alpha)*sin(theta)*cos(gamma),cos(alpha)*sin(theta)*sin(gamma)+sin(alpha)*cos(gamma),cos(alpha)*cos(theta), 3, //
0, 0, 0, 1;
Eigen::Affine3d T(tm);
geometry_msgs::TransformStamped msg = tf2::eigenToTransform(T);
Eigen::Affine3d Tback = tf2::transformToEigen(msg);
EXPECT_TRUE(T.isApprox(Tback));
EXPECT_TRUE(tm.isApprox(Tback.matrix()));
}