Distributed trajectory estimation with privacy and communication constraints: A two-stage distributed Gauss-Seidel approach.