1 introduction
2 Timed Elastic Band
经典的“elastic band”是用n个中间机器人姿势序列来描述的,而“time elastic band”则是两个序列组成的元组:时间和位姿。其关键思想是通过实时加权多目标优化来调整和优化TEB的位姿配置和时间间隔。
TEB其实是一个非线性优化问题,它的目标函数分为两类:(a)以penalty function表示的约束,比如速度和加速度限制 (b) 与路径相关的目标函数,比如清障、最短路的目标。稀疏约束优化算法在机器人框架(如OS)中并不容易获得。因此,在“时间弹性带”的背景下,这些约束被描述为一个分段连续的、可微分的代价函数,产生违反约束的行为越严重,代价越高。
x表示约束变量,xr表示约束值,E影响逼近精度,S表示缩放因子, n为多项式阶数,E为一个逼近的较小的偏移量。这一式子即为上文提到的teb的目标函数之一:以penalty function表示的约束,比如速度和加速度限制。
写一半不想写了,因为发现已经有博文写的很清楚了
https://blog.csdn.net/xiekaikaibing/article/details/83417223
https://www.leiphone.com/news/201612/0TCtaBOIcFOIBN69.html