Stochastic Trajectory Optimization for Motion Planning (STOMP) - View it on GitHub