[added]Solution for SLAM expansion with landmarks