Issue raised by @SteveMacenski (afaik): At the moment the occupancy grid is created from laser scan data aligned to the VSLAM coordinate system. Laser scan segments are connected to camera key frames ...