Made slight changes to SteerAvoidObstacles.