Die Tonerzeugung könntest du wesentlich einfacher mit Timer2 im CTC Mode haben.
Du müsstest nur den Compare Match Wert entsprechend der gewünschten Frequenz setzen.
Den Timer lässt du so lange laufen, wie du den Ton ausgeben möchtest.