本文整理汇总了C++中eigen::VectorXd::isApprox方法的典型用法代码示例。如果您正苦于以下问题:C++ VectorXd::isApprox方法的具体用法?C++ VectorXd::isApprox怎么用?C++ VectorXd::isApprox使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类eigen::VectorXd
的用法示例。
在下文中一共展示了VectorXd::isApprox方法的2个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: rvss
//==============================================================================
TEST(Rn, LogMapRx)
{
Rn rvss(3);
auto state = rvss.createState();
rvss.setValue(state, Eigen::Vector3d(1, 2, 3));
Eigen::VectorXd out;
rvss.logMap(state, out);
EXPECT_TRUE(out.isApprox(Eigen::Vector3d(1, 2, 3)));
rvss.expMap(Eigen::Vector3d(4, 5, 7), state);
rvss.logMap(state, out);
EXPECT_TRUE(out.isApprox(Eigen::Vector3d(4, 5, 7)));
}
示例2:
TEST(SO3, LogMap)
{
SO3 so3;
auto state = so3.createState();
so3.setQuaternion(
state,
Eigen::Quaterniond(Eigen::AngleAxisd(M_PI_2, Eigen::Vector3d::UnitZ())));
Eigen::VectorXd out;
so3.logMap(state, out);
EXPECT_TRUE(Eigen::Vector3d(0, 0, M_PI_2).isApprox(out));
so3.expMap(Eigen::Vector3d(M_PI_2, M_PI_2, M_PI / 5), state);
so3.logMap(state, out);
EXPECT_TRUE(out.isApprox(Eigen::Vector3d(M_PI_2, M_PI_2, M_PI / 5)));
}