Erster Code für Firmware hinzugefügt, 40kHz-Signal wird per FastPWM erzeugt.