Update an EPnP solver class

I have a header file that I've built for an EPnP solver. The current header uses OpenCV, but quite an old build (around 2008). Because of it's age, and a few other requirements, I would like to remove all references to CV and replace them with standard STL.

The EPnP solver class and algorithm is already written. What's needed is the CV content to be replaced with relevant standard C++ (STL) code. Examples of what may need recreating:

CvMat
cvCreateMat()
cvMat()
cvmGet()
cvmSet()
cvInvert()
cvMulTransposed();
cvReleaseMat()
cvSolve()
cvSVD().

And any others I may have missed. I'm happy for these to be either recreated (or copied from CV), so long as the include <cv.h> and all dependencies are removed.

The aim is to eventually have a completely standard C++ header file, free from any external libraries. This won't be the final file my end, but it should be compilable for testing.

I can provide a testing program, with known results, if needed.