Updated octomap/octovis to 1.6 beta for hydro