diff --git a/controller/controller.ino b/controller/controller.ino index f37e6d36ab2e65fc44d0d26e374c48c6e12a19b3..8850336457707d9bb47a32e886b6df8b3e7cb2a3 100644 --- a/controller/controller.ino +++ b/controller/controller.ino @@ -91,7 +91,7 @@ uint8_t gEsc_val = 0; // ESC angle (to use with the Servo l String gMode; // Mode of operation uint16_t gAngleOffset[] = { 0, 0, 1, 0 }; // Encoder offset (prevent wrap-around) uint16_t gMaxWingPos[] = MAX_WING_POS; // Encoder maximum recorder position - +int gStartTime; // Loop start time /******************************************************************************* ARDUINO SETUP @@ -142,6 +142,8 @@ void setup() { delay(1000); // Ensure proper initialization Serial.println("[INFO]: Setup OK, starting now..."); delay(500); + + gStartTime = millis(); } @@ -260,7 +262,7 @@ void SerialPrint(String mode, int potent, int esc_val, unsigned int wing_angles[ Serial.print("/*"); // Beginning of data stream Serial.print(mode); Serial.print(","); - Serial.print(millis() / 1000.0); + Serial.print((millis() - gStartTime) / 1000.0); Serial.print(","); Serial.print(potent * 5.0 / 1023.0); // Converts pot val into proper tension Serial.print(",");