PID working decent with small oscillations