diff options
author | Lorenz Meier <lm@inf.ethz.ch> | 2012-08-17 17:37:58 +0200 |
---|---|---|
committer | Lorenz Meier <lm@inf.ethz.ch> | 2012-08-17 17:37:58 +0200 |
commit | bce043a21b7f39f786755fa3118c2c5e25eb8a94 (patch) | |
tree | 4a3df548c5e70c33d03d1ad9a813c99ca2958a27 /apps/commander/commander.c | |
parent | 73286f3262b624ab62ce3f2d55e3521c1cb5f135 (diff) | |
download | px4-firmware-bce043a21b7f39f786755fa3118c2c5e25eb8a94.tar.gz px4-firmware-bce043a21b7f39f786755fa3118c2c5e25eb8a94.tar.bz2 px4-firmware-bce043a21b7f39f786755fa3118c2c5e25eb8a94.zip |
Fixed mag axis assignment, fixed mag calibration
Diffstat (limited to 'apps/commander/commander.c')
-rw-r--r-- | apps/commander/commander.c | 19 |
1 files changed, 16 insertions, 3 deletions
diff --git a/apps/commander/commander.c b/apps/commander/commander.c index e290c2140..47829ddf5 100644 --- a/apps/commander/commander.c +++ b/apps/commander/commander.c @@ -376,9 +376,22 @@ 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]); - mag_offset[1] = (max_avg[1] - min_avg[1]); - mag_offset[2] = (max_avg[2] - min_avg[2]); + + /** + * The offset is subtracted from the sensor values, so the result is the + * POSITIVE number that has to be subtracted from the sensor data + * to shift the center to zero + * + * offset = max - ((max - min) / 2.0f) + * + * which reduces to + * + * offset = (max + min) / 2.0f + */ + + mag_offset[0] = (max_avg[0] + min_avg[0]) / 2.0f; + mag_offset[1] = (max_avg[1] + min_avg[1]) / 2.0f; + mag_offset[2] = (max_avg[2] + min_avg[2]) / 2.0f; 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]; |