Simplify and improve acc calibration command output

This commit is contained in:
Oleg Kalachev 2025-03-29 01:05:55 +03:00
parent a8fe1324c3
commit 3a61dca102

View File

@ -88,6 +88,7 @@ void calibrateAccel() {
calibrateAccelOnce();
printIMUCal();
print("✓ Calibration done!\n");
configureIMU();
}
@ -113,9 +114,6 @@ void calibrateAccelOnce() {
if (acc.x < accMin.x) accMin.x = acc.x;
if (acc.y < accMin.y) accMin.y = acc.y;
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
accScale = (accMax - accMin) / 2 / ONE_G;
accBias = (accMax + accMin) / 2;