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

Merge branch 'op_dem' of gitlab.com:lander-team/lander-cpp into op_dem

Browse Source
This commit is contained in:
Anson Biggs 2021-11-22 13:37:57 -07:00
commit 3a2773891f
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
include/teensy.h
View File

@ -214,12 +214,12 @@ void thrustInfo(Vehicle &State) {
double R = 5.0;
// Vector math to aqcuire thrust vector components
State.thrust = State.lc0_processed + State.lc1_processed +
State.lc2_processed + State.lc3_processed;
State.Fz = State.lc0_processed + State.lc1_processed + State.lc2_processed +
State.lc3_processed;
State.Fx = (State.lc1_processed - State.lc2_processed) * r / R;
State.Fy = (State.lc0_processed - State.lc3_processed) * r / R;
State.Fz =
sqrt(pow(State.thrust, 2) - pow(State.Fx, 2) - pow(State.Fy, 2)) +
State.thrust =
sqrt(pow(State.Fz, 2) + pow(State.Fx, 2) + pow(State.Fy, 2)) +
(State.mass * g);
} else {