本文整理汇总了C++中Pose3::retract方法的典型用法代码示例。如果您正苦于以下问题：C++ Pose3::retract方法的具体用法？C++ Pose3::retract怎么用？C++ Pose3::retract使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Pose3的用法示例。
在下文中一共展示了Pose3::retract方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: main
int main()
{
int n = 5000000;
cout << "NOTE: Times are reported for " << n << " calls" << endl;
double norm=sqrt(1.0+16.0+4.0);
double x=1.0/norm, y=4.0/norm, z=2.0/norm;
Vector v = (Vector(6) << x, y, z, 0.1, 0.2, -0.1).finished();
Pose3 T = Pose3::Expmap((Vector(6) << 0.1, 0.1, 0.2, 0.1, 0.4, 0.2).finished()), T2 = T.retract(v);
Matrix H1,H2;
TEST(retract, T.retract(v))
TEST(Expmap, T*Pose3::Expmap(v))
TEST(localCoordinates, T.localCoordinates(T2))
TEST(between, T.between(T2))
TEST(between_derivatives, T.between(T2,H1,H2))
TEST(Logmap, Pose3::Logmap(T.between(T2)))
// Print timings
tictoc_print_();
return 0;
}