模型预测控制和multi_robot_trajectory对接

转到多机器人路径规划上了,功能包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的论文

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值