论文翻译 《Trajectory modification considering dynamic constraints of autonomous robots》考虑动力学约束的自主机器人轨迹修正

论文翻译 《Trajectory modification considering dynamic constraints of autonomous robots》考虑动力学约束的自主机器人轨迹修正
摘要：
经典的“弹性带”使全局规划者生成的路径相对于最短路径长度变形，同时避免与障碍物接触。它不直接考虑底层机器人的任何动态约束。这一贡献引入了一种新的方法，称为“时间弹性带”，它根据动态约束(如有限的机器人速度和加速度)显式地考虑运动的时间方面。在加权多目标优化框架下，建立了“时间弹性带”问题的数学模型。大多数目标都是本地的，因为它们依赖于几个相邻的中间配置。这导致了一个稀疏系统矩阵，对于该稀疏系统矩阵，存在有效的大规模约束最小二乘优化方法。仿真和真实机器人的实验结果表明，该方法能够实时生成最优机器人轨迹，具有较好的鲁棒性和计算效率。“定时弹性带”将由一系列路点组成的初始路径转换为显式依赖于时间的轨迹，从而实现对机器人的实时控制。由于其模块化的表述方式，该方法很容易扩展以包含额外的目标和约束。

1 Introduction

• 运动规划关注的是寻找一条符合运动学和动力学运动约束的无碰撞轨迹。
• 在运动规划的背景下，假设初始路径已由全局规划者生成，本文重点研究局部路径修改[1]。特别地，在服务机器人的上下文中，由于动态环境的固有不确定性，由于环境可以是动态的，因此修改路径是优选的方法。此外，由于局部的、不完整的地图和动态障碍物，环境模型可能会发生变化。此外，大规模全局路径的(重新)计算在实时应用中往往是不可行的。这种观察导致了局部修改路径的方法，例如[2，3]提出的“弹性带”。“弹性带”方法的主要思想是通过将一条最初给定的路径视为受到内力和外力的弹性橡皮带来变形，内力和外力相互平衡，试图在与障碍物保持一定距离的同时收缩路径。
• 后来，这种方法扩展到非完整运动学[4，5，6]，多自由度机器人系统[7]和动力学障碍物[8]。然而，据我们所知，动态运动约束尚未被视为路径变形的目标。典型的方法是平滑路径，例如使用样条曲线来获得动态可行的轨迹。

• 

                                                                             图1：带有“定时橡皮筋”的机器人系统

• 我们的方法，称为“时间弹性带”，是新颖的，因为它用时间信息显式地增加了“弹性带”，从而允许考虑机器人的动态约束和对轨迹的直接修改，而不是路径。图1显示了带有“定时弹性带”的机器人系统的体系结构。通过考虑时间信息，“定时弹性带”也可以用来控制机器人的速度和加速度。新方法适用于高维状态空间，尽管本文考虑的是一个微分驱动移动机器人在平面环境中运动，具有三个全局自由度和两个局部自由度。

• 2 Timed Elastic Band

• 经典的“橡皮筋”是用n个中间机器人姿势的序列来描述的  xi= (xi,yi,βi)T∈R2× S1, 在以下表示为包括机器人在相关帧β，图2)中的位置xi、yi和方位地图i的配置中：

• 

•  通过两个相继配置之间的时间间隔来增加“定时弹性带”(TEB)，从而产生n−1时间差Δ_Ti的序列：

• 

• 每个时间差表示机器人按顺序从一个构形过渡到下一个构形所需的时间(图2)。TEB被定义为两个序列的元组：