Fixed calculations

ret15108 · Feb 16, 2018 · 56a21aa · 56a21aa
1 parent beaf3ed
commit 56a21aa
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/publish_vel_dist.py b/src/publish_vel_dist.py
@@ -54,7 +54,7 @@ def publishVelDist(msg, vmaint):
         map(lambda x: x*timedelt, accel)
         vmaint.velocity = [vmaint.velocity[i]+accel[i] for i in range(3)]
         map(lambda x: x*timedelt, accel)
-        vmaint.velocity = [vmaint.velocity[i]+accel[i] for i in range(3)]
+        vmaint.position = [vmaint.velocity[i]+accel[i] for i in range(3)]
         vmaint.time = ctime
         v = Vector3(vmaint.velocity[0],vmaint.velocity[1],vmaint.velocity[2])
         p = Vector3(vmaint.position[0],vmaint.position[1],vmaint.position[2])