Refactoring the code. Fixed the extrinsic and intrinsic camera matrices. I can plot an object over the calibration patterns now.
Changed the controls, some more refactoring and bugfixes. Must fix the bug that, sometimes when a button is pressed, the sphere disapears.