Before revision:  The main improvement is that the collision term in  penalty function is formulated by comparing the colliding trajectory with a collision-free guiding path.
After revision:  The main improvement is that the collision term in the penalty function is formulated by comparing the colliding trajectory with a collision-free guiding path.