; Source created with Parsic Version 3.x

; at              : 2009.06.03. 19:16:29


; Project File    : C:\DOCUME~1\ALLUSE~1\ASZTAL\szuro.pic

; Project Version : 1.0.42

; Created         : 2009.06.01. 0:16:00

; Last change     : 2009.06.03. 19:16:25

	PROCESSOR 16F628A

	INCLUDE P16F628A.INC

	RADIX DEC


	__IDLOCS H'0100'

	__CONFIG _CP_OFF & _PWRTE_ON & _WDT_OFF & _BODEN_ON & _XT_OSC & _LVP_OFF & _MCLRE_ON

; Diverses

ZERO	EQU Z	; ZERO-Flag
CARRY	 EQU C	; CARRY-Flag


; Variable

TR1	= 32	; located in Bank 0
TR1_HI	= 33	; located in Bank 0
S0	= 34	; located in Bank 0
ZV1	= 35	; located in Bank 0
ZV1_HI	= 36	; located in Bank 0
ZV1_FD	= 37	; located in Bank 0
ZV2	= 38	; located in Bank 0
ZV2_HI	= 39	; located in Bank 0
ZV2_FD	= 40	; located in Bank 0
TR2	= 41	; located in Bank 0
TR2_HI	= 42	; located in Bank 0
ZV3	= 43	; located in Bank 0
ZV3_HI	= 44	; located in Bank 0
ZV3_FD	= 45	; located in Bank 0
OS1_FD	= 46	; located in Bank 0
S1	= 47	; located in Bank 0
OS2_FD	= 48	; located in Bank 0
OS3_FD	= 49	; located in Bank 0
ZV4	= 50	; located in Bank 0
ZV4_HI	= 51	; located in Bank 0
ZV4_FD	= 52	; located in Bank 0
S2	= 53	; located in Bank 0
OS4_FD	= 54	; located in Bank 0
OS5_FD	= 55	; located in Bank 0
S3	= 56	; located in Bank 0
OS6_FD	= 57	; located in Bank 0
MF1	= 58	; located in Bank 0
MF1_HI	= 59	; located in Bank 0
MF1_FD	= 60	; located in Bank 0
RAM	= 61	; located in Bank 0
SYS_WSAV	= 112	; located in Bank 0, 1, 2, 3
SYS_SSAV	= 113	; located in Bank 0, 1, 2, 3
SYS_FSAV	= 114	; located in Bank 0, 1, 2, 3

	ERRORLEVEL -302	; disable warning (Bankswitching)
	ERRORLEVEL -306	; disable warning (Pageswitching)

;****************************************
;Programmanfang
;****************************************

	ORG 0

	CLRF STATUS	; switch to RAM-Bank 0
	GOTO SYS_INIT
	NOP
	NOP

;****************************************
;Interrupt-Adress
;****************************************

	MOVWF SYS_WSAV	; save register
	SWAPF STATUS,W
	CLRF STATUS	; bank 0
	MOVWF SYS_SSAV
	MOVFW FSR
	MOVWF SYS_FSAV


	BTFSS INTCON,T0IF	; TMR0 ?
	GOTO NOTMR0INT
	BCF INTCON,T0IF	; Interrupt quitieren

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	INCFSZ TR1,F
	GOTO SYS_INT_LABEL_0
	INCF TR1_HI,F

SYS_INT_LABEL_0
	INCFSZ TR2,F
	GOTO SYS_INT_LABEL_1
	INCF TR2_HI,F

SYS_INT_LABEL_1
	INCFSZ MF1,F
	GOTO SYS_INT_LABEL_2
	INCF MF1_HI,F

SYS_INT_LABEL_2
NOTMR0INT


EXITINT

	MOVFW SYS_FSAV
	MOVWF FSR
	SWAPF SYS_SSAV,W	; Register zurück
	MOVWF STATUS
	SWAPF SYS_WSAV,F
	SWAPF SYS_WSAV,W

	RETFIE


;****************************************
; Subroutines
;****************************************


;****************************************
;Initialisierung
;****************************************


SYS_INIT

	MOVLW B'00100000'
	MOVWF INTCON

