Final Version of the ACS Controller #367
@ -397,6 +397,7 @@ void SensorProcessing::processSus(
|
||||
for (uint8_t i = 0; i < 3; i++) {
|
||||
susVecTotDerivative[i] = (susVecTot[i] - savedSusVecTot[i]) / timeDiff;
|
||||
savedSusVecTot[i] = susVecTot[i];
|
||||
susVecTotDerivativeValid = true;
|
||||
}
|
||||
}
|
||||
timeOfSavedSusDirEst = timeOfSusMeasurement;
|
||||
|
Loading…
Reference in New Issue
Block a user