cv2.imshow('Test Kinect Depth', kinect.frameDepth)
cv2.namedWindow('Test Kinect IR')
cv2.imshow('Test Kinect IR', kinect.frameInfrared)
np.set_printoptions(threshold=np.inf)
#print(kinect.csps1[100].z)
if (np.any((kinect.ids != None)) & np.any((Cam1.ids != None))):
ts = time.time() - startTime
print(ts)
print('\n')
# print(kinect.kinect.FD2[212][256])
KinXFilter.Processing(kinect.tvec[0][0][0])
x2 = 1000 * KinXFilter.average
print(x2)
print('\n')
KinYFilter.Processing(kinect.tvec[0][0][1])
y2 = 1000 * KinYFilter.average
print(y2)
print('\n')
KinZFilter.Processing(kinect.tvec[0][0][2])
z2 = 1000 * KinZFilter.average
print(z2)
print('\n')
KinPitchFilter.Processing(kinect.pitchx)
