Taking the concepts from KinectDemo but rewriting them for C++ using OpenGL/GLUT