fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

position_estimator_inav: minor fixes

Browse Source
This commit is contained in:
Anton Babushkin 2013-07-17 19:54:47 +04:00
parent c6d184e29d
commit c4248c055f
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/position_estimator_inav/position_estimator_inav_main.c
View File

@ -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));