本文整理汇总了C++中eigen::Quaternion::_transformVector方法的典型用法代码示例。如果您正苦于以下问题:C++ Quaternion::_transformVector方法的具体用法?C++ Quaternion::_transformVector怎么用?C++ Quaternion::_transformVector使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类eigen::Quaternion
的用法示例。
在下文中一共展示了Quaternion::_transformVector方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: rot
Eigen::Vector3d pose3Dto2D (geometry_msgs::Point const & translation,
geometry_msgs::Quaternion const & orientation)
{
// Can somebody please explain to me why Eigen has chosen to store
// the parameters in (x,y,z,w) order, but provide a ctor in
// (w,x,y,z) order? What have they been smoking?
//
Eigen::Quaternion<double> const rot (orientation.w,
orientation.x,
orientation.y,
orientation.z);
Eigen::Vector3d ux;
ux << 1.0, 0.0, 0.0;
ux = rot._transformVector (ux);
Eigen::Vector3d pose (translation.x, translation.y, atan2 (ux.y(), ux.x()));
return pose;
}