More progress with OpenNI2 wrapper