Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Committer:
pvaibhav
Date:
Wed Jan 14 15:44:34 2015 +0000
Revision:
1:c279bc3af90c
Child:
4:e759b8c756da
Barometer and accelerometer are alive

Who changed what in which revision?

UserRevisionLine numberNew contents of line
pvaibhav 1:c279bc3af90c 1 #include "Accelerometer.h"
pvaibhav 1:c279bc3af90c 2 #define DEBUG "BMX055-Acc"
pvaibhav 1:c279bc3af90c 3 #include "Logger.h"
pvaibhav 1:c279bc3af90c 4
pvaibhav 1:c279bc3af90c 5 Accelerometer::Accelerometer(I2C &i2c) : I2CPeripheral(i2c, 0x30 /* address */) {
pvaibhav 1:c279bc3af90c 6 write_reg(0x14, 0xB6); // reset
pvaibhav 1:c279bc3af90c 7 wait_ms(2); // XXX: not specified in datasheet, assuming.
pvaibhav 1:c279bc3af90c 8
pvaibhav 1:c279bc3af90c 9 const uint8_t chip_id = read_reg(0x00);
pvaibhav 1:c279bc3af90c 10 if (chip_id == 0xfa) {
pvaibhav 1:c279bc3af90c 11 INFO("Bosch Sensortec BMX055-Accel ready");
pvaibhav 1:c279bc3af90c 12 } else {
pvaibhav 1:c279bc3af90c 13 WARN("Bosch Sensortec BMX055-Accel not found (chip ID=0x%02x, expected=0x58)", chip_id);
pvaibhav 1:c279bc3af90c 14 }
pvaibhav 1:c279bc3af90c 15 }
pvaibhav 1:c279bc3af90c 16