From e95662f505eb45f80036be63940d435e4b4871e1 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Thu, 16 Aug 2012 13:33:16 +0200 Subject: mag cal, scaling of throttle --- apps/commander/commander.c | 10 +++++----- 1 file changed, 5 insertions(+), 5 deletions(-) (limited to 'apps/commander/commander.c') diff --git a/apps/commander/commander.c b/apps/commander/commander.c index 19fc81f63..21bf91c61 100644 --- a/apps/commander/commander.c +++ b/apps/commander/commander.c @@ -306,8 +306,8 @@ void do_mag_calibration(int status_pub, struct vehicle_status_s *status) calibration_counter++; } else { /* any poll failure for 1s is a reason to abort */ - mavlink_log_info(mavlink_fd, "[commander] mag calibration aborted, please retry."); - break; + //mavlink_log_info(mavlink_fd, "[commander] mag calibration aborted, please retry."); + //break; } } @@ -376,9 +376,9 @@ void do_mag_calibration(int status_pub, struct vehicle_status_s *status) printf("\nFINAL:\nmag min: %d\t%d\t%d\nmag max: %d\t%d\t%d\n", (int)min_avg[0], (int)min_avg[1], (int)min_avg[2], (int)max_avg[0], (int)max_avg[1], (int)max_avg[2]); float mag_offset[3]; - mag_offset[0] = (max_avg[0] - min_avg[0])/2; - mag_offset[1] = (max_avg[1] - min_avg[1])/2; - mag_offset[2] = (max_avg[2] - min_avg[2])/2; + mag_offset[0] = (max_avg[0] - min_avg[0]); + mag_offset[1] = (max_avg[1] - min_avg[1]); + mag_offset[2] = (max_avg[2] - min_avg[2]); global_data_parameter_storage->pm.param_values[PARAM_SENSOR_MAG_XOFFSET] = mag_offset[0]; global_data_parameter_storage->pm.param_values[PARAM_SENSOR_MAG_YOFFSET] = mag_offset[1]; -- cgit v1.2.3