first version of pid + dual pwm timers