fix(goal_planner_module): adjust object filtering to consider velocity threshold

fix(goal_planner_module): adjust object filtering to consider velocity threshold #4592