Phase correct pwm

use phase correct pwm; added some further improvements to avoid jitter, which is obviosly caused by R/C transmitterns ADC.