Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-05-29 02:38:07 +08:00
Code Issues Actions 30 Packages Projects Releases Wiki Activity

[python] fix natnet3 speed filter

Browse Source 
previously, only the last computed speed was return in the end,
regardless of the filter option (number of points to use)
This commit is contained in:
Gautier Hattenberger
2019-06-18 17:52:49 +02:00
committed by Freek van Tienen
parent 8f4b107ad2
commit 4d7045d6ff
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/ground_segment/python/natnet3.x/natnet2ivy.py
+6 -6
View File
@@ -114,15 +114,15 @@ def compute_velocity(ac_id):
dt = t2 - t1 dt = t2 - t1
if dt < 1e-5: if dt < 1e-5:
continue continue
vel[0] = (p2[0] - p1[0]) / dt vel[0] += (p2[0] - p1[0]) / dt
vel[1] = (p2[1] - p1[1]) / dt vel[1] += (p2[1] - p1[1]) / dt
vel[2] = (p2[2] - p1[2]) / dt vel[2] += (p2[2] - p1[2]) / dt
p1 = p2 p1 = p2
t1 = t2 t1 = t2
if nb > 0: if nb > 0:
vel[0] / nb vel[0] /= nb
vel[1] / nb vel[1] /= nb
vel[2] / nb vel[2] /= nb
return vel return vel
def receiveRigidBodyList( rigidBodyList, stamp ): def receiveRigidBodyList( rigidBodyList, stamp ):