diff --git a/libraries/AP_Airspeed/AP_Airspeed_MS5525.cpp b/libraries/AP_Airspeed/AP_Airspeed_MS5525.cpp index 75f0315c39..eccb9f8d83 100644 --- a/libraries/AP_Airspeed/AP_Airspeed_MS5525.cpp +++ b/libraries/AP_Airspeed/AP_Airspeed_MS5525.cpp @@ -18,12 +18,14 @@ */ #include "AP_Airspeed_MS5525.h" +#include +#include + #include #include #include +#include #include -#include -#include extern const AP_HAL::HAL &hal; @@ -140,9 +142,12 @@ bool AP_Airspeed_MS5525::read_prom(void) bool all_zero = true; for (uint8_t i = 0; i < 8; i++) { - if (!dev->read_uint16_be(REG_PROM_BASE+i*2, prom[i])) { + be16_t val; + if (!dev->read_registers(REG_PROM_BASE+i*2, (uint8_t *) &val, + sizeof(uint16_t))) { return false; } + prom[i] = be16toh(val); if (prom[i] != 0) { all_zero = false; }