Toma la. Aqui ja esta tudo feito.
Se quiseres algo mais complicado devias olhar as tecnicas em synths...
Podes tb replicar as frequencias atraves de on/off os pins, mas talvez seja melhor usares AVR C code, ja que precisas de mexer no miolo do codigo que vai contra o que esta nos core