mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-09-30 19:33:45 +08:00
need sqrtsd
old-commit-hash: bcbcd96d92e1f2f05e918f74e42799b15eb18d1a
This commit is contained in:
@@ -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]
|
||||||
|
|||||||
Reference in New Issue
Block a user