Added optimization for P-Controller with IT1 control loop