Updated for OpenNI2