aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Airspeed: MS5525: use common macros to deal with endianness

Browse Source 
Instead of calling a special method in the device, just use be16toh()
which is implemented for all platforms in our special sparse-endian.h
file. It has the advantage of using a special type for different
endianness and makes no assumption we are running on LE.
This commit is contained in:
Lucas De Marchi 2017-01-13 09:28:06 -08:00
parent 14519e90ff
commit f6a4a4dbe8
1 changed files with 8 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
libraries/AP_Airspeed/AP_Airspeed_MS5525.cpp
View File

@ -18,12 +18,14 @@
*/
#include "AP_Airspeed_MS5525.h"
#include <stdio.h>
#include <utility>
#include <AP_Common/AP_Common.h>
#include <AP_HAL/AP_HAL.h>
#include <AP_HAL/I2CDevice.h>
#include <AP_HAL/utility/sparse-endian.h>
#include <AP_Math/AP_Math.h>
#include <stdio.h>
#include <utility>
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;
}