Fixed servo bug

Fixed bug where only the first servo value could be changed by the
joystick.  It was a stupid typo.  That's what I get for copying and
pasting a function.