Adds ability to publish full octomap data at every frame that is reprojected into the local frame for comparison against stereo_bm.  Not yet fully tested.