diff options
author | James Goppert <james.goppert@gmail.com> | 2013-01-15 13:21:13 -0500 |
---|---|---|
committer | James Goppert <james.goppert@gmail.com> | 2013-01-15 13:21:13 -0500 |
commit | 68b92cd4fc2c4df3de15ef19e723edb67a108ea0 (patch) | |
tree | 2e14e4051e66e2b6b81de567900959847fccddc2 /apps/examples/kalman_demo | |
parent | 9cf3d51aec4e73f626cfdea29b19bdfe80eea384 (diff) | |
download | px4-firmware-68b92cd4fc2c4df3de15ef19e723edb67a108ea0.tar.gz px4-firmware-68b92cd4fc2c4df3de15ef19e723edb67a108ea0.tar.bz2 px4-firmware-68b92cd4fc2c4df3de15ef19e723edb67a108ea0.zip |
Slowed HIL status updates. Also prevented posCor. when gps not init.
Diffstat (limited to 'apps/examples/kalman_demo')
-rw-r--r-- | apps/examples/kalman_demo/KalmanNav.cpp | 8 |
1 files changed, 6 insertions, 2 deletions
diff --git a/apps/examples/kalman_demo/KalmanNav.cpp b/apps/examples/kalman_demo/KalmanNav.cpp index 918dfd9df..38cdb6ca0 100644 --- a/apps/examples/kalman_demo/KalmanNav.cpp +++ b/apps/examples/kalman_demo/KalmanNav.cpp @@ -239,9 +239,10 @@ void KalmanNav::update() } // output - if (newTimeStamp - _outTimeStamp > 1e6) { // 1 Hz + if (newTimeStamp - _outTimeStamp > 10e6) { // 0.1 Hz _outTimeStamp = newTimeStamp; - printf("nav: %4d Hz, misses fast: %4d slow: %4d\n", _navFrames, _missFast, _missSlow); + printf("nav: %4d Hz, misses fast: %4d slow: %4d\n", + _navFrames/10, _missFast/10, _missSlow/10); _navFrames = 0; _missFast = 0; _missSlow = 0; @@ -616,6 +617,9 @@ void KalmanNav::correctAtt() void KalmanNav::correctPos() { using namespace math; + + if (!_positionInitialized) return; + Vector y(5); y(0) = _gps.vel_n - vN; y(1) = _gps.vel_e - vE; |