Implemented first Hangar-Service
Dependencies: CalibrateMagneto QuaternionMath
Fork of SML2 by
Diff: Accelerometer.cpp
- Revision:
- 1:c279bc3af90c
- Child:
- 4:e759b8c756da
diff -r 943820483318 -r c279bc3af90c Accelerometer.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Accelerometer.cpp Wed Jan 14 15:44:34 2015 +0000 @@ -0,0 +1,16 @@ +#include "Accelerometer.h" +#define DEBUG "BMX055-Acc" +#include "Logger.h" + +Accelerometer::Accelerometer(I2C &i2c) : I2CPeripheral(i2c, 0x30 /* address */) { + write_reg(0x14, 0xB6); // reset + wait_ms(2); // XXX: not specified in datasheet, assuming. + + const uint8_t chip_id = read_reg(0x00); + if (chip_id == 0xfa) { + INFO("Bosch Sensortec BMX055-Accel ready"); + } else { + WARN("Bosch Sensortec BMX055-Accel not found (chip ID=0x%02x, expected=0x58)", chip_id); + } +} +