Bremen Team - Hangar / SML2

Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Accelerometer.cpp

Committer:
pvaibhav
Date:
2015-01-14
Revision:
1:c279bc3af90c
Child:
4:e759b8c756da

File content as of revision 1:c279bc3af90c:

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