mobile manipulation in unstructured environments : perception , planning , and execution .
STOMP: Stochastic trajectory optimization for motion planning