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