Implemented first Hangar-Service

Dependencies:   CalibrateMagneto QuaternionMath

Fork of SML2 by TobyRich GmbH

Revision:
40:8e852115fe55
Parent:
25:abb0f208e6a9
Child:
46:fd5a62296b12
--- a/Barometer.cpp	Tue May 19 14:18:30 2015 +0000
+++ b/Barometer.cpp	Tue May 26 11:28:37 2015 +0000
@@ -41,9 +41,13 @@
 
 Vector3 Barometer::read() {
     uint8_t buffer[6];
+    /*
     for (int i = 0; i < 6; i++)
         buffer[i] =  read_reg(0xF7 + i);
-
+    */
+    
+    read_reg(0xF7, buffer, sizeof buffer);
+    
     const uint32_t adc_P = ((buffer[0] << 16) | (buffer[1] << 8) | buffer[2]) >> 4;
     const uint32_t adc_T = ((buffer[3] << 16) | (buffer[4] << 8) | buffer[5]) >> 4;