Constrained Factor Graph Optimization for Robust Networked Pedestrian Inertial Navigation - View it on GitHub