diff --git a/src/publish_vel_dist.py b/src/publish_vel_dist.py
index bbe976a..e82f536 100644
--- 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])