added octomap and octomap_ros dependencies
removed ros components from surface detection class in order to prepare it for unit testing.  Added moving least square smoothing step in for averaing small variations due to noise and calibration errors