Bremen Team - Hangar / SML2

Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Magnetometer.cpp@4:e759b8c756da, 2015-01-23 (annotated)

Committer:
pvaibhav
Date:
Fri Jan 23 13:00:46 2015 +0000
Revision:
4:e759b8c756da
Child:
11:d21275e60ebb
Added stub drivers for magneto and gyro

Who changed what in which revision?

UserRevisionLine numberNew contents of line
pvaibhav 4:e759b8c756da 1 #include "Magnetometer.h"
pvaibhav 4:e759b8c756da 2 #define DEBUG "BMX055-Mag"
pvaibhav 4:e759b8c756da 3 #include "Logger.h"
pvaibhav 4:e759b8c756da 4
pvaibhav 4:e759b8c756da 5 Magnetometer::Magnetometer(I2C &i2c) : I2CPeripheral(i2c, 0x10 << 1 /* address */) {
pvaibhav 4:e759b8c756da 6 write_reg(0x4B, 0x83); // softreset and powermode=suspend
pvaibhav 4:e759b8c756da 7 wait_ms(3); // page 18
pvaibhav 4:e759b8c756da 8
pvaibhav 4:e759b8c756da 9 const uint8_t chip_id = read_reg(0x40);
pvaibhav 4:e759b8c756da 10 if (chip_id == 0x32) {
pvaibhav 4:e759b8c756da 11 INFO("Bosch Sensortec BMX055-Magneto ready");
pvaibhav 4:e759b8c756da 12 } else {
pvaibhav 4:e759b8c756da 13 WARN("Bosch Sensortec BMX055-Magneto not found (chip ID=0x%02x, expected=0x32)", chip_id);
pvaibhav 4:e759b8c756da 14 }
pvaibhav 4:e759b8c756da 15 }
pvaibhav 4:e759b8c756da 16