Mh, bei deinem Quellcode kann ich dir in Ermangelung an Assembler Kenntnissen leider nicht weiterhelfen, deswegen würde ich mal das Augenmerk auf die Schaltung werfen.

Worauf hast du diese aufgebaut? Nach welchem Schaltplan? Ist die Versorgungsspannung stabil? Funktionieren die anderen Funktionene sauber?

Hast du auch keine kalten Lötstellen/wacklige Steckkontakte?