RemovePassedGoals(移除已通过的目标)

检查输入端口的“goals”并删除机器人靠近或最近经过的任何点。这用于剔除已从 ComputePathToPoses 传递的目标点,以便仅对当前任务目标进行重新规划。

输入端口

radius(半径)

类型

默认

双精度

0.5

描述

在通过的蓝牙节点列表中,从列表中移除与目标点接近的半径(米)。

global_frame

类型

默认

string

"地图"

描述

参考坐标系。

机器人基准坐标系

类型

默认

string

"base_link"

描述

机器人基准坐标系。

输入目标

类型

默认

geometry_msgs::msg::PoseStamped

N/A

描述

一个目标向量,用于检查在当前迭代中是否通过了任何目标。

输出端口

输出目标

类型

默认

geometry_msgs::msg::PoseStamped

N/A

描述

一个目标向量,其中的目标在接近机器人时被移除。

示例

<RemovePassedGoals radius="0.6" input_goals="{goals}" output_goals="{goals}"/>