diff --git a/include/teensy.h b/include/teensy.h index e414339..c02166e 100644 --- a/include/teensy.h +++ b/include/teensy.h @@ -98,7 +98,7 @@ void thrustInfo(Vehicle &State) { } else { State.burnElapsed = 2000; // arbitrary number to ensure we don't burn } - //Serial.println(abs(State.burnVelocity + State.vz)); + // Serial.println(abs(State.burnVelocity + State.vz)); if ((State.burnElapsed > 0.147) && (State.burnElapsed < 0.420)) { State.thrustFiring = true; @@ -138,58 +138,58 @@ void processTVC(Vehicle &State) { } void write2CSV(Vehicle &State) { - dataFile.print(State.time); + dataFile.print(String(State.time, 5)); dataFile.print(","); - dataFile.print(State.x); + dataFile.print(String(State.x, 5)); dataFile.print(","); - dataFile.print(State.y); + dataFile.print(String(State.y, 5)); dataFile.print(","); - dataFile.print(State.z); + dataFile.print(String(State.z, 5)); dataFile.print(","); - dataFile.print(State.vx); + dataFile.print(String(State.vx, 5)); dataFile.print(","); - dataFile.print(State.vy); + dataFile.print(String(State.vy, 5)); dataFile.print(","); - dataFile.print(State.vz); + dataFile.print(String(State.vz, 5)); dataFile.print(","); - dataFile.print(State.ax); + dataFile.print(String(State.ax, 5)); dataFile.print(","); - dataFile.print(State.ay); + dataFile.print(String(State.ay, 5)); dataFile.print(","); - dataFile.print(State.az); + dataFile.print(String(State.az, 5)); dataFile.print(","); - dataFile.print(State.yaw * 180.0 / M_PI); + dataFile.print(String(State.yaw * 180.0 / M_PI, 5)); dataFile.print(","); - dataFile.print(State.pitch * 180.0 / M_PI); + dataFile.print(String(State.pitch * 180.0 / M_PI, 5)); dataFile.print(","); - dataFile.print(State.roll * 180.0 / M_PI); + dataFile.print(String(State.roll * 180.0 / M_PI, 5)); dataFile.print(","); - dataFile.print(State.yawdot * 180.0 / M_PI); + dataFile.print(String(State.yawdot * 180.0 / M_PI, 5)); dataFile.print(","); - dataFile.print(State.pitchdot * 180.0 / M_PI); + dataFile.print(String(State.pitchdot * 180.0 / M_PI, 5)); dataFile.print(","); - dataFile.print(State.rolldot * 180.0 / M_PI); + dataFile.print(String(State.rolldot * 180.0 / M_PI, 5)); dataFile.print(","); - dataFile.print(State.xServoDegs); + dataFile.print(String(State.xServoDegs, 5)); dataFile.print(","); - dataFile.print(State.yServoDegs); + dataFile.print(String(State.yServoDegs, 5)); dataFile.print(","); - dataFile.print(State.thrustFiring); + dataFile.print(String(State.thrustFiring, 5)); dataFile.print(","); - dataFile.print(State.PIDx); + dataFile.print(String(State.PIDx, 5)); dataFile.print(","); - dataFile.print(State.PIDy); + dataFile.print(String(State.PIDy, 5)); dataFile.print(","); - dataFile.print(State.thrust); + dataFile.print(String(State.thrust, 5)); dataFile.print("\n"); }