Stroring history now. Next: test it.
Added functionality for visualizing both filtered and observed people. Filtering code added in and compiles, it throws a cv::esception when run. Get rid of opencv dependence perhaps
The bug was an uninitialized variable. Fixed, filtering and new visualization works.