From 56a21aa99143922d030323892e2326073ca637b5 Mon Sep 17 00:00:00 2001
From: Nandan Tumu <10603428+nandantumu@users.noreply.github.com>
Date: Fri, 16 Feb 2018 16:09:34 -0500
Subject: [PATCH] Fixed calculations

---
 src/publish_vel_dist.py | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

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])