Track papers across labs, topics, and trends.
Search papers, labs, and topics across Lattice.
This paper investigates the impact of optimization scheduling on the performance of a Smart Scheduled Hybrid (SSH) EKF-FGO framework for state estimation in robotics. By isolating optimization scheduling as a design variable, the authors demonstrate that it significantly affects the trade-off between estimation accuracy and computational cost. Simulation results reveal specific operating regimes where global optimization benefits can be maximized while minimizing computational expenses, underscoring the importance of this factor in hybrid state estimation systems.
Optimization scheduling can dramatically enhance state estimation efficiency, allowing for significant accuracy gains at reduced computational costs.
Reliable state estimation in robotics and control re quires balancing estimation accuracy against computational cost. While filtering-based methods such as the Extended Kalman Filter (EKF) provide efficient real-time updates, and optimisation based formulations using factor graphs improve global consistency, the role of optimisation scheduling is often treated implicitly rather than examined as an explicit design variable. This paper presents an experimental study that explicitly isolates optimisation scheduling using a Smart Scheduled Hybrid (SSH) EKF-FGO framework as a controlled testbed. By combining EKF-based state propagation with periodically invoked batch optimisation and holding solver structure and effort fixed, the main contribution of this work is the experimental characterisation of optimisation scheduling as an independent design variable governing the trade-off between intermediate estimation accuracy and computational cost. Simulation results in a planar SLAM environment show that scheduling strongly influences pre optimisation drift, transient error behaviour, and runtime. In particular, the results identify operating regimes in which most of the benefit of global optimisation can be retained at a fraction of the computational cost, highlighting optimisation scheduling as an under-explored yet critical consideration in hybrid state estimation systems.