Updated octomap/octovis to 1.6.0 release