I've done some projects like this, i've worked with OpenCV for 2 years. I can do it in 3 days, I can make you in python, You're gonna understand the Source Code, I'll comment all the code for you and I'll create another version what uses my new Algorithm