Add PID loop