标签：planner 变量 Efficient Trajectory teb 非线性 g2o 优化 节点

teb2013年的一篇文章

摘要：

teb的最优轨迹问题，可以转换为多变量的非线性最优化问题。大多数的变量成员都与一小部分周围的变量产生联系。进而构成稀疏结构的H矩阵。文章主要就是描述，怎么用g2o来求解teb的优化问题。

g2o在VSLAM和SBA中已经广泛应用。

g2o优化第一步首先构建图模型：

图模型是由节点和边组成：

其中teb所有的节点：

边构成节点之间的约束。用f(x)表示。

最终生成的图的样子：

最终的转换为如下公式：

非线性最小二次优化问题：

标签：planner,变量,Efficient,Trajectory,teb,非线性,g2o,优化,节点
来源： https://blog.csdn.net/allenhsu6/article/details/113634094

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。