def path_last_point_to_numpy(path):
if isinstance(path, Path):
path = path.poses[-1]
if isinstance(path, PoseStamped):
return ROSBridge.pose_to_list(path)
raise TypeError("ROSBridge.path_last_point_to_numpy only accepts Path or PoseStamped, got {}".format(type(path)))
评论列表
文章目录