Slight modifications to gyro code; it works!
Moved servo control to buttons 2 & 3