转到多机器人路径规划上了,功能包multi_robot_trajectory中使用ECBS获取路径,后续建立安全走廊,在此基础上对路径做了轨迹优化。
开源代码只有轨迹优化和可视化,并没有加入跟踪。因此采用MPC对路径进行跟踪
MPC 代码采用github开源mpc_ros的代码
修改内容:
trackRefTrajNode
将回调函数的desiredPathCB订阅话题修改为产生的轨迹话题,为desired_trajectory/mav0
修改multi_robot_traj_planner功能包中头文件中发布可视化i的文件,将msgs_traj消息类型的坐标系改为odom,初始是world只是为了可视化。
把experiment.launch中rviz的节点注释
roslaunch mpc_ros ref_trajectory_tracking_gazebo.launch
roslaunch multi_robot_traj_planner experiment.launch
存在问题:
1、还是在gazebo中进行的可视化,后续修改在stage_ros中,并且用先锋的模型
2、轨迹跟踪到终点后,不会停止。发布终点话题
后续学习下ECBS, EECBS,SIPP,CBS的论文以及代码
以及最近一个大牛的IJRR的论文