Gradient Based Trajectory Optimization