Ganz einfach: Wartezeit=1/Frequenz
Wenn du also 500Hz erzeugen willst musst du bis zum Umschalten 1/500Hz=2ms=2000µs warten.
Mit C-Programmierung bei µC kenn ich mich allerdings nicht so gut aus.