Development of a vehicle dynamics controller for obstacle avoidance