rosparam和ROS参数服务

https://blog.csdn.net/u014695839/article/details/78348600
https://blog.csdn.net/u014695839/article/details/78348600

可以参考turtlebot的navigation启动move_base节点的过程,保存在yaml文件中的参数是通过rosparam标签被加载到参数服务器中的。

定义NodeHandle对象n时用默认的全局命名空间,定义NodeHandle对象pn的时候使用了私有的命名空间:

ros::init(argc, argv, “param_demo”);
ros::NodeHandle n;
ros::NodeHandle pn("~my_namespce");
因此“string_param”是全局的参数,“int_param”是在命名空间my_namespace下的参数。

接下来有两行代码:

n.paramstd::string(“string_param”, s, “haha”);
pn.param(“int_param”, num, 666)

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
以下是补充完整的代码: ```cpp #include <iostream> #include <cmath> #include <ros/ros.h> #include <geometry_msgs/PoseStamped.h> #include <nav_msgs/Odometry.h> #include "plan_env/lec4.h" #include "ego_planner/TutorialGoal.h" using namespace std; ros::Subscriber odom_sub; ros::Publisher param_goal_pub; ros::ServiceClient client; int waypoint_num_; double waypoints_[50][3]; double spin_rate; // void OdomCallback(const nav_msgs::Odometry& msg) { ROS_WARN_ONCE("odom CB"); static int way_point_count = 0; if (way_point_count >= waypoint_num_) { ROS_WARN_ONCE("all points pub"); return; } float dist = std::sqrt(std::pow(waypoints_[way_point_count][0] - msg.pose.pose.position.x, 2) + std::pow(waypoints_[way_point_count][1] - msg.pose.pose.position.y, 2) + std::pow(waypoints_[way_point_count][2] - msg.pose.pose.position.z, 2)); //TODO /***your code for publishing drone goal***/ if (dist < 0.1) { ego_planner::TutorialGoal goal; goal.point.x = waypoints_[way_point_count][0]; goal.point.y = waypoints_[way_point_count][1]; goal.point.z = waypoints_[way_point_count][2]; param_goal_pub.publish(goal); way_point_count++; } } int main(int argc, char** argv) { ros::init(argc, argv, "exercesie2_param_node"); ros::NodeHandle n("~"); odom_sub = n.subscribe("/odom", 10, OdomCallback); param_goal_pub = n.advertise<ego_planner::TutorialGoal>("/waypoint_generator/tutorial_goal", 10); //TODO /*your code for param reading*/ n.param("/waypoint_num", waypoint_num_, 0); for (int i = 0; i < waypoint_num_; i++) { string param_x = "/waypoint_" + to_string(i) + "/x"; string param_y = "/waypoint_" + to_string(i) + "/y"; string param_z = "/waypoint_" + to_string(i) + "/z"; n.param(param_x, waypoints_[i][0], 0.0); n.param(param_y, waypoints_[i][1], 0.0); n.param(param_z, waypoints_[i][2], 0.0); } n.param("/spin_rate", spin_rate, 10.0); ros::Duration(0.5).sleep(); ros::Rate loop_rate(spin_rate); while (ros::ok()) { ros::spinOnce(); loop_rate.sleep(); } } ``` 这段代码是一个ROS节点,用于读取参数并发布无人机的目标位置。它通过订阅`/odom`话题获取当前无人机的位置信息,然后根据预设的目标点,计算当前位置与目标点之间的距离。当距离小于阈值时,发布下一个目标点作为无人机的目标位置。 在`main`函数中,我们首先初始化ROS节点,并设置参数服务器前缀为`~`。然后创建一个订阅器`odom_sub`,用于接收无人机的位置信息。创建一个发布器`param_goal_pub`,用于发布无人机的目标位置。接着从参数服务器中读取参数,包括目标点的数量`waypoint_num`和每个目标点的坐标。最后,设置循环的频率,并在循环中调用`ros::spinOnce()`来处理ROS的回调函数。 其中,`OdomCallback`是回调函数,用于处理接收到的无人机位置信息。在该函数中,我们首先判断是否已经发布了所有的目标点,如果是,则直接返回。否则,计算当前位置与目标点之间的距离`dist`。如果距离小于设定的阈值(这里设为0.1),则发布下一个目标点作为无人机的目标位置,并将目标点计数加1。 请根据实际需求修改其中的TODO部分,完成发布无人机目标位置的代码。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值