Implementation of multi-objects tracking

Compiling, to be tested...