Task Requiered Altitude Calculation :
if next Tp Requiered Altitude is less than current tp altitude, use current tp altitude for requiered altitude...