Finished migrating to latest MoveIt API changes