Contains the code which now holds 1 meter , added the integral term of error in desired rate calculation