机器人控制算法——局部规划器TEB算法原理及C++可视化仿真

“ 最近一段时间，由于项目需要，一直在做TEB算法的工程化的工作，于是就考虑写下一篇系统些的文章，作为笔记，后续自己看也方便，TEB的英文名Time elastic band”，是一种局部规划器,它的核心思想是将路径规划问题转化为一个带有时间弹性的优化问题,通过对时间弹性的控制，来实现路径的优化。”TEB算法网上有很多的相关资料，本文主要侧重于如何在ubuntu系统下对C++开源的TEB算法进行可视化仿真，这件事是很有意义的，如果做纯理论算法的，可以通过此代码验证自己对TEB算法改进后的效果，如果要做工程化的产品，可用此代码研究TEB算法的不同的参数和算法的效果之间的关系，然后使其在真正的产品上调试出一组好的参数。那现在开始正文吧！01—TEB算法原理正如开头引言所介绍，TEB算法是一种局部规划器，它的核心思想是将路径规划问题转 ………………………………