本文整理汇总了C++中Pose::orientation方法的典型用法代码示例。如果您正苦于以下问题:C++ Pose::orientation方法的具体用法?C++ Pose::orientation怎么用?C++ Pose::orientation使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Pose
的用法示例。
在下文中一共展示了Pose::orientation方法的2个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: Pose
inline Pose Pose::operator*(const Pose& other) const
{
// Convention: Pose * PoseOther
// x' = (Pose * PoseOther).map(x)
// x' = Pose.map(PoseOther.map(x))
// x' = R * (Rother * x + Tother) + T
// x' = R * Rother * x + (R * Tother + T)
Quaterniond orientation = (m_orientation * other.orientation());
Vector3d position = m_orientation * other.position() + m_position;
return Pose(orientation, position);
}
示例2: get_heading
double get_heading(const Pose &p) { return p.orientation(); }