Algorithms for Global Positioning by Gilbert Strang