This uses the improvements @jeking04 made to GetLinearCollisionCheckPts in #332 to improve the collision checking efficiency of VectorFieldPlanner. Due to poor bookkeeping, the planner previously re-checked the entire trajectory from the start after each integration step.
This pull request is an improved version of the attempted fix in #287.
This uses the improvements @jeking04 made to
GetLinearCollisionCheckPts
in #332 to improve the collision checking efficiency ofVectorFieldPlanner
. Due to poor bookkeeping, the planner previously re-checked the entire trajectory from the start after each integration step.This pull request is an improved version of the attempted fix in #287.