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

Adding back PID gains since they didn't survive the merge for some reason

Browse Source
This commit is contained in:
bpmcgeeney
2021-10-14 18:25:33 -07:00
parent 14d68f852c
commit 59345992db
2 changed files with 7 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
matlabHelpers/simPlot.m
View File

@@ -51,7 +51,6 @@ title('Altitude vs Time')
xlabel('Time (s)')
ylabel('Altitude (m)')
ylim([0 z(1)+5])
saveas(gcf,'outputs/Accel-Vel-Alt vs Time.png')
figure(2)
@@ -75,7 +74,6 @@ plot(t, rolldot)
title('Angular Velocity vs Time')
xlabel('Time (ms)')
ylabel('Angular Velocity (deg/s)')
saveas(gcf,'outputs/Euler Angles vs Time.png')
legend("yawdot", "pitchdot", "rolldot")
figure(3)
@@ -93,4 +91,3 @@ 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')

9
src/main.cpp
View File

@@ -17,14 +17,19 @@ int main() {
Vehicle State;
Vehicle PrevState;
// PID Gains
State.Kp = -6.8699;
State.Ki = 0;
State.Kd = -0.775;
// Initial Velocity
State.vx = 0; // [m/s]
State.vy = 0; // [m/s]
State.vz = 0; // [m/s]
// Initial YPR
State.yaw = 10 * M_PI / 180; // [rad]
State.pitch = 5 * M_PI / 180; // [rad]
State.yaw = 75 * M_PI / 180; // [rad]
State.pitch = 35 * M_PI / 180; // [rad]
State.roll = 0 * M_PI / 180; // [rad]
// Initial YPRdot