Updated for MoveIt API changes