Add testing measuring distance with kinect