Ros noetic 机器人坐标记录运动路径和发布 实战教程(C)配套教程
用于加载路径点并发布 在构造函数中,通过读取ROS参数服务器中的配置参数,获取路径点话题的名称、路径点文件的路径和地图坐标系的名称。 使用ROS的发布器对象,在构造函数中创建一个 ros::Publisher 类型的对象,用于发布路径点信息到指定的ROS话题。 在 LoadWaypointsArray_() 函数中,根据指定的路径点文件路径,打开并读取路径点文件。然后解析每一行的数据,将其转化为路径点的数据结构,并将其添加到路径点数组中。 在一个单独的线程中,通过 PublishWaypoints_() 函数循环发布路径点信息到ROS话题。该函数使用ROS发布器对象将路径点数组中存储的路径点信息发布到指定的ROS话题上。 main() 函数中实例化了 WaypointLoader 类的对象,并传入ROS节点句柄作为参数。然后通过调用 ros::spin() 进入ROS的主循环,等待接收ROS系统的消息和调用回调函数。 整个过程中,WaypointLoader 类负责加载路径点文件,解析路径点数据,以指定频率发布路径点信息,并通过ROS机制将路径点信息传递给其他ROS节点。