import atexit
import sys
if sys.version_info[0] == 2:
    from Queue import Empty
else:
    from queue import Empty
from multiprocessing import Process, Queue
from rllab.sampler.utils import rollout
import numpy as np

__all__ = [
    'init_worker',
    'init_plot',
    'update_plot'
]

process = None
queue = None


def _worker_start():
    env = None
    policy = None
    max_length = None
    try:
        while True:
            msgs = {}
            # Only fetch the last message of each type
            while True:
                try:
                    msg = queue.get_nowait()
                    msgs[msg[0]] = msg[1:]
                except Empty:
                    break
            if 'stop' in msgs:
                break
            elif 'update' in msgs:
                env, policy = msgs['update']
                # env.start_viewer()
            elif 'demo' in msgs:
                param_values, max_length = msgs['demo']
                policy.set_param_values(param_values)
                rollout(env, policy, max_path_length=max_length, animated=True, speedup=5)
            else:
                if max_length:
                    rollout(env, policy, max_path_length=max_length, animated=True, speedup=5)
    except KeyboardInterrupt:
        pass


def _shutdown_worker():
    if process:
        queue.put(['stop'])
        queue.close()
        process.join()


def init_worker():
    print("####################init_worker")
    global process, queue
    queue = Queue()
    process = Process(target=_worker_start)
    process.start()
    atexit.register(_shutdown_worker)


def init_plot(env, policy):
    queue.put(['update', env, policy])


def update_plot(policy, max_length=np.inf):
    queue.put(['demo', policy.get_param_values(), max_length])

[((61, 12, 61, 19), 'multiprocessing.Queue', 'Queue', ({}, {}), '()', False, 'from multiprocessing import Process, Queue\n'), ((62, 14, 62, 43), 'multiprocessing.Process', 'Process', (), '', False, 'from multiprocessing import Process, Queue\n'), ((64, 4, 64, 37), 'atexit.register', 'atexit.register', ({(64, 20, 64, 36): '_shutdown_worker'}, {}), '(_shutdown_worker)', False, 'import atexit\n'), ((43, 16, 43, 90), 'rllab.sampler.utils.rollout', 'rollout', (), '', False, 'from rllab.sampler.utils import rollout\n'), ((46, 20, 46, 94), 'rllab.sampler.utils.rollout', 'rollout', (), '', False, 'from rllab.sampler.utils import rollout\n')]