本文整理汇总了C++中kdl::Rotation::Inverse方法的典型用法代码示例。如果您正苦于以下问题：C++ Rotation::Inverse方法的具体用法？C++ Rotation::Inverse怎么用？C++ Rotation::Inverse使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类kdl::Rotation的用法示例。
在下文中一共展示了Rotation::Inverse方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: calcPoseDiff
void Controller::calcPoseDiff(){
// Calculate the position difference expressed in the world frame
KDL::Vector diff_world(m_goal_pose.x - m_current_pose[0], m_goal_pose.y - m_current_pose[1], 0.0);
// Calculate the YouBot-to-world orientation matrix, based on the angle
// estimation.
KDL::Rotation rot = KDL::Rotation::RotZ(m_current_pose[2]);
// Express the position difference in the YouBot frame
m_delta_pose = rot.Inverse(diff_world);
m_delta_pose[2] = m_goal_pose.theta - m_current_pose[2];
}