add Regrab to RobotBase::SetNonCollidingConfiguration