Wow bin eben mal drüber geflogen, echt eine Menge Code!

Aber wenn ich das richtig sehe machst du das alles über die "delay.h". Also benutzt du keinen Timer? Ich glaube eine Lösung mit Timern (den kleinsten Timer0) würde an dieser Stelle vielleicht etwas besser sein.

Das ist meine Meinung wenn deine Version in der Praxis auch funktioniert, dann ist es ja auch mal eine Alternative.

MfG
Ringo