mirror of
https://gitlab.com/lander-team/lander-cpp.git
synced 2025-06-16 23:26:43 +00:00
53 lines
1.1 KiB
C++
53 lines
1.1 KiB
C++
#include <cmath>
|
|
#include <fstream>
|
|
#include <iostream>
|
|
#include <stdio.h>
|
|
|
|
#include "sVars.h"
|
|
#include "sim.h"
|
|
|
|
void sim(struct sVars &);
|
|
|
|
int main() {
|
|
sVars Vars;
|
|
|
|
// Initial Velocity
|
|
Vars.vx = 0; // [m/s]
|
|
Vars.vy = 0; // [m/s]
|
|
Vars.vz = 0; // [m/s]
|
|
|
|
// Initial YPR
|
|
Vars.yaw = 0 * M_PI / 180; // [rad]
|
|
Vars.pitch = 0 * M_PI / 180; // [rad]
|
|
Vars.roll = 0 * M_PI / 180; // [rad]
|
|
|
|
// Initial YPRdot
|
|
Vars.yawdot = 0 * M_PI / 180; // [rad/s]
|
|
Vars.pitchdot = 0 * M_PI / 180; // [rad/s]
|
|
Vars.rolldot = 0 * M_PI / 180; // [rad/s]
|
|
|
|
// Servo Limitation
|
|
Vars.maxServo = 15; // [degs]
|
|
|
|
// Vehicle Properties
|
|
Vars.m0 = 1.2; // [kg]
|
|
Vars.vehicleHeight = 0.5318; // [m]
|
|
Vars.vehicleRadius = 0.05105; // [m]
|
|
Vars.momentArm = 0.145; // [m]
|
|
|
|
// Sim Step Size
|
|
Vars.stepSize = 1; // [ms]
|
|
|
|
// Other Properties
|
|
Vars.mp = 0.06; // [kg]
|
|
Vars.mb = Vars.m0 - Vars.mp; // [kg]
|
|
Vars.tb = 3.45 - 0.148; // [s]
|
|
Vars.mdot = Vars.mp / Vars.tb; // [kg/s]
|
|
|
|
sim(Vars);
|
|
|
|
std::cout << "Finished";
|
|
std::cin.get();
|
|
|
|
return 0;
|
|
} |