Update kinectbvh.cpp