First Commit. SLAM with initial marker alignment.