; Set output before direction

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVLW B'00000000'
	MOVWF PORTA

	MOVLW B'00000100'
	MOVWF PORTB

	MOVLW 143
	BSF STATUS,RP0	; Bank 1
	MOVWF OPTION_REG


; Richtung setzen

	MOVLW B'11111100'
	MOVWF TRISA

	MOVLW B'00000011'
	MOVWF TRISB

	BCF STATUS,RP0	; Bank 0
	MOVLW 7	; Comparators off
	MOVWF CMCON
; init vars


; Clear RAM

	BCF STATUS,IRP
	MOVLW 32
	MOVWF FSR
CR1
	CLRF INDF
	INCF FSR,F
	BTFSS FSR,7
	GOTO CR1
	BSF FSR,5
CR2
	CLRF INDF
	INCF FSR,F
	MOVLW H'F0'
	SUBWF FSR,W
	BTFSS STATUS,ZERO
	GOTO CR2
	BSF STATUS,IRP
	MOVLW 32
	MOVWF FSR
CR3
	CLRF INDF
	INCF FSR,F
	MOVLW H'50'
	SUBWF FSR,W
	BTFSS STATUS,ZERO
	GOTO CR3

	MOVLW B'00000001'
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVWF S1
	MOVLW B'10000010'
	MOVWF S2

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	CLRF TMR0
	BCF INTCON,T0IF
	BSF INTCON,GIE	; Interrupt freigeben

;**********************************
;******* Haupt-Programm ***********
;**********************************

MAIN

;***************************************************
; Timer -> TR1
;***************************************************

	MOVLW 0	; Test auf >=
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	SUBWF TR1_HI,W	;F-W -> W
	BTFSS STATUS,ZERO
	GOTO LABEL_TR1_CHECK
	MOVLW 4
	SUBWF TR1,W	;F-W -> W
LABEL_TR1_CHECK
	BTFSS STATUS,CARRY
	GOTO LABEL_TR1_ENDE

LABEL_TR1_RESET
	MOVLW 0	; Test auf >=
	SUBWF TR1_HI,F	;F-W -> F
	MOVLW 4
	SUBWF TR1,F	;F-W -> F
	BTFSS STATUS,CARRY
	DECF TR1_HI,F

LABEL_TR1_SET	; toggel output
	BTFSC S0,0
	GOTO LABEL_TR1_CLR
	BSF S0,0
	GOTO LABEL_TR1_ENDE
LABEL_TR1_CLR
	BCF S0,0
LABEL_TR1_ENDE

;***************************************************
; Zähler -> ZV1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,1	; Reset ?
	GOTO LABEL_ZV1_COUNT
	CLRF ZV1
	CLRF ZV1_HI
	GOTO LABEL_ZV1_SETOUT

LABEL_ZV1_COUNT

; Test auf positive Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,0
	GOTO LABEL_ZV1_SETFD
	BTFSC ZV1_FD,0
	GOTO LABEL_ZV1_SETFD

	BSF ZV1_FD,0


	BTFSC S0,2	; Vorwärts oder Rückwärts ?
	GOTO LABEL_ZV1_BACKWARD

	INCFSZ ZV1,F
	GOTO LABEL_ZV1_SETOUT
	INCF ZV1_HI,F
	GOTO LABEL_ZV1_SETOUT

LABEL_ZV1_BACKWARD
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	DECF ZV1,F
	INCFSZ ZV1,W
	GOTO LABEL_ZV1_SETOUT
	DECF ZV1_HI,F

LABEL_ZV1_SETOUT


LABEL_ZV1_SETFD

; Test auf negative Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,0
	GOTO LABEL_ZV1_EXIT
	BCF ZV1_FD,0

LABEL_ZV1_EXIT

;***************************************************
; Vergleich -> IF1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW ZV2_HI
	SUBWF ZV1_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF1_CHECK
	MOVFW ZV2
	SUBWF ZV1,W	; F - W -> W

LABEL_IF1_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,CARRY	; Test auf -> >
	GOTO LABEL_IF1_FALSE
	BTFSC STATUS,ZERO
	GOTO LABEL_IF1_FALSE

LABEL_IF1_TRUE
	BSF S0,1
	GOTO LABEL_IF1_EXIT

LABEL_IF1_FALSE
	BCF S0,1

