need sqrtsd

old-commit-hash: bcbcd96d92
commatwo_master
Harald Schafer 5 years ago
parent bb112dd2f3
commit 83ea66cbfb
  1. 2
      selfdrive/locationd/locationd.py

@ -38,7 +38,7 @@ class Localizer():
def liveLocationMsg(self, time): def liveLocationMsg(self, time):
predicted_state = self.kf.x 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 = predicted_state[States.ECEF_POS]
fix_ecef_std = predicted_std[States.ECEF_POS_ERR] fix_ecef_std = predicted_std[States.ECEF_POS_ERR]

Loading…
Cancel
Save