TECS-WIP : Added takeoff/climbout logic