LABEL_IF1_EXIT
;***************************************************
; Zähler -> ZV2
;***************************************************

	BTFSS S0,5	; Reset ?
	GOTO LABEL_ZV2_COUNT
	CLRF ZV2
	CLRF ZV2_HI
	GOTO LABEL_ZV2_SETOUT

LABEL_ZV2_COUNT

; Test auf positive Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,7
	GOTO LABEL_ZV2_SETFD
	BTFSC ZV2_FD,0
	GOTO LABEL_ZV2_SETFD

	BSF ZV2_FD,0


	BTFSC S0,2	; Vorwärts oder Rückwärts ?
	GOTO LABEL_ZV2_BACKWARD

	INCFSZ ZV2,F
	GOTO LABEL_ZV2_SETOUT
	INCF ZV2_HI,F
	GOTO LABEL_ZV2_SETOUT

LABEL_ZV2_BACKWARD
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	DECF ZV2,F
	INCFSZ ZV2,W
	GOTO LABEL_ZV2_SETOUT
	DECF ZV2_HI,F

LABEL_ZV2_SETOUT


LABEL_ZV2_SETFD

; Test auf negative Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,7
	GOTO LABEL_ZV2_EXIT
	BCF ZV2_FD,0

LABEL_ZV2_EXIT

;***************************************************
; UND - Gatter -> LG1
;***************************************************

LABEL_LG1_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC PORTA,2
	GOTO LABEL_LG1_FALSE
LABEL_LG1_2
	BTFSS S0,3
	GOTO LABEL_LG1_FALSE

LABEL_LG1_TRUE
	BSF S0,6
	GOTO LABEL_LG1_ENDE
LABEL_LG1_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S0,6
LABEL_LG1_ENDE
;***************************************************
; Timer -> TR2
;***************************************************

	MOVLW 0	; Test auf >=
	SUBWF TR2_HI,W	;F-W -> W
	BTFSS STATUS,ZERO
	GOTO LABEL_TR2_CHECK
	MOVLW 98
	SUBWF TR2,W	;F-W -> W
LABEL_TR2_CHECK
	BTFSS STATUS,CARRY
	GOTO LABEL_TR2_ENDE

LABEL_TR2_RESET
	MOVLW 0	; Test auf >=
	SUBWF TR2_HI,F	;F-W -> F
	MOVLW 98
	SUBWF TR2,F	;F-W -> F
	BTFSS STATUS,CARRY
	DECF TR2_HI,F

LABEL_TR2_SET	; toggel output
	BTFSC S0,3
	GOTO LABEL_TR2_CLR
	BSF S0,3
	GOTO LABEL_TR2_ENDE
LABEL_TR2_CLR
	BCF S0,3
LABEL_TR2_ENDE

;***************************************************
; Zähler -> ZV3
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,4	; Reset ?
	GOTO LABEL_ZV3_COUNT
	CLRF ZV3
	CLRF ZV3_HI
	GOTO LABEL_ZV3_SETOUT

LABEL_ZV3_COUNT

; Test auf positive Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,1
	GOTO LABEL_ZV3_SETFD
	BTFSC ZV3_FD,0
	GOTO LABEL_ZV3_SETFD

	BSF ZV3_FD,0


	BTFSC S0,2	; Vorwärts oder Rückwärts ?
	GOTO LABEL_ZV3_BACKWARD

	INCFSZ ZV3,F
	GOTO LABEL_ZV3_SETOUT
	INCF ZV3_HI,F
	GOTO LABEL_ZV3_SETOUT

LABEL_ZV3_BACKWARD
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	DECF ZV3,F
	INCFSZ ZV3,W
	GOTO LABEL_ZV3_SETOUT
	DECF ZV3_HI,F

LABEL_ZV3_SETOUT


LABEL_ZV3_SETFD

; Test auf negative Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,1
	GOTO LABEL_ZV3_EXIT
	BCF ZV3_FD,0

LABEL_ZV3_EXIT

;***************************************************
; Vergleich -> IF2
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW ZV4_HI
	SUBWF ZV3_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF2_CHECK
	MOVFW ZV4
	SUBWF ZV3,W	; F - W -> W

