code
2011_icra_STOMP: Stochastic trajectory optimization for motion planning - matlab implementation
title