File size: 777 Bytes
7142654 | 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 | import time
def main():
import zmq
port = "5000"
context = zmq.Context()
socket = context.socket(zmq.SUB)
print "Collecting head pose updates..."
socket.connect ("tcp://localhost:%s" % port)
topic_filter = "HeadPose:"
socket.setsockopt(zmq.SUBSCRIBE, topic_filter)
while True:
head_pose = socket.recv()
head_pose = head_pose[9:].split(',')
X = float(head_pose[0])
Y = float(head_pose[1])
Z = float(head_pose[2])
pitch = float(head_pose[3])
yaw = float(head_pose[4])
roll = float(head_pose[5])
print 'X: %.1f, Y: %.1f, Z:%.1f, pitch: %.1f, yaw: %.1f, roll: %.1f' % (X, Y, Z, pitch, yaw, roll)
time.sleep(0.01)
if __name__ == '__main__':
main()
|