SLAM algorithm using curves and points (University of Illinois at Urbana-Champaign)