Fixed bug that caused elevation servo to oscillate rapidly