Gripper and behavior tree functionality
This adds many improvements and small changes to the advanced CoSTAR functionality:
- Parallel-all nodes. These execute all children in parallel and succeed when all children succeed.
- Repeat nodes. They now fail properly if a child inside fails as well.
- Robotiq gripper predicates.
- Working predicate tests for object class information.