Integrate octomap

[jaredweiss]

issue #1 -- bring up octomap in launch file
issue #2 -- connect octomap to moveit
issue #3 - Bring up the robot self filter and make sure it works -- This makes sure the robot doesn't think it is in collision with octomap points that belong to it.