Fix submodules and test_slam_layout