Barrier Method for Inequality Constrained Factor Graph Optimization with Application to Model Predictive Control

Anas Abdelkarim, Holger Voos, Daniel Görges

Factor graphs have demonstrated remarkable efficiency for robotic perception tasks, particularly in localization and mapping applications. However, their application to optimal con…