RAND modified kinect.cpp. Now working with Xtion as well