如何通过C++action判断move_base goal reached
时间: 2023-04-09 12:01:49 浏览: 142
基于C++Builder的运动目标检测
可以通过监听 move_base 的 feedback topic,判断当前机器人是否已经到达目标点。如果 feedback 中的状态为 SUCCEEDED,则说明机器人已经到达目标点。可以使用以下代码实现:
rospy.Subscriber('/move_base/feedback', MoveBaseActionFeedback, feedback_callback)
def feedback_callback(feedback):
if feedback.status.status == 3:
rospy.loginfo("Goal reached!")
阅读全文