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