LABEL_IF2_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,CARRY	; Test auf -> >
	GOTO LABEL_IF2_FALSE
	BTFSC STATUS,ZERO
	GOTO LABEL_IF2_FALSE

LABEL_IF2_TRUE
	BSF S0,4
	GOTO LABEL_IF2_EXIT

LABEL_IF2_FALSE
	BCF S0,4

LABEL_IF2_EXIT
;***************************************************
; One Shot -> OS1
;***************************************************


	BTFSC PORTA,2
	GOTO LABEL_OS1_1
	BTFSC OS1_FD,0
	GOTO LABEL_OS1_1
	BSF OS1_FD,0
	BSF S0,5
	GOTO LABEL_OS1_2
LABEL_OS1_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S0,5
	BTFSS PORTA,2
	GOTO LABEL_OS1_2
	BCF OS1_FD,0
LABEL_OS1_2
;***************************************************
; ODER - Gatter -> LG2
;***************************************************

LABEL_LG2_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,6
	GOTO LABEL_LG2_TRUE
LABEL_LG2_2
	BTFSC S1,1
	GOTO LABEL_LG2_TRUE
LABEL_LG2_3
	BTFSC S3,3
	GOTO LABEL_LG2_TRUE

LABEL_LG2_FALSE
	BCF S0,7
	GOTO LABEL_LG2_ENDE
LABEL_LG2_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S0,7
LABEL_LG2_ENDE
;***************************************************
; One Shot -> OS2
;***************************************************


	BTFSS S1,0
	GOTO LABEL_OS2_1
	BTFSC OS2_FD,0
	GOTO LABEL_OS2_1
	BSF OS2_FD,0
	BSF S1,1
	GOTO LABEL_OS2_2
LABEL_OS2_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,1
	BTFSC S1,0
	GOTO LABEL_OS2_2
	BCF OS2_FD,0
LABEL_OS2_2
;***************************************************
; VCC
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S1,0	; immer High

;***************************************************
; One Shot -> OS3
;***************************************************


	BTFSS PORTA,3
	GOTO LABEL_OS3_1
	BTFSC OS3_FD,0
	GOTO LABEL_OS3_1
	BSF OS3_FD,0
	BSF S1,2
	GOTO LABEL_OS3_2
LABEL_OS3_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,2
	BTFSC PORTA,3
	GOTO LABEL_OS3_2
	BCF OS3_FD,0
LABEL_OS3_2
;***************************************************
; Zähler -> ZV4
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,5	; Reset ?
	GOTO LABEL_ZV4_COUNT
	CLRF ZV4
	CLRF ZV4_HI
	GOTO LABEL_ZV4_SETOUT

LABEL_ZV4_COUNT

; Test auf positive Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S2,2
	GOTO LABEL_ZV4_SETFD
	BTFSC ZV4_FD,0
	GOTO LABEL_ZV4_SETFD

	BSF ZV4_FD,0


	BTFSC S1,7	; Vorwärts oder Rückwärts ?
	GOTO LABEL_ZV4_BACKWARD

	INCFSZ ZV4,F
	GOTO LABEL_ZV4_SETOUT
	INCF ZV4_HI,F
	GOTO LABEL_ZV4_SETOUT

LABEL_ZV4_BACKWARD
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	DECF ZV4,F
	INCFSZ ZV4,W
	GOTO LABEL_ZV4_SETOUT
	DECF ZV4_HI,F

LABEL_ZV4_SETOUT

; Output Q0

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS ZV4,0
	GOTO LABEL_ZV4_SETOUT0
	BSF S2,4
	GOTO LABEL_ZV4_SETOUT0_END
LABEL_ZV4_SETOUT0
	BCF S2,4
LABEL_ZV4_SETOUT0_END

; Output Q1

	BTFSS ZV4,1
	GOTO LABEL_ZV4_SETOUT1
	BSF S2,5
	GOTO LABEL_ZV4_SETOUT1_END
LABEL_ZV4_SETOUT1
	BCF S2,5
LABEL_ZV4_SETOUT1_END

; Output Q2

	BTFSS ZV4,2
	GOTO LABEL_ZV4_SETOUT2
	BSF S2,6
	GOTO LABEL_ZV4_SETOUT2_END
LABEL_ZV4_SETOUT2
	BCF S2,6
