Added tolerance for servo code.
Added tolerance for servo.
Merge branch 'master' of github.com:bfogarty/FRC3780-2013.git