collision contact tutorial

This code goes with the collision contact tutorial
http://moveit.ros.org/wiki/index.php/Groovy/InteractiveRobot/CollisionContact