Multiple object tracking opencv/c++ code help