Merged several versions, plus removed unnecessary dependency to triangulate_point_cloud messages