Showing the changes to interface/src/SerialInterface.cpp (1 of 2 files). Show all
Unified · Split
| @@ -249,6 +249,8 @@ void SerialInterface::readData(float deltaTime) { · 248 unmodified lines | ||
| 249 | 249 | _angularAccelToLinearAccel * angularAcceleration; |
| 250 | 250 | glm::vec3 error = _estimatedAcceleration - predictedAcceleration; |
| 251 | 251 | |
| 252 | + printLog("error %g\n", glm::length(error)); | |
| 253 | + | |
| 252 | 254 | // adjust according to error in each dimension, in proportion to input magnitudes |
| 253 | 255 | for (int i = 0; i < 3; i++) { |
| 254 | 256 | if (fabsf(error[i]) < EPSILON) { |