Integrated integral gain into RobotManeuvers