Joinied Positioning and Control Model Based on Factor Graph Optimization (FGO) - View it on GitHub