Working on updating the state machine and control loop logic to fit the new parabolic flight trajectory.

Considerations:

Very messy state machine sketch (not the actual diagram):