瀏覽代碼

Update MPU6050.cpp

Replaced constant 50 with samples
Dhananjay Tanpure 6 年之前
父節點
當前提交
e41f00ab81
共有 1 個文件被更改,包括 3 次插入3 次删除
  1. 3 3
      MPU6050.cpp

+ 3 - 3
MPU6050.cpp

@@ -569,9 +569,9 @@ void MPU6050::calibrateGyro(uint8_t samples)
     dg.ZAxis = sumZ / samples;
 
     // Calculate threshold vectors
-    th.XAxis = sqrt((sigmaX / 50) - (dg.XAxis * dg.XAxis));
-    th.YAxis = sqrt((sigmaY / 50) - (dg.YAxis * dg.YAxis));
-    th.ZAxis = sqrt((sigmaZ / 50) - (dg.ZAxis * dg.ZAxis));
+    th.XAxis = sqrt((sigmaX / samples) - (dg.XAxis * dg.XAxis));
+    th.YAxis = sqrt((sigmaY / samples) - (dg.YAxis * dg.YAxis));
+    th.ZAxis = sqrt((sigmaZ / samples) - (dg.ZAxis * dg.ZAxis));
 
     // If already set threshold, recalculate threshold vectors
     if (actualThreshold > 0)