本文整理汇总了C++中Pose::Yaw方法的典型用法代码示例。如果您正苦于以下问题：C++ Pose::Yaw方法的具体用法？C++ Pose::Yaw怎么用？C++ Pose::Yaw使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Pose的用法示例。
在下文中一共展示了Pose::Yaw方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: CalculateNextPoint
////////////////////////////////////////////////////////////////////////////////////
///
/// \brief Returns a point [distance] meters from the end of the path
/// (follows last points heading).
///
/// \param[in] pose The position to be relative to.
/// \param[in] distance Distance from last point to the next point.
/// \param[in] angleOffset Optional parameter to offset current angle in radians.
///
/// \return Pose where the projected line would end.
///
////////////////////////////////////////////////////////////////////////////////////
Pose Path::CalculateNextPoint(const Pose pose, const double distance, const double angleOffset)
{
Point3D point;
CxUtils::Quaternion quat;
Pose projection = pose;
projection.mRotation.mZ += angleOffset;
if(projection.mpPoseRotation != NULL)
{
projection.mpPoseRotation->mZ += angleOffset;
quat = *projection.mpPoseRotation;
}
else
{
quat.SetRotationZ(-projection.Yaw());
}
point.mY = distance;
point = quat.Rotate(point);
projection.mPosition += point;
return projection;
}