Tracking algorithm is implemented in tracker.cpp, trackingDemo.cp is just a test