Progressed with OpenNI2 C wrappers