661.69 STOMP (Stochastic Trajectory Optimization) 알고리즘