X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Ftests%2Fhostsim%2Fdisplay.py;h=a6c90e7d7526bcb8a1fb6f2ee82f1bd08f870ba8;hp=412f936f82c41d97972a088ea6bef2a1e25e7dac;hb=600ceb6d01bc9eae4aa4a3e53edd072c3778277f;hpb=2d718b9ca7b94bbc978a3c2d8f3a561c33f1f9c3

diff --git a/projects/microb2010/tests/hostsim/display.py b/projects/microb2010/tests/hostsim/display.py
index 412f936..a6c90e7 100644
--- a/projects/microb2010/tests/hostsim/display.py
+++ b/projects/microb2010/tests/hostsim/display.py
@@ -14,13 +14,25 @@ robot = box(pos = (0, 0, 150),
             size = (300,300,300),
             color = (1, 0, 0) )
 
+last_pos = robot.pos.x, robot.pos.y, robot.pos.z
+robot_trail = curve()
+max_trail = 500
+
 def set_robot(x, y, a):
-    global robot
+    global robot, last_pos
     robot.pos = (x - AREA_X/2, y - AREA_Y/2, 150)
     robot.axis = (math.cos(a*math.pi/180) * 300,
                   math.sin(a*math.pi/180) * 300,
                   0)
 
+    pos = robot.pos.x, robot.pos.y, robot.pos.z
+    if pos != last_pos:
+        robot_trail.append(pos)
+        last_pos = pos
+    robot_trail_l = len(robot_trail.pos)
+    if robot_trail_l> max_trail:
+        robot_trail.pos = robot_trail.pos[robot_trail_l - max_trail:]
+
 while True:
     try:
         os.mkfifo("/tmp/.robot")