diff options
| author | Lorenz Meier <lm@inf.ethz.ch> | 2012-08-28 08:50:23 +0200 |
|---|---|---|
| committer | Lorenz Meier <lm@inf.ethz.ch> | 2012-08-28 08:50:23 +0200 |
| commit | 2fca24f803e8ec88fee568337935921d3d92a754 (patch) | |
| tree | 5f85879ca9dad5afaa9e4436935400fa15084539 /apps/commander/commander.c | |
| parent | 0bc9cfd0f95ba0fc2d415e8136bb0110558872eb (diff) | |
| download | px4-firmware-2fca24f803e8ec88fee568337935921d3d92a754.tar.gz px4-firmware-2fca24f803e8ec88fee568337935921d3d92a754.tar.bz2 px4-firmware-2fca24f803e8ec88fee568337935921d3d92a754.zip | |
Added missing calibration announcement for gyro cal in commander
Diffstat (limited to 'apps/commander/commander.c')
| -rw-r--r-- | apps/commander/commander.c | 8 |
1 files changed, 8 insertions, 0 deletions
diff --git a/apps/commander/commander.c b/apps/commander/commander.c index 352cf68f6..6b2ddc8b4 100644 --- a/apps/commander/commander.c +++ b/apps/commander/commander.c @@ -446,6 +446,10 @@ void do_mag_calibration(int status_pub, struct vehicle_status_s *status) void do_gyro_calibration(int status_pub, struct vehicle_status_s *status) { + /* set to gyro calibration mode */ + status->preflight_gyro_calibration = true; + state_machine_publish(status_pub, status, mavlink_fd); + const int calibration_count = 3000; int sub_sensor_combined = orb_subscribe(ORB_ID(sensor_combined)); @@ -488,6 +492,10 @@ void do_gyro_calibration(int status_pub, struct vehicle_status_s *status) mavlink_log_critical(mavlink_fd, "[commander] Setting Z gyro offset failed!"); } + /* exit to gyro calibration mode */ + status->preflight_gyro_calibration = false; + state_machine_publish(status_pub, status, mavlink_fd); + char offset_output[50]; sprintf(offset_output, "[commander] gyro cal: x:%8.4f y:%8.4f z:%8.4f", (double)gyro_offset[0], (double)gyro_offset[1], (double)gyro_offset[2]); mavlink_log_info(mavlink_fd, offset_output); |