mirror of
https://github.com/dragonpilot/dragonpilot.git
synced 2026-06-21 22:12:05 +08:00
need sqrtsd
This commit is contained in:
@@ -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]
|
||||
|
||||
Reference in New Issue
Block a user