Add PID controler