本文整理汇总了C++中PowerCubeCtrl::Recover方法的典型用法代码示例。如果您正苦于以下问题:C++ PowerCubeCtrl::Recover方法的具体用法?C++ PowerCubeCtrl::Recover怎么用?C++ PowerCubeCtrl::Recover使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类PowerCubeCtrl
的用法示例。
在下文中一共展示了PowerCubeCtrl::Recover方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: srvCallback_Recover
/*!
* \brief Executes the service callback for recover.
*
* Recovers the driver after an emergency stop.
* \param req Service request
* \param res Service response
*/
bool srvCallback_Recover(cob_srvs::Trigger::Request &req, cob_srvs::Trigger::Response &res)
{
ROS_INFO("Recovering powercubes...");
if (initialized_)
{
/// stopping all arm movements
if (pc_ctrl_->Recover())
{
error_ = false;
error_msg_ = "";
res.success.data = true;
ROS_INFO("...recovering powercubes successful.");
}
else
{
res.success.data = false;
error_ = true;
error_msg_ = pc_ctrl_->getErrorMessage();
res.error_message.data = pc_ctrl_->getErrorMessage();
ROS_ERROR("...recovering powercubes not successful. error: %s", res.error_message.data.c_str());
}
}
else
{
res.success.data = false;
res.error_message.data = "powercubes not initialized";
ROS_ERROR("...recovering powercubes not successful. error: %s",res.error_message.data.c_str());
}
return true;
}