本文整理汇总了C++中kdl::Rotation::GetEulerZYX方法的典型用法代码示例。如果您正苦于以下问题：C++ Rotation::GetEulerZYX方法的具体用法？C++ Rotation::GetEulerZYX怎么用？C++ Rotation::GetEulerZYX使用的例子？那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类kdl::Rotation的用法示例。
在下文中一共展示了Rotation::GetEulerZYX方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: goal_callback
void goal_callback(const geometry_msgs::PoseStamped::ConstPtr& msg)
{
if(msg->header.frame_id.compare(frame_id_) != 0)
{
ROS_WARN("frame_id of goal did not match expected '%s'. Ignoring goal",
frame_id_.c_str());
return;
}
// copying over goal
state_[joint_names_.size() + 0] = msg->pose.position.x;
state_[joint_names_.size() + 1] = msg->pose.position.y;
state_[joint_names_.size() + 2] = msg->pose.position.z;
KDL::Rotation rot;
tf::quaternionMsgToKDL(msg->pose.orientation, rot);
rot.GetEulerZYX(state_[joint_names_.size() + 3], state_[joint_names_.size() + 4],
state_[joint_names_.size() + 5]);
if (!controller_started_)
{
if (controller_.start(state_, nWSR_))
{
ROS_INFO("Controller started.");
controller_started_ = true;
}
else
{
ROS_ERROR("Couldn't start controller.");
print_eigen(state_);
}
}
}