Factor descent optimization for sparsification in graph SLAM
Optimizing costly functions with simple constraints: A limited-memory projected quasi-newton algorithm