diff options
| author | Andrew Tridgell <tridge@samba.org> | 2014-01-07 11:37:40 +0800 |
|---|---|---|
| committer | Lorenz Meier <lm@inf.ethz.ch> | 2014-01-07 09:33:10 +0100 |
| commit | 1f564a95ee89278b3e4eea6c2d4ded378b71542c (patch) | |
| tree | 42754ecd526bb7971be7521c38a46d40b4390829 /src/drivers/meas_airspeed | |
| parent | d4d2571161530848f2a4ac153f2529ab50ec4fcc (diff) | |
| download | px4-firmware-1f564a95ee89278b3e4eea6c2d4ded378b71542c.tar.gz px4-firmware-1f564a95ee89278b3e4eea6c2d4ded378b71542c.tar.bz2 px4-firmware-1f564a95ee89278b3e4eea6c2d4ded378b71542c.zip | |
meas_airspeed: avoid trivial dependency on math lib
including the math lib adds a huge amount to flash usage
Diffstat (limited to 'src/drivers/meas_airspeed')
| -rw-r--r-- | src/drivers/meas_airspeed/meas_airspeed.cpp | 4 |
1 files changed, 3 insertions, 1 deletions
diff --git a/src/drivers/meas_airspeed/meas_airspeed.cpp b/src/drivers/meas_airspeed/meas_airspeed.cpp index 3cd6d6720..a95c4576b 100644 --- a/src/drivers/meas_airspeed/meas_airspeed.cpp +++ b/src/drivers/meas_airspeed/meas_airspeed.cpp @@ -198,7 +198,9 @@ MEASAirspeed::collect() // uint16_t diff_press_pa = abs(dp_raw - (16384 / 2.0f)); const float P_min = -1.0f; const float P_max = 1.0f; - float diff_press_pa = math::max(0.0f, fabsf( ( ((float)dp_raw - 0.1f*16383.0f) * (P_max-P_min)/(0.8f*16383.0f) + P_min) * 6894.8f) - _diff_pres_offset); + float diff_press_pa = fabsf( ( ((float)dp_raw - 0.1f*16383.0f) * (P_max-P_min)/(0.8f*16383.0f) + P_min) * 6894.8f) - _diff_pres_offset; + if (diff_press_pa < 0.0f) + diff_press_pa = 0.0f; struct differential_pressure_s report; |