#!/usr/bin/env python
import time
import openravepy
import scipy
from math import *
from environment_force_the_stream import *
from environment_force_the_counterstream import *
from environment_force_the_ray import *
from environment_periodic_force_the_hideout import *
from environment_periodic_force_triple_stream import *
from environment_periodic_force_crossroad_stream import *

if not __openravepy_build_doc__:
    from openravepy import *
    from numpy import *

if __name__ == "__main__":
    #env = EnvironmentTheStream()
    env = EnvironmentTheCounterStream()
    #env = EnvironmentTheRay()
    #env = EnvironmentTheHideout()
    #env = EnvironmentTripleStream()
    #env = EnvironmentCrossroadStream()

    while True:
            env.DisplayForces() 
            time.sleep(0.01)
    #h = env.env.drawarrow(array((0,0,0.3)),array((1,0,0.3)),linewidth=0.05,color=array((1,0,0)))

    raw_input('Enter any key to quit. ')
