Hey there!
If you are looking for some OpenCV CPP code that would be useful, I would recommend taking a look at Team 2053's TowerTracker which is a C++ port of Team 3019's TowerTracker which can be found here:
https://github.com/team2053tigertron...016/src/vision
Good luck!