diff options
author | Simon Wilks <sjwilks@gmail.com> | 2013-04-19 16:20:40 +0200 |
---|---|---|
committer | Simon Wilks <sjwilks@gmail.com> | 2013-04-19 16:20:40 +0200 |
commit | df6976c8d640b395220d46f5b1fd7ecfc8ae3e04 (patch) | |
tree | 6c701f76d8b7bd67d6be6ebcd0eea26b28a486ff /apps/commander/commander.c | |
parent | c5a453cd18949d2d4673c0b343e22c22a8d2854d (diff) | |
download | px4-firmware-df6976c8d640b395220d46f5b1fd7ecfc8ae3e04.tar.gz px4-firmware-df6976c8d640b395220d46f5b1fd7ecfc8ae3e04.tar.bz2 px4-firmware-df6976c8d640b395220d46f5b1fd7ecfc8ae3e04.zip |
Split diff pressure and airspeed.
Diffstat (limited to 'apps/commander/commander.c')
-rw-r--r-- | apps/commander/commander.c | 10 |
1 files changed, 5 insertions, 5 deletions
diff --git a/apps/commander/commander.c b/apps/commander/commander.c index 7c0a25f86..fcfffcfef 100644 --- a/apps/commander/commander.c +++ b/apps/commander/commander.c @@ -801,7 +801,7 @@ void do_airspeed_calibration(int status_pub, struct vehicle_status_s *status) struct differential_pressure_s differential_pressure; int calibration_counter = 0; - float airspeed_offset = 0.0f; + float diff_pres_offset = 0.0f; while (calibration_counter < calibration_count) { @@ -812,7 +812,7 @@ void do_airspeed_calibration(int status_pub, struct vehicle_status_s *status) if (poll_ret) { orb_copy(ORB_ID(differential_pressure), sub_differential_pressure, &differential_pressure); - airspeed_offset += differential_pressure.voltage; + diff_pres_offset += differential_pressure.differential_pressure_pa; calibration_counter++; } else if (poll_ret == 0) { @@ -822,11 +822,11 @@ void do_airspeed_calibration(int status_pub, struct vehicle_status_s *status) } } - airspeed_offset = airspeed_offset / calibration_count; + diff_pres_offset = diff_pres_offset / calibration_count; - if (isfinite(airspeed_offset)) { + if (isfinite(diff_pres_offset)) { - if (param_set(param_find("SENS_VAIR_OFF"), &(airspeed_offset))) { + if (param_set(param_find("SENS_VAIR_OFF"), &(diff_pres_offset))) { mavlink_log_critical(mavlink_fd, "Setting offs failed!"); } |