Bremen Team - Hangar / SML2

Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

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);
    }
}