private Point3D convertJointPosition(CameraSpacePoint position) { return new Point3D(position.X, position.Y, position.Z); }