fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-28 02:04:07 +08:00
Code Issues Packages Projects Releases Wiki Activity

ms4525 treat max temperature as an error

Browse Source
This commit is contained in:
Daniel Agar 2017-06-24 16:07:18 -04:00 committed by Lorenz Meier
parent f82e85f8ff
commit ca480ff868
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/drivers/meas_airspeed/meas_airspeed.cpp
View File

@ -210,6 +210,13 @@ MEASAirspeed::collect()
dp_raw = 0x3FFF & dp_raw;
dT_raw = (val[2] << 8) + val[3];
dT_raw = (0xFFE0 & dT_raw) >> 5;
// dT max is almost certainly an invalid reading
if (dT_raw == 2047) {
perf_count(_comms_errors);
return -EAGAIN;
}
float temperature = ((200.0f * dT_raw) / 2047) - 50;
// Calculate differential pressure. As its centered around 8000