add property for Kalman state

2018-01-12 11:07:07 +08:00 · 2018-01-12 11:07:07 +08:00 · cc86a4de49
commit cc86a4de49
parent 4bcb526fd9
1 changed files with 3 additions and 0 deletions
--- a/stabilizer.py
+++ b/stabilizer.py
@ -78,6 +78,9 @@ class Stabilizer:
        # Correct according to mesurement
        self.filter.correct(self.measurement)

+        # Update state value.
+        self.state = self.filter.statePost
+
    def set_q_r(self, cov_process=0.1, cov_measure=0.001):
        """Set new value for processNoiseCov and measurementNoiseCov."""
        if self.measure_num == 1: