Distributed object based SLAM