本文整理汇总了C++中PowerCubeCtrl::doHoming方法的典型用法代码示例。如果您正苦于以下问题：C++ PowerCubeCtrl::doHoming方法的具体用法？C++ PowerCubeCtrl::doHoming怎么用？C++ PowerCubeCtrl::doHoming使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类PowerCubeCtrl的用法示例。
在下文中一共展示了PowerCubeCtrl::doHoming方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: srvCallback_Init
// service callback functions
// function will be called when a service is querried
bool srvCallback_Init(cob3_srvs::Init::Request &req,
cob3_srvs::Init::Response &res )
{
ROS_INFO("Initializing powercubes");
// init powercubes
//TODO: make iniFilepath as an argument
//TODO: read iniFile into ros prarameters
if (PCube->Init("include/iniFile.txt"))
{
ROS_INFO("Initializing succesfull");
res.success = 0; // 0 = true, else = false
}
else
{
ROS_ERROR("Initializing powercubes not succesfull. error: %s", PCube->getErrorMessage().c_str());
res.success = 1; // 0 = true, else = false
res.errorMessage.data = PCube->getErrorMessage();
return true;
}
// homing powercubes
if (PCube->doHoming())
{
ROS_INFO("Homing powercubes succesfull");
res.success = 0; // 0 = true, else = false
}
else
{
ROS_ERROR("Homing powercubes not succesfull. error: %s", PCube->getErrorMessage().c_str());
res.success = 1; // 0 = true, else = false
res.errorMessage.data = PCube->getErrorMessage();
return true;
}
return true;
}