LABEL_ZV4_SETOUT2_END


LABEL_ZV4_SETFD

; Test auf negative Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S2,2
	GOTO LABEL_ZV4_EXIT
	BCF ZV4_FD,0

LABEL_ZV4_EXIT

;***************************************************
; UND - Gatter -> LG3
;***************************************************

LABEL_LG3_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S1,3
	GOTO LABEL_LG3_FALSE
LABEL_LG3_2
	BTFSS S1,6
	GOTO LABEL_LG3_FALSE

LABEL_LG3_TRUE
	BSF S1,4
	GOTO LABEL_LG3_ENDE
LABEL_LG3_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,4
LABEL_LG3_ENDE
;***************************************************
; UND - Gatter -> LG4
;***************************************************

LABEL_LG4_1
	BTFSS S1,6
	GOTO LABEL_LG4_FALSE
LABEL_LG4_2
	BTFSC S1,3
	GOTO LABEL_LG4_FALSE

LABEL_LG4_TRUE
	BSF S1,5
	GOTO LABEL_LG4_ENDE
LABEL_LG4_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,5
LABEL_LG4_ENDE
;***************************************************
; RS-FLIP-FLOP -> RS1
;***************************************************

	BTFSC S1,4
	GOTO LABEL_RS1_RESET
	BTFSS S1,5
	GOTO LABEL_RS1_ENDE
	BSF S1,3	; Ausgang setzen
	GOTO LABEL_RS1_ENDE
LABEL_RS1_RESET
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,3	; Ausgang zurücksetzen
LABEL_RS1_ENDE

;***************************************************
; GND
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,7	; immer Low

;***************************************************
; One Shot -> OS4
;***************************************************


	BTFSS S0,4
	GOTO LABEL_OS4_1
	BTFSC OS4_FD,0
	GOTO LABEL_OS4_1
	BSF OS4_FD,0
	BSF S1,6
	GOTO LABEL_OS4_2
LABEL_OS4_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,6
	BTFSC S0,4
	GOTO LABEL_OS4_2
	BCF OS4_FD,0
LABEL_OS4_2
;***************************************************
; ODER - Gatter -> LG5
;***************************************************

LABEL_LG5_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S1,3
	GOTO LABEL_LG5_TRUE
LABEL_LG5_2
	BTFSC S2,0
	GOTO LABEL_LG5_TRUE

LABEL_LG5_FALSE
	BSF S2,1
	GOTO LABEL_LG5_ENDE
LABEL_LG5_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S2,1
LABEL_LG5_ENDE
;***************************************************
; Vergleich -> IF3
;***************************************************

	MOVLW HIGH 5
	SUBWF ZV4_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF3_CHECK
	MOVLW LOW 5
	SUBWF ZV4,W	; F - W -> W

LABEL_IF3_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,ZERO	; Test auf -> =
	GOTO LABEL_IF3_FALSE

LABEL_IF3_TRUE
	BSF S2,0
	GOTO LABEL_IF3_EXIT

LABEL_IF3_FALSE
	BCF S2,0

LABEL_IF3_EXIT
;***************************************************
; ODER - Gatter -> LG6
;***************************************************

LABEL_LG6_1
	BTFSC S3,0
	GOTO LABEL_LG6_TRUE
LABEL_LG6_2
	BTFSC S2,3
	GOTO LABEL_LG6_TRUE

LABEL_LG6_FALSE
	BCF S2,2
	GOTO LABEL_LG6_ENDE
LABEL_LG6_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S2,2
LABEL_LG6_ENDE
;***************************************************
; One Shot -> OS5
;***************************************************


	BTFSC S0,5
	GOTO LABEL_OS5_1
	BTFSC OS5_FD,0
	GOTO LABEL_OS5_1
	BSF OS5_FD,0
	BSF S2,3
	GOTO LABEL_OS5_2
LABEL_OS5_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S2,3
	BTFSS S0,5
	GOTO LABEL_OS5_2
	BCF OS5_FD,0
LABEL_OS5_2
;***************************************************
; UND - Gatter -> LG7
;***************************************************

LABEL_LG7_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S2,4
	GOTO LABEL_LG7_FALSE
LABEL_LG7_2
	BTFSC S2,5
	GOTO LABEL_LG7_FALSE
