Update openni_listener.cpp