Matthew Kelly, An Introduction to Trajectory Optimization: How to Do Your Own Direct Collocation, SIAM Review, Vol. 59, No. 4 (December 2017), pp. 849-904 ...