Create Mubser_detection_test.cpp

an OpenNI version for detecting and mapping obstacles