AP_TECS : Cleaned up airspeeed increment logic