Am Ende der Achsen-Routinen fehlt jetzt das "goto main", und die Warteschleife ist besser unmittelbar nach dem "bsf PORTx".

Ansonsten musst Du mal sehen, was wirklich an den Input-Ports anliegt.

LG
Wolfgang