Vehicle-Dynamics-Conscious Obstacle Avoidance Algorithm