Schrankensteuerung für Modellbahn

NULL_STELLUNG:
sbis PinB,0 ;Lichtschranke1
rjmp VOR_MAIN
sbis PinB,1 ;Lichtschranke2
rjmp VOR_MAIN ;Lichtschrankenabfrage:
ldi Schritte, 1 ;bei 1 Signal Lichtschranken nicht durchbrochen
rcall MOTOR_RUNTER ;also sind die Schranken noch nicht unten
rjmp NULL_STELLUNG ;bei 0 Signal Schaltung betriebsbereit
;_______________________________________________________________________________
MOTOR_HOCH:
ldi Motor, 0b00101100 ;\
out PortD, Motor ; |
ldi Zeit, 1 ; |
rcall WARTE ; |
; |
ldi Motor, 0b00110100 ; |
out PortD, Motor ; |
ldi Zeit, 1 ; |
rcall WARTE ; |
; |
ldi Motor, 0b01010100 ; |
out PortD, Motor ; |
ldi Zeit, 1 ; |
rcall WARTE ; \ Ansteuerung um die Schrittmotoren
; / nach oden zu steuern
ldi Motor, 0b01001100 ; |
out PortD, Motor ; |
ldi Zeit, 1 ; |
rcall WARTE ; |
; |
dec Schritte ; |
cp Schritte, null ; |
brne MOTOR_HOCH ; |
; |
ldi Motor, 0b01111100 ; |
out PortD, Motor ; |
ret ;/
;_______________________________________________________________________________
Seite 19