added point cloud pub to PTAM and tested it with octomap, in the middle of writing a path following controller for moveit