H-Bridge and PWM improvements/mistakes