Added pid controller