Wen Sun, Jur van den Berg, Ron Alterovitz: Stochastic Extended LQR for Optimization-Based Motion Planning Under Uncertainty. IEEE Trans Autom. Sci. Eng. 13(2): 437-447 (2016)