A Trajectory Optimization Method with Global Yaw Parameterization - View it on GitHub