1
0
mirror of https://gitlab.com/lander-team/lander-cpp.git synced 2025-08-02 11:31:34 +00:00

More robust gimbal test function, delay based on step size of Sim

This commit is contained in:
bpmcgeeney
2021-11-14 17:10:58 -07:00
parent e6f7e4c160
commit 5a99508761
3 changed files with 19 additions and 5 deletions

View File

@@ -105,17 +105,18 @@ void loop() {
if ((State.z < 0.0) && (State.thrustFiring == 2)) {
printSimResults(State);
Serial.println("Run duration:" + String(micros() - initTime) + " us");
Serial.println("Run duration:" + String((micros() - initTime) / 1000000.0) +
" seconds");
closeFile();
delay(3000);
Serial.println("SUCCESS");
Serial.println("Aborting Sim");
Serial.println("Exiting Sim");
teensyAbort();
}
delay(20.0 - ((micros() - last) / 1000.0));
delay(State.stepSize - ((micros() - last) / 1000.0));
}
void init_loadCells() {