Tweak joystick code to work with servos