Change task Requiered Altitude Calculation :

if next Tp Requiered Altitude is less than current tp altitude, use current tp altitude for requiered altitude...
 - AAT Task : altitude of AAT Target point is used if upper center altitude, otherwise, center altitude is used.
 - PG optimized : always use Optimized point altitude.