diff options
| author | Anton Babushkin <anton.babushkin@me.com> | 2013-07-17 19:54:47 +0400 |
|---|---|---|
| committer | Anton Babushkin <anton.babushkin@me.com> | 2013-07-17 19:54:47 +0400 |
| commit | c4248c055f098e775e57a7f0ea6ffda49e930b01 (patch) | |
| tree | c7a510f56cdb83f2173443e3c0080dc971c8747a /src | |
| parent | c6d184e29dbf906c1dfbebe0d7f353653db8cc7e (diff) | |
| download | px4-firmware-c4248c055f098e775e57a7f0ea6ffda49e930b01.tar.gz px4-firmware-c4248c055f098e775e57a7f0ea6ffda49e930b01.tar.bz2 px4-firmware-c4248c055f098e775e57a7f0ea6ffda49e930b01.zip | |
position_estimator_inav: minor fixes
Diffstat (limited to 'src')
| -rw-r--r-- | src/modules/position_estimator_inav/position_estimator_inav_main.c | 4 |
1 files changed, 2 insertions, 2 deletions
diff --git a/src/modules/position_estimator_inav/position_estimator_inav_main.c b/src/modules/position_estimator_inav/position_estimator_inav_main.c index 3b0fbd782..a9bc09e0d 100644 --- a/src/modules/position_estimator_inav/position_estimator_inav_main.c +++ b/src/modules/position_estimator_inav/position_estimator_inav_main.c @@ -115,6 +115,7 @@ int position_estimator_inav_main(int argc, char *argv[]) exit(0); } + verbose_mode = false; if (argc > 1) if (!strcmp(argv[2], "-v")) verbose_mode = true; @@ -379,10 +380,9 @@ int position_estimator_inav_thread_main(int argc, char *argv[]) } } - accel_NED[2] += CONSTANTS_ONE_G; accel_corr[0] = accel_NED[0] - x_est[2]; accel_corr[1] = accel_NED[1] - y_est[2]; - accel_corr[2] = accel_NED[2] - z_est[2]; + accel_corr[2] = accel_NED[2] + CONSTANTS_ONE_G - z_est[2]; } else { memset(accel_corr, 0, sizeof(accel_corr)); |