LABEL_LG7_3
	BTFSC S2,6
	GOTO LABEL_LG7_FALSE

LABEL_LG7_TRUE
	BSF PORTB,7
	GOTO LABEL_LG7_ENDE
LABEL_LG7_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,7
LABEL_LG7_ENDE
;***************************************************
; UND - Gatter -> LG8
;***************************************************

LABEL_LG8_1
	BTFSS S2,4
	GOTO LABEL_LG8_FALSE
LABEL_LG8_2
	BTFSS S2,5
	GOTO LABEL_LG8_FALSE
LABEL_LG8_3
	BTFSC S2,6
	GOTO LABEL_LG8_FALSE

LABEL_LG8_TRUE
	BSF PORTB,5
	GOTO LABEL_LG8_ENDE
LABEL_LG8_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,5
LABEL_LG8_ENDE
;***************************************************
; UND - Gatter -> LG9
;***************************************************

LABEL_LG9_1
	BTFSC S2,4
	GOTO LABEL_LG9_FALSE
LABEL_LG9_2
	BTFSC S2,5
	GOTO LABEL_LG9_FALSE
LABEL_LG9_3
	BTFSS S2,6
	GOTO LABEL_LG9_FALSE

LABEL_LG9_TRUE
	BSF PORTB,4
	GOTO LABEL_LG9_ENDE
LABEL_LG9_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,4
LABEL_LG9_ENDE
;***************************************************
; Vergleich -> IF4
;***************************************************

	MOVLW 5
	SUBWF ZV4,W	; F - W -> W

LABEL_IF4_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,ZERO	; Test auf -> =
	GOTO LABEL_IF4_FALSE

LABEL_IF4_TRUE
	BCF S2,7
	GOTO LABEL_IF4_EXIT

LABEL_IF4_FALSE
	BSF S2,7

LABEL_IF4_EXIT
;***************************************************
; UND - Gatter -> LG10
;***************************************************

LABEL_LG10_1
	BTFSS S1,2
	GOTO LABEL_LG10_FALSE
LABEL_LG10_2
	BTFSS S2,7
	GOTO LABEL_LG10_FALSE

LABEL_LG10_TRUE
	BSF S3,0
	GOTO LABEL_LG10_ENDE
LABEL_LG10_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S3,0
LABEL_LG10_ENDE
;***************************************************
; UND - Gatter -> LG11
;***************************************************

LABEL_LG11_1
	BTFSC S2,4
	GOTO LABEL_LG11_FALSE
LABEL_LG11_2
	BTFSS S2,5
	GOTO LABEL_LG11_FALSE
LABEL_LG11_3
	BTFSC S2,6
	GOTO LABEL_LG11_FALSE

LABEL_LG11_TRUE
	BSF PORTB,6
	GOTO LABEL_LG11_ENDE
LABEL_LG11_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,6
LABEL_LG11_ENDE
;***************************************************
; UND - Gatter -> LG12
;***************************************************

LABEL_LG12_1
	BTFSS S2,4
	GOTO LABEL_LG12_FALSE
LABEL_LG12_2
	BTFSS S2,6
	GOTO LABEL_LG12_FALSE

LABEL_LG12_TRUE
	BSF PORTB,3
	GOTO LABEL_LG12_ENDE
LABEL_LG12_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,3
LABEL_LG12_ENDE
;***************************************************
; One Shot -> OS6
;***************************************************


	BTFSS S3,2
	GOTO LABEL_OS6_1
	BTFSC OS6_FD,0
	GOTO LABEL_OS6_1
	BSF OS6_FD,0
	BSF S3,1
	GOTO LABEL_OS6_2
LABEL_OS6_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S3,1
	BTFSC S3,2
	GOTO LABEL_OS6_2
	BCF OS6_FD,0
LABEL_OS6_2
;***************************************************
; UND - Gatter -> LG13
;***************************************************

LABEL_LG13_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,4
	GOTO LABEL_LG13_FALSE
LABEL_LG13_2
	BTFSC S2,0
	GOTO LABEL_LG13_FALSE

LABEL_LG13_TRUE
	BSF S3,2
	GOTO LABEL_LG13_ENDE
