Controls NonLinear WORKING

System claims that it can achieve a SS condition after 0.783 sec. Needs
to be deployed to robot.