一种基于势能场的机器人路径跟踪算法
Abstract:
本发明提供本发明的一种基于势能场的机器人路径跟踪算法,包括以下步骤:(1)获得转弯半径;(2)根据转弯半径R和当前线速度Vx(t),估算下一个时刻线速度Vx(t+1);(3)根据R和Vx(t+1)计算角速度ω,获得合理的路径跟踪速度(Vx,ω),随后对获得的当前路径与预设路径两者之间进行拟合获得最优的路径跟踪速度(Vx,ω优),由此确定最优跟踪路径轨迹。本发明通过对机器人实时虚拟路径的分析计算得到基础速度分解量(Vx,ω),然后进一步通过势能场中机器人路径预测来得到最优路径,能够极大的提高计算效率,降低对计算机硬件的要求,并且不论系统本身的特性如何变化,或者机器人相对预设路径的初始偏角多大,算法本身都会保证机器人收敛到预设路径上。
Public/Granted literature
Patent Agency Ranking
0/0