mawei/StarPilot
1
0
Fork 0
mirror of https://github.com/firestar5683/StarPilot.git synced 2026-07-07 14:42:08 +08:00
Code Issues Packages Projects Releases Wiki Activity

needed for stability

Browse Source 
old-commit-hash: 00e05bc7d881feaf82529b4066789e41ee555c42
This commit is contained in:
Harald Schafer
2020-05-21 17:47:05 -07:00
parent 4061f1d530
commit 818695cfe7
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
selfdrive/locationd/models/live_kf.py
+1 -1
View File
@@ -168,7 +168,7 @@ class LiveKalman():
h_acc_sym = (gravity + acceleration)
h_phone_rot_sym = sp.Matrix([vroll, vpitch, vyaw])
speed = sp.sqrt(vx**2 + vy**2 + vz**2)
speed = sp.sqrt(vx**2 + vy**2 + vz**2 + 1e-6)
h_speed_sym = sp.Matrix([speed * odo_scale])
h_pos_sym = sp.Matrix([x, y, z])