basic PID and PWM works