Online multi-object tracking - C++