Fixed my distance formula :P
Also reduced restart latency of the tone