本文整理汇总了C++中ros::ServiceClient::getService方法的典型用法代码示例。如果您正苦于以下问题:C++ ServiceClient::getService方法的具体用法?C++ ServiceClient::getService怎么用?C++ ServiceClient::getService使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类ros::ServiceClient
的用法示例。
在下文中一共展示了ServiceClient::getService方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: draw
void TrajectoryMapWriter::draw(MapWriterInterface *interface)
{
if(!initialized_) return;
hector_nav_msgs::GetRobotTrajectory srv_path;
if (!service_client_.call(srv_path)) {
ROS_ERROR_NAMED(name_, "Cannot draw trajectory, service %s failed", service_client_.getService().c_str());
return;
}
std::vector<geometry_msgs::PoseStamped>& traj_vector (srv_path.response.trajectory.poses);
size_t size = traj_vector.size();
std::vector<Eigen::Vector2f> pointVec;
pointVec.resize(size);
for (size_t i = 0; i < size; ++i){
const geometry_msgs::PoseStamped& pose (traj_vector[i]);
pointVec[i] = Eigen::Vector2f(pose.pose.position.x, pose.pose.position.y);
}
if (size > 0){
//Eigen::Vector3f startVec(pose_vector[0].x,pose_vector[0].y,pose_vector[0].z);
Eigen::Vector3f startVec(pointVec[0].x(),pointVec[0].y(),0.0f);
interface->drawPath(startVec, pointVec);
}
}