Robotics Service Bus

'''

Created on Jan 16, 2013

@author: dklotz

'''

import logging

import threading

import time

import rst

import rstsandbox

from rst.vision.HeadObject_pb2 import HeadObject

from rst.vision.HeadObjects_pb2 import HeadObjects

shutDown = False

heads = HeadObjects()

def threadFunc():

    print("%s running." % threading.current_thread().name)

    while not shutDown:

        len(heads.head_objects)

        str(heads)

        str(heads.head_objects)

        for head in heads.head_objects:

            str(head)

            if head.HasField("age"):

                ageClass = head.age.decided_class

                len(ageClass)

    print("%s shutting down." % threading.current_thread().name)

if __name__ == '__main__':

    # Configure the logger

    FORMAT = '%(asctime)-15s %(levelname)s %(pathname)s:%(lineno)s -- %(message)s'

    logging.basicConfig(format=FORMAT)

    #logging.getLogger("rsb.transport.socket.BusConnection").setLevel(logging.DEBUG)

    # Fill in the test object(s)

    for i in xrange(5):

        head = heads.head_objects.add()

        head.tracking_info.id = i

        if i % 2 == 0:

            head.age.decided_class = "Test" + str(i)

    #print len(heads.head_objects), heads

    thread1 = threading.Thread(target=threadFunc)

    thread2 = threading.Thread(target=threadFunc)

    thread3 = threading.Thread(target=threadFunc)

    thread4 = threading.Thread(target=threadFunc)

    thread1.start()

    thread2.start()

    thread3.start()

    thread4.start()

    try:

        while True:

            time.sleep(1)

    finally:

        shutDown = True