Tidying
Modified ServoTimer2
Variable to know if a tone is playing
Experiment to try to use a servo on the same timer as the motors