LABEL_LG13_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S3,2
LABEL_LG13_ENDE
;***************************************************
; UND - Gatter -> LG14
;***************************************************

LABEL_LG14_1
	BTFSC S3,3
	GOTO LABEL_LG14_FALSE

LABEL_LG14_TRUE
	BCF PORTB,2
	GOTO LABEL_LG14_ENDE
LABEL_LG14_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF PORTB,2
LABEL_LG14_ENDE
;***************************************************
; RS-FLIP-FLOP -> RS2
;***************************************************

	BTFSC S0,5
	GOTO LABEL_RS2_RESET
	BTFSS S3,4
	GOTO LABEL_RS2_ENDE
	BSF S3,3	; Ausgang setzen
	GOTO LABEL_RS2_ENDE
LABEL_RS2_RESET
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S3,3	; Ausgang zurücksetzen
LABEL_RS2_ENDE

;***************************************************
; Vergleich -> IF5
;***************************************************

	MOVLW HIGH 499
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	SUBWF ZV2_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF5_CHECK
	MOVLW LOW 499
	SUBWF ZV2,W	; F - W -> W

LABEL_IF5_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,ZERO	; Test auf -> =
	GOTO LABEL_IF5_FALSE

LABEL_IF5_TRUE
	BSF S3,4
	GOTO LABEL_IF5_EXIT

LABEL_IF5_FALSE
	BCF S3,4

LABEL_IF5_EXIT
;***************************************************
; UND - Gatter -> LG15
;***************************************************

LABEL_LG15_1
	BTFSS S2,6
	GOTO LABEL_LG15_FALSE
LABEL_LG15_2
	BTFSS S1,2
	GOTO LABEL_LG15_FALSE
LABEL_LG15_3
	BTFSS S2,4
	GOTO LABEL_LG15_FALSE

LABEL_LG15_TRUE
	BSF S3,6
	GOTO LABEL_LG15_ENDE
LABEL_LG15_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S3,6
LABEL_LG15_ENDE
;***************************************************
; ODER - Gatter -> LG16
;***************************************************

LABEL_LG16_1
	BTFSC S3,1
	GOTO LABEL_LG16_TRUE
LABEL_LG16_2
	BTFSC S3,5
	GOTO LABEL_LG16_TRUE

LABEL_LG16_FALSE
	BCF PORTA,0
	GOTO LABEL_LG16_ENDE
LABEL_LG16_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF PORTA,0
LABEL_LG16_ENDE
;***************************************************
; ODER - Gatter -> LG17
;***************************************************

LABEL_LG17_1
	BTFSC S3,5
	GOTO LABEL_LG17_TRUE
LABEL_LG17_2
	BTFSC S2,1
	GOTO LABEL_LG17_TRUE

LABEL_LG17_FALSE
	BCF PORTA,1
	GOTO LABEL_LG17_ENDE
LABEL_LG17_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF PORTA,1
LABEL_LG17_ENDE
;***************************************************
; Mono-Flop -> MF1
;***************************************************

; Läuft der Impuls ?

	BTFSC MF1_FD,1
	GOTO LABEL_MF1_CHKTIME

; Test auf positive Flanke

	BTFSC MF1_FD,0
	GOTO LABEL_MF1_SETFD
	BTFSS S3,6
	GOTO LABEL_MF1_SETFD


LABEL_MF1_RESET

	CLRF MF1
	CLRF MF1_HI
	BSF MF1_FD,1
	BSF S3,5

LABEL_MF1_CHKTIME

	MOVLW 0
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	SUBWF MF1_HI,W
	BTFSS STATUS,ZERO
	GOTO LABEL_MF1_CHECK
	MOVLW 195
	SUBWF MF1,W
LABEL_MF1_CHECK
	BTFSS STATUS,CARRY
	GOTO LABEL_MF1_SETFD
LABEL_MF1_TO

	BCF MF1_FD,1
	BCF S3,5

LABEL_MF1_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S3,6
	GOTO LABEL_MF1_CLR
	BSF MF1_FD,0
	GOTO LABEL_MF1_ENDE
LABEL_MF1_CLR
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF MF1_FD,0

LABEL_MF1_ENDE

;****************************************

	GOTO MAIN


	END

