mirror of
https://github.com/okalachev/flix.git
synced 2026-01-10 21:16:50 +00:00
Simplify and improve acc calibration command output
This commit is contained in:
@@ -88,6 +88,7 @@ void calibrateAccel() {
|
|||||||
calibrateAccelOnce();
|
calibrateAccelOnce();
|
||||||
|
|
||||||
printIMUCal();
|
printIMUCal();
|
||||||
|
print("✓ Calibration done!\n");
|
||||||
configureIMU();
|
configureIMU();
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -113,9 +114,6 @@ void calibrateAccelOnce() {
|
|||||||
if (acc.x < accMin.x) accMin.x = acc.x;
|
if (acc.x < accMin.x) accMin.x = acc.x;
|
||||||
if (acc.y < accMin.y) accMin.y = acc.y;
|
if (acc.y < accMin.y) accMin.y = acc.y;
|
||||||
if (acc.z < accMin.z) accMin.z = acc.z;
|
if (acc.z < accMin.z) accMin.z = acc.z;
|
||||||
print("acc %f %f %f\n", acc.x, acc.y, acc.z);
|
|
||||||
print("max %f %f %f\n", accMax.x, accMax.y, accMax.z);
|
|
||||||
print("min %f %f %f\n", accMin.x, accMin.y, accMin.z);
|
|
||||||
// Compute scale and bias
|
// Compute scale and bias
|
||||||
accScale = (accMax - accMin) / 2 / ONE_G;
|
accScale = (accMax - accMin) / 2 / ONE_G;
|
||||||
accBias = (accMax + accMin) / 2;
|
accBias = (accMax + accMin) / 2;
|
||||||
|
|||||||
Reference in New Issue
Block a user