Connect costmap to new pointclouds
Add coordinate frames for new cameras