local planner 代码问题请教

[sunxq_hit]

各位大神，请问这行代码（446-449）：

if (pathID >= 0 && pathID < pathNum && groupID >= 0 && groupID < groupNum) {
  pathList[pathID] = groupID;
  endDirPathList[pathID] = 2.0 * atan2(endY, endX) * 180 / PI;
}

在计算每条路径终点的方向角时，为什么乘以2呢？

[哈工大-朱洪彪]

你好，这里的2是一个经验数字，类似于一种驾驶的直觉，如果一条路径是向左或者向右弯曲的，后续的路径还会继续向相同的方向弯曲，所以我们把角度设置的比实际的大。当使用waypoint来引导local planner的时候，就会像把车开出去更远那样考虑车辆的行驶方向，而不只是考虑当前的状态。在实际测试中，我们已经把这个参数调到最好的效果了，不过你仍然可以自己去调节，尝试不同的效果。

[Robert--cao]

个人理解可以把它看做为一个角度值的权重，目的就是让在计算代价值的时候轨迹终点方向角离目标点的越小的轨迹越容易被选择。但是也不能设置为太大，太大容易造成基本选择车的方向前进，特别是到终点的时候会不断的调整。也不能设置太小，太小容易在直道上轨迹很容易弯曲。