Kinect to Coordinate Mapping with help from Vitruvius