纯跟踪(Pure Pursuit)算法是一种用于移动机器人或自动驾驶车辆的路径跟踪方法。其基本目标是让机器人沿着预定路径行驶,同时保持一定的参考速度。在给定线速度的前提下,它计算移动的角速度令机器人从其当前位置到达机器人前方的某个前瞻点(lookahead)。该算法根据机器人的当前位置不断地追着它前面的一个点,直到路径的最后一个点。
根据模型的不同,Pure Pursuit算法需要使用不同的控制公式,例如:
自行车模型:

如上图所示,点C为路径上的一个点(前视点/预瞄点),Pure Pursuit算法的目标则是控制B的角速度,使得A点可以经过C点。
假设我们以AC两点画一个圆弧,注意,由于要考虑到运动学约束,这段圆弧应当与直线AB相切,也就是角OAB=90度。同时我们知道对于圆弧,OA=OC,三角形AOC为等腰三角形。
∠ O A C = ∠ O C A \angle OAC = \angle OCA ∠OAC=∠OCA
同时有:
∠ O A C + ∠ C A B = π 2 \angle OAC +\angle CAB = \frac{\pi}{2} ∠OAC+∠CAB=2π
即:
2 ∗ ( ∠ O A C + ∠ C A B ) = π 2*(\angle OAC +\angle CAB )= \pi 2∗(∠OAC+∠CAB)=π
于是可以得到:
∠ O A C + ∠ O C A + 2 ∗ ∠ C A B = π \angle OAC + \angle OCA + 2*\angle CAB = \pi ∠OAC+∠OCA
1万+



被折叠的 条评论
为什么被折叠?



