Anson/Lander-Embedded
1
0
Fork 0
mirror of https://gitlab.com/lander-team/lander-cpp.git synced 2025-06-16 07:06:51 +00:00
Code Releases Activity

outfile now has more precision

Browse Source
This commit is contained in:
Anson Biggs 2021-11-10 14:42:47 -07:00
parent 87fb8f8621
commit f0577a8fce
1 changed files with 23 additions and 23 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

46
include/teensy.h
View File

@ -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");
}