Collision avoidance groovy

This branch adds the collision avoidance feature to the pick and place demo.  Rather significant changes have been made to the pick_and_place package and some minor modifications on the robot urdf and moveit config generated package as well.