First try at getting a solvePnP camera matrix to work with OpenGL (ksimek's tutorial)