O.K. Bild  

Sie müssen aber für die Richtungänderung seine Zustände ändern und das sehe ich in Deinem Code nicht, nur immer PORTB,5=0 und PORTB,4=1.

MfG