fix(manipulation): use the captured robot state during planning (#3386)