Преглед изворни кода

Added read scaled values in g

Korneliusz Jarzebski пре 11 година
родитељ
комит
041d338d36
2 измењених фајлова са 13 додато и 0 уклоњено
  1. 12 0
      MPU6050.cpp
  2. 1 0
      MPU6050.h

+ 12 - 0
MPU6050.cpp

@@ -379,6 +379,18 @@ Vector MPU6050::readNormalizeAccel(void)
     return na;
 }
 
+Vector MPU6050::readScaledAccel(void)
+{
+    readRawAccel();
+
+    na.XAxis = ra.XAxis * rangePerDigit;
+    na.YAxis = ra.YAxis * rangePerDigit;
+    na.ZAxis = ra.ZAxis * rangePerDigit;
+
+    return na;
+}
+
+
 Vector MPU6050::readRawGyro(void)
 {
     Wire.beginTransmission(MPU6050_ADDRESS);

+ 1 - 0
MPU6050.h

@@ -215,6 +215,7 @@ class MPU6050
 
 	Vector readRawAccel(void);
 	Vector readNormalizeAccel(void);
+	Vector readScaledAccel(void);
 
     private:
 	Vector ra, rg; // Raw vectors