ROS控制 从移动指定距离流畅切换到自主导航

介绍:
MoveTargetDistanceForward是个移动指定距离的函数。
PublishGoalCmd时move_base中发送导航坐标,自主导航到目标点的函数。

需求:向前移动0.3m后,直接切换到导航状态,但机器人会卡顿一下。
因此需要进行多线程同时启动两个函数,同时还需要设置信号量,控制两个函数的优先级。
让MoveTargetDistanceForward先执行,PublishGoalCmd也同时规划好路径。
让导航的速度会被暂时忽视,等待MoveTargetDistanceForward执行完成,再接收导航速度。

MoveTargetDistanceForward

-> cmd_vel_for_moto -> cmd_vel
将速度发给cmd_vel_for_moto,然后由CmdVelRelayNode控制,转发给cmd_vel

  • 修改deskmedia/src/deskmedia_node.cpp
// 向cmd_vel_for_moto发送速度
cmd_vel_ = nh.advertise<geometry_msgs::Twist
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
红包 添加红包
表情包 插入表情
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值