need sqrtsd

5 years ago · bcbcd96d92
parent ee7234485b
commit bcbcd96d92
1 changed files with 1 additions and 1 deletions
--- a/selfdrive/locationd/locationd.py
+++ b/selfdrive/locationd/locationd.py
@ -38,7 +38,7 @@ class Localizer():

  def liveLocationMsg(self, time):
    predicted_state = self.kf.x
-    predicted_std = np.diagonal(self.kf.P)
+    predicted_std = np.sqrt(np.diagonal(self.kf.P))

    fix_ecef = predicted_state[States.ECEF_POS]
    fix_ecef_std = predicted_std[States.ECEF_POS_ERR]