Fixes to submeshes and publish_planning_scene