ascent.ks

FUNCTION EXECUTE_ASCENT_STEP {
  PARAMETER direction.
  PARAMETER minAlt.
  PARAMETER newAngle.


  SET prevThrust TO MAXTHRUST.

 UNTIL FALSE {

    IF MAXTHRUST < (prevThrust - 10) {
      WAIT 0.1. STAGE. WAIT 0.1.
      SET prevThrust TO MAXTHRUST.
    }

    IF ALTITUDE > minAlt {
      LOCK STEERING TO HEADING(direction, newAngle).
      BREAK.
    }

    WAIT 0.1.
  }
}

FUNCTION EXECUTE_ASCENT_PROFILE {
  PARAMETER profile.

  SET step TO 0.
  UNTIL step >= profile:length - 1 {
    EXECUTE_ASCENT_STEP(
      profile[step],
      profile[step+1],
      profile[step+2]
    ).
    SET step TO step + 3.
  }
  }