restore the math in Kinect sensor