Anson/Lander-Embedded
1
0
Fork 0
mirror of https://gitlab.com/lander-team/lander-cpp.git synced 2025-07-23 14:41:25 +00:00
Code Releases Activity

its angry

Browse Source
This commit is contained in:
bpmcgeeney
2021-11-08 11:19:06 -07:00
parent 995d856d08
commit cce451f069
2 changed files with 36 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files

46
include/teensy.h
View File

@@ -1,5 +1,4 @@
#include "Vehicle.h"
#include <Arduino.h>
#include <SD.h>
#include <SPI.h>
@@ -35,20 +34,43 @@ void initFile() {
}
Serial.println("Card initialized.");
// Delete any previous existing files
int i = 1;
Serial.print("simOut_" + String(i) + ".csv");
String fileName;
if (SD.exists("simOut.csv")) {
SD.remove("simOut.csv");
}
while (i > 0) {
fileName = "simOut_" + String(i) + ".csv";
// Open simOut.csv
dataFile = SD.open("simOut.csv", FILE_WRITE);
if (dataFile) {
Serial.println("File successfully opened!");
if (!SD.exists(fileName)) {
// Open simOut_i.csv
dataFile = SD.open(fileName, FILE_WRITE);
if (dataFile) {
Serial.println("File successfully opened!");
} else {
// if the file didn't open, print an error:
Serial.println("Error opening output file. \n\nABORTING SIMULATION");
teensyAbort();
}
i = 0;
} else {
i++;
}
}
} else {
// if the file didn't open, print an error:
Serial.println("Error opening simOut.csv. \n\nABORTING SIMULATION");
teensyAbort();
// Open simOut.csv
dataFile = SD.open("simOut.csv", FILE_WRITE);
if (dataFile) {
Serial.println("File successfully opened!");
} else {
// if the file didn't open, print an error:
Serial.println("Error opening output file. \n\nABORTING SIMULATION");
teensyAbort();
}
}
// File Header
@@ -176,7 +198,7 @@ void printSimResults(Vehicle &State) {
State.yaw = State.yaw * 180 / M_PI;
State.pitch = State.pitch * 180 / M_PI;
State.roll = State.roll * 180 / M_PI;
double landing_angle =
pow(State.yaw * State.yaw + State.pitch * State.pitch, .5);