路径跟踪之Pure Pursuit控制算法
Pure Pursuit是一种几何跟踪控制算法，也被称为纯跟踪控制算法。该算法最早由R. Wallace在1985年提出，其思想是基于当前车辆的后轮中心位置（车辆质心），在参考路径上向（称为前视距离）的距离匹配一个预瞄点，假设车辆后轮中心可以按照一定的转弯半径????行驶至该预瞄点，然后根据前视距离、转弯半径????、车辆坐标系下预瞄点的朝向角????之间的几何关系来计算前轮转角。如上图所示，在三角形OAC中，根据正弦定理可得：根据车辆的运动学方程，有：所以，前轮转角为：车辆
