From acf37e4b6562eceeae000fc89cf4058b31f6446d Mon Sep 17 00:00:00 2001 From: Anson Biggs Date: Mon, 20 Sep 2021 22:03:04 +0000 Subject: [PATCH 1/3] Revert "Resolved #7 - added inputs.csv for initial conditions" This reverts commit ee67077664c5f25c4b0b4b0f31f0dbb5f98a1d52 --- matlabHelpers/simPlot.m | 6 +-- src/main.cpp | 88 ++++++++++++++++------------------------- 2 files changed, 37 insertions(+), 57 deletions(-) diff --git a/matlabHelpers/simPlot.m b/matlabHelpers/simPlot.m index f15e1c6..047c0cb 100644 --- a/matlabHelpers/simPlot.m +++ b/matlabHelpers/simPlot.m @@ -48,7 +48,7 @@ title('Altitude vs Time') xlabel('Time (s)') ylabel('Altitude (m)') ylim([0 z(1)+5]) -%saveas(gcf,'outputs/Accel-Vel-Alt vs Time.png') +saveas(gcf,'outputs/Accel-Vel-Alt vs Time.png') figure(2) @@ -72,7 +72,7 @@ plot(t, rolldot) title('Angular Velocity vs Time') xlabel('Time (ms)') ylabel('Angular Velocity (deg/s)') -%saveas(gcf,'outputs/Euler Angles vs Time.png') +saveas(gcf,'outputs/Euler Angles vs Time.png') legend("yawdot", "pitchdot", "rolldot") figure(3) @@ -90,4 +90,4 @@ plot(t, Servo2) title('Servo 2 Position vs Time') xlabel('Time (ms)') ylabel('Servo 2 Position (rad)') -%saveas(gcf,'outputs/Servo Position vs Time.png') +saveas(gcf,'outputs/Servo Position vs Time.png') diff --git a/src/main.cpp b/src/main.cpp index c1a7562..50c2e3e 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -3,10 +3,7 @@ #include #include #include -#include -#include // std::runtime_error #include -#include #include "Vehicle.h" #include "sim.h" @@ -17,67 +14,50 @@ int main() { Vehicle State; Vehicle PrevState; - // Create an input filestream - std::ifstream inFile("input.csv"); - - // Make sure the file is open - if (!inFile.is_open()) - throw std::runtime_error("Could not open file"); - - std::vector varValueVec = std::vector(17, 0.0); - std::string varName, varValue, varUnits; - - for (int i; i < 17; i++) { - std::getline(inFile, varName, ','); - std::getline(inFile, varValue, ','); - varValueVec[i] = stod(varValue); - std::getline(inFile, varUnits); - } - // Initial Velocity - State.vx = varValueVec[0]; // [m/s] - State.vy = varValueVec[1]; // [m/s] - State.vz = varValueVec[2]; // [m/s] + State.vx = 0; // [m/s] + State.vy = 0; // [m/s] + State.vz = 0; // [m/s] - // Initial YPR - State.yaw = varValueVec[3] * M_PI / 180; // [rad] - State.pitch = varValueVec[4] * M_PI / 180; // [rad] - State.roll = varValueVec[5] * M_PI / 180; // [rad] + // Initial YPR + State.yaw = 10 * M_PI / 180; // [rad] + State.pitch = 5 * M_PI / 180; // [rad] + State.roll = 0 * M_PI / 180; // [rad] - // Initial YPRdot - State.yawdot = varValueVec[6] * M_PI / 180; // [rad/s] - State.pitchdot = varValueVec[7] * M_PI / 180; // [rad/s] - State.rolldot = varValueVec[8] * M_PI / 180; // [rad/s] + // Initial YPRdot + State.yawdot = 1 * M_PI / 180; // [rad/s] + State.pitchdot = -1 * M_PI / 180; // [rad/s] + State.rolldot = 0 * M_PI / 180; // [rad/s] - // Servo Limitation - State.maxServo = varValueVec[9]; // [degs] + // Servo Limitation + State.maxServo = 15; // [degs] - // Vehicle Properties - State.massInitial = varValueVec[10]; // [kg] - State.vehicleHeight = varValueVec[13]; // [m] - State.vehicleRadius = varValueVec[14]; // [m] - State.momentArm = varValueVec[15]; // [m] + // Vehicle Properties + State.massInitial = 1.2; // [kg] + State.vehicleHeight = 0.5318; // [m] + State.vehicleRadius = 0.05105; // [m] + State.momentArm = 0.145; // [m] - // Sim Step Size - State.stepSize = varValueVec[16]; // [ms] + // Sim Step Size + State.stepSize = 1; // [ms] - // Other Properties - State.burntime = varValueVec[12]; // [s] - State.massPropellant = varValueVec[11]; // [kg] - State.massBurnout = State.massInitial - State.massPropellant; // [kg] - State.mdot = State.massPropellant / State.burntime; // [kg/s] - State.mass = State.massInitial; // [kg] - State.burnElapsed = 2000; // [s] - PrevState.thrust = 0; // [N] + // Other Properties + State.massPropellant = 0.06; // [kg] + State.massBurnout = State.massInitial - State.massPropellant; // [kg] + State.burntime = 3.45 - 0.148; // [s] + State.mdot = State.massPropellant / State.burntime; // [kg/s] + State.mass = State.massInitial; // [kg] + State.burnElapsed = 2000; // [s] + PrevState.thrust = 0; // [N] - bool outcome = sim(State, PrevState); + bool outcome = sim(State, PrevState); - std::cout << "Finished" - << "\n"; + std::cout << "Finished" + << "\n"; - if (outcome == 1) { - std::cout << "Sim Result = Success!"; - return 0; + if (outcome == 1) { + std::cout << "Sim Result = Success!"; + return 0; } else if (outcome == 0) { std::cout << "Sim Result = Failed!"; // return 1; Until I figure out how to make CI/CD continue even when run From 11b7b414693387bf373bf8267345303023bf51ff Mon Sep 17 00:00:00 2001 From: Anson Biggs Date: Mon, 20 Sep 2021 22:16:58 +0000 Subject: [PATCH 2/3] Delete input.csv --- input.csv | 17 ----------------- 1 file changed, 17 deletions(-) delete mode 100644 input.csv diff --git a/input.csv b/input.csv deleted file mode 100644 index 85abb23..0000000 --- a/input.csv +++ /dev/null @@ -1,17 +0,0 @@ -vx,0,m/s -vy,0,m/s -vz,0,m/s -yaw,5,degs -pitch,10,degs -roll,0,degs -yawdot,1,degs/s -pitchdot,-1,degs/s -rolldot,0,degs/s -Max Servo Rotation,7.5,degs -Initial Mass,1.2,kg -Propellant Mass,0.06,kg -Burn Time,3.3,s -Vehicle Height,0.53,m -Vehicle Radius,0.05,m -Moment Arm,0.15,m -Sim Step Size,1,ms From b30154a62d9fe88f425b6837d9112056e89693bf Mon Sep 17 00:00:00 2001 From: Anson Biggs Date: Thu, 14 Oct 2021 18:14:13 +0000 Subject: [PATCH 3/3] Resolve "More verbose simulation results" --- .vscode/extensions.json | 3 ++- include/sim.h | 37 ++++++++++++++++++++++++++----------- src/main.cpp | 16 ++++------------ 3 files changed, 32 insertions(+), 24 deletions(-) diff --git a/.vscode/extensions.json b/.vscode/extensions.json index 32f52b8..986e8c3 100644 --- a/.vscode/extensions.json +++ b/.vscode/extensions.json @@ -1,6 +1,7 @@ { "recommendations": [ "ms-vscode.cpptools", - "wayou.vscode-todo-highlight" + "wayou.vscode-todo-highlight", + "usernamehw.errorlens" ] } \ No newline at end of file diff --git a/include/sim.h b/include/sim.h index 55add14..579528e 100644 --- a/include/sim.h +++ b/include/sim.h @@ -1,6 +1,8 @@ #include "Vehicle.h" #include "outVector.h" +#include + void burnStartTimeCalc(struct Vehicle &); void thrustSelection(struct Vehicle &, int t); void lqrCalc(struct Vehicle &); @@ -38,19 +40,33 @@ bool sim(struct Vehicle &State, struct Vehicle &PrevState) { write2CSV(stateVector, State); - bool returnValue; + bool pass = 1; - if (abs(State.vz) < 5) { - if ((abs(State.yaw) < 5) && (abs(State.pitch) < 5)) { - returnValue = 1; - } else { - returnValue = 0; - } + double landing_angle = + pow(State.yaw * State.yaw + State.pitch * State.pitch, .5); + + double landing_velocity = + pow(State.vx * State.vx + State.vy * State.vy + State.vz * State.vz, .5); + + if (landing_angle < 5.0) { + std::cout << " Landing Angle < 5° | PASS | "; } else { - returnValue = 0; + std::cout << " Landing Angle < 5° | FAIL | "; + pass = pass * 0; } + std::cout << "Final Angles: [" << State.yaw << ", " << State.pitch << "]" + << std::endl; - return returnValue; + if (landing_velocity < 5.0) { + std::cout << "Landing Velocity < 5 m/s | PASS | "; + } else { + std::cout << "Landing Velocity < 5 m/s | FAIL | "; + pass = pass * 0; + } + std::cout << "Final Velocity: [" << State.vx << ", " << State.vy << ", " + << State.vz << "]" << std::endl; + + return pass; } void burnStartTimeCalc(Vehicle &State) { @@ -344,8 +360,6 @@ void write2CSV(outVector &stateVector, Vehicle &State) { "pitchdot, rolldot, Servo1, Servo2, thrustFiring" << std::endl; - std::cout << "Writing to csv...\n"; - // writing to output file for (int t = 0; t < State.simTime; t++) { outfile << t << ", "; @@ -377,6 +391,7 @@ void write2CSV(outVector &stateVector, Vehicle &State) { } outfile.close(); + std::cout << "simOut.csv created successfully.\n" << std::endl; } double derivative(double current, double previous, double step) { diff --git a/src/main.cpp b/src/main.cpp index 50c2e3e..c1efbf6 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -52,16 +52,8 @@ int main() { bool outcome = sim(State, PrevState); - std::cout << "Finished" - << "\n"; - - if (outcome == 1) { - std::cout << "Sim Result = Success!"; - return 0; - } else if (outcome == 0) { - std::cout << "Sim Result = Failed!"; - // return 1; Until I figure out how to make CI/CD continue even when run - // fails. - return 0; - } + std::cout << std::endl << "Simulation Complete 🚀" << std::endl; + // ^^^ + // 50% chance this makes Mattys linux crash + return 0; } \ No newline at end of file