OpenNI2: Significant refactoring and fixing.