From bcbcd96d92e1f2f05e918f74e42799b15eb18d1a Mon Sep 17 00:00:00 2001 From: Harald Schafer Date: Wed, 18 Mar 2020 15:23:59 -0700 Subject: [PATCH] need sqrtsd --- selfdrive/locationd/locationd.py | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/selfdrive/locationd/locationd.py b/selfdrive/locationd/locationd.py index 001f6d2e9f..0fe96cf5eb 100644 --- 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]