Modular architecture for asynchronous late-fusion of objects

Abstract

Systems and methods for asynchronous late-fusion of measurements. State information and intermediate values may be calculated as measurements arrive and are stored. When late sensor measurements arrive out of the temporal order in which the measurements were generated, the late measurements are stored in temporal order rather than the order in which measurements arrive. State information is then recalculated to account for the late-arriving sensor measurement, with state outputs propagated forward in temporal order using the previously computed intermediate values to speed up computation. In this manner, more accurate revised state information is efficiently generated, accounting for any late-arriving measurements. This modular processing framework also enables sensors to be added or changed, which may cause measurements to arrive asynchronously, without having to reprogram the processing framework.