Implemented first Hangar-Service
Dependencies: CalibrateMagneto QuaternionMath
Fork of SML2 by
Magnetometer.cpp
- Committer:
- pvaibhav
- Date:
- 2015-01-23
- Revision:
- 4:e759b8c756da
- Child:
- 11:d21275e60ebb
File content as of revision 4:e759b8c756da:
#include "Magnetometer.h" #define DEBUG "BMX055-Mag" #include "Logger.h" Magnetometer::Magnetometer(I2C &i2c) : I2CPeripheral(i2c, 0x10 << 1 /* address */) { write_reg(0x4B, 0x83); // softreset and powermode=suspend wait_ms(3); // page 18 const uint8_t chip_id = read_reg(0x40); if (chip_id == 0x32) { INFO("Bosch Sensortec BMX055-Magneto ready"); } else { WARN("Bosch Sensortec BMX055-Magneto not found (chip ID=0x%02x, expected=0x32)", chip_id); } }