Optimal Vehicle Trajectory Planning for Static Obstacle Avoidance using Nonlinear Optimization