Iterative prediction/Add P and I controler