; Source created with Parsic Version 3.x

; at              : 2010.01.03. 19:53:04


; Project File    : C:\DOCUME~1\ALLUSE~1\Asztal\3xlcdter.PIC

; Project Version : 1.0.11

; Created         : 2009.12.26. 19:52:00

; Last change     : 2010.01.03. 19:52:54

	PROCESSOR 16F876A

	INCLUDE P16F876A.INC

	RADIX DEC


	__IDLOCS H'0100'

	__CONFIG _CP_OFF & _PWRTE_ON & _WDT_OFF & _BODEN_ON & _XT_OSC & _LVP_OFF & _CPD_OFF & _DEBUG_OFF

; Diverses

ZERO	EQU Z	; ZERO-Flag
CARRY	 EQU C	; CARRY-Flag


; Variable

ZV1	= 32	; located in Bank 0
EE1_FD	= 33	; located in Bank 0
ZV2	= 34	; located in Bank 0
EE2_FD	= 35	; located in Bank 0
ZV3	= 36	; located in Bank 0
EE3_FD	= 37	; located in Bank 0
ADC0	= 38	; located in Bank 0
ADC0_HI	= 39	; located in Bank 0
S0	= 40	; located in Bank 0
S0_HI	= 41	; located in Bank 0
S2	= 42	; located in Bank 0
S2_HI	= 43	; located in Bank 0
LT1_FD	= 44	; located in Bank 0
LT2_FD	= 45	; located in Bank 0
LT3_FD	= 46	; located in Bank 0
LT4_FD	= 47	; located in Bank 0
S17	= 48	; located in Bank 0
S16	= 49	; located in Bank 0
ZV1_HI	= 50	; located in Bank 0
ZV1_FD	= 51	; located in Bank 0
ZV2_HI	= 52	; located in Bank 0
ZV2_FD	= 53	; located in Bank 0
ZV3_HI	= 54	; located in Bank 0
ZV3_FD	= 55	; located in Bank 0
S15	= 56	; located in Bank 0
TR1	= 57	; located in Bank 0
TR1_HI	= 58	; located in Bank 0
OS1_FD	= 59	; located in Bank 0
OS2_FD	= 60	; located in Bank 0
OS3_FD	= 61	; located in Bank 0
LT5_FD	= 62	; located in Bank 0
LT6_FD	= 63	; located in Bank 0
LT7_FD	= 64	; located in Bank 0
S1	= 65	; located in Bank 0
S1_HI	= 66	; located in Bank 0
S3	= 67	; located in Bank 0
S3_HI	= 68	; located in Bank 0
LT8_FD	= 69	; located in Bank 0
S4	= 70	; located in Bank 0
S4_HI	= 71	; located in Bank 0
ADC1	= 72	; located in Bank 0
ADC1_HI	= 73	; located in Bank 0
S5	= 74	; located in Bank 0
S5_HI	= 75	; located in Bank 0
S7	= 76	; located in Bank 0
S7_HI	= 77	; located in Bank 0
LT9_FD	= 78	; located in Bank 0
S6	= 79	; located in Bank 0
S6_HI	= 80	; located in Bank 0
S8	= 81	; located in Bank 0
S8_HI	= 82	; located in Bank 0
LT10_FD	= 83	; located in Bank 0
S9	= 84	; located in Bank 0
S9_HI	= 85	; located in Bank 0
ADC2	= 86	; located in Bank 0
ADC2_HI	= 87	; located in Bank 0
S10	= 88	; located in Bank 0
S10_HI	= 89	; located in Bank 0
S12	= 90	; located in Bank 0
S12_HI	= 91	; located in Bank 0
LT11_FD	= 92	; located in Bank 0
S11	= 93	; located in Bank 0
S11_HI	= 94	; located in Bank 0
S13	= 95	; located in Bank 0
S13_HI	= 96	; located in Bank 0
LT12_FD	= 97	; located in Bank 0
S14	= 98	; located in Bank 0
S14_HI	= 99	; located in Bank 0
TR2	= 100	; located in Bank 0
TR2_HI	= 101	; located in Bank 0
RAM	= 102	; located in Bank 0
SYS_TMP1	= 114	; located in Bank 0, 1, 2, 3
SYS_TMP2	= 115	; located in Bank 0, 1, 2, 3
SYS_TMP3	= 116	; located in Bank 0, 1, 2, 3
SYS_TMP4	= 117	; located in Bank 0, 1, 2, 3
SYS_TMP5	= 118	; located in Bank 0, 1, 2, 3
SYS_TMP6	= 119	; located in Bank 0, 1, 2, 3
SYS_TMP7	= 120	; located in Bank 0, 1, 2, 3
SYS_TMP9	= 121	; located in Bank 0, 1, 2, 3
SYS_TMP10	= 122	; located in Bank 0, 1, 2, 3
SYS_WSAV	= 123	; located in Bank 0, 1, 2, 3
SYS_SSAV	= 124	; located in Bank 0, 1, 2, 3
SYS_PSAV	= 125	; located in Bank 0, 1, 2, 3
SYS_FSAV	= 126	; 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
	MOVLW HIGH SYS_INIT	; set page
	MOVWF PCLATH
	GOTO SYS_INIT

;****************************************
;Interrupt-Adress
;****************************************

	MOVWF SYS_WSAV	; save register
	SWAPF STATUS,W
	CLRF STATUS	; bank 0
	MOVWF SYS_SSAV
	MOVFW FSR
	MOVWF SYS_FSAV
	MOVFW PCLATH
	MOVWF SYS_PSAV
	CLRF PCLATH


	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
NOTMR0INT


EXITINT
	MOVFW SYS_PSAV
	MOVWF PCLATH

	MOVFW SYS_FSAV
	MOVWF FSR
	SWAPF SYS_SSAV,W	; Register zurück
	MOVWF STATUS
	SWAPF SYS_WSAV,F
	SWAPF SYS_WSAV,W

	RETFIE


;****************************************
; Multiplikation 16 - Bit
; OP1 = SYS_TMP1,2
; OP2 = SYS_TMP3,4
;****************************************

SYSMUL16
	MOVLW 16	; set loopcounter
	MOVWF SYS_TMP7

	CLRF SYS_TMP5	; clear result
	CLRF SYS_TMP6

SYSMUL16_1
	RRF SYS_TMP4,F
	RRF SYS_TMP3,F

	BTFSS STATUS,CARRY
	GOTO SYSMUL16_2
	MOVFW SYS_TMP2	; add High-Byte
	ADDWF SYS_TMP6,F
	MOVFW SYS_TMP1	; add Low-Byte
	ADDWF SYS_TMP5,F
	BTFSC STATUS,CARRY	; carry ?
	INCF SYS_TMP6,F	; add 256 to result

SYSMUL16_2
	BCF STATUS,CARRY
	RLF SYS_TMP1,F
	RLF SYS_TMP2,F
	DECFSZ SYS_TMP7,F

	GOTO SYSMUL16_1

	RETURN

;****************************************
; Division 16 - Bit
; OP1 = SYS_TMP1,2
; OP2 = SYS_TMP3,4
;****************************************

SYSDIV16
	MOVFW SYS_TMP3	; Division durch 0 ?
	IORWF SYS_TMP4,W
	BTFSC STATUS,ZERO
	GOTO SYSDIV16_ERROR

	CLRF SYS_TMP5	; Ergebnis löschen
	CLRF SYS_TMP6
	MOVLW 1
	MOVWF SYS_TMP7
SYSDIV16_0
	BTFSC SYS_TMP4,7	; OP2 linksbündig
	GOTO SYSDIV16_1
	INCF SYS_TMP7,F
	BCF STATUS,CARRY
	RLF SYS_TMP3,F
	RLF SYS_TMP4,F
	GOTO SYSDIV16_0

SYSDIV16_1
	MOVFW SYS_TMP4	; OP1 und OP2 vergleichen
	SUBWF SYS_TMP2,W	; F-W -> W
	BTFSS STATUS,ZERO
	GOTO SYSDIV16_2
	MOVFW SYS_TMP3
	SUBWF SYS_TMP1,W	; F-W -> W

SYSDIV16_2
	BTFSS STATUS,CARRY
	GOTO SYSDIV16_3
	MOVFW SYS_TMP4	; OP1-OP2
	SUBWF SYS_TMP2,F	; F-W -> F
	MOVFW SYS_TMP3
	SUBWF SYS_TMP1,F	; F-W -> F
	BTFSS STATUS,CARRY
	DECF SYS_TMP2,F
	BSF STATUS,CARRY
SYSDIV16_3
	RLF SYS_TMP5,F	; Ergebnis aktualisieren
	RLF SYS_TMP6,F
	RRF SYS_TMP4,F	; OP2 nach rechts schieben
	RRF SYS_TMP3,F
	DECFSZ SYS_TMP7,F	; Zähler -1
	GOTO SYSDIV16_1

	RETURN

SYSDIV16_ERROR
	MOVLW 255
	MOVWF SYS_TMP5
	MOVWF SYS_TMP6
	RETURN


;****************************************
; Subroutines
;****************************************

;***************************************************
; Read  -> AN0
;***************************************************

READ_AN0

	MOVLW B'100'
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	MOVWF ADCON1
	BSF TRISA,0
	BSF ADCON1,ADFM	; Right-Justified

	MOVLW B'11000001'	; CH0
	BCF STATUS,RP0	; Bank 0
	MOVWF ADCON0
	MOVLW 5
	MOVWF SYS_TMP1

SYS_ADC_LABEL_0
	DECFSZ SYS_TMP1,F
	GOTO SYS_ADC_LABEL_0

	BSF ADCON0,GO	; Start convert

SYS_ADC_LABEL_1

	BTFSC ADCON0,GO	; ready ?
	GOTO SYS_ADC_LABEL_1	; no

	BSF STATUS,RP0	; Bank 1
	MOVFW ADRESL
	BCF STATUS,RP0	; Bank 0
	MOVWF ADC0
	MOVFW ADRESH
	MOVWF ADC0_HI

	MOVLW 6
	BSF STATUS,RP0	; Bank 1
	MOVWF ADCON1
	MOVLW B'11111111'
	MOVWF TRISA
	RETURN

;***************************************************
; Read  -> AN1
;***************************************************

READ_AN1

	MOVLW B'100'
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	MOVWF ADCON1
	BSF TRISA,1
	BSF ADCON1,ADFM	; Right-Justified

	MOVLW B'11001001'	; CH1
	BCF STATUS,RP0	; Bank 0
	MOVWF ADCON0
	MOVLW 5
	MOVWF SYS_TMP1

SYS_ADC_LABEL_2
	DECFSZ SYS_TMP1,F
	GOTO SYS_ADC_LABEL_2

	BSF ADCON0,GO	; Start convert

SYS_ADC_LABEL_3

	BTFSC ADCON0,GO	; ready ?
	GOTO SYS_ADC_LABEL_3	; no

	BSF STATUS,RP0	; Bank 1
	MOVFW ADRESL
	BCF STATUS,RP0	; Bank 0
	MOVWF ADC1
	MOVFW ADRESH
	MOVWF ADC1_HI

	MOVLW 6
	BSF STATUS,RP0	; Bank 1
	MOVWF ADCON1
	MOVLW B'11111111'
	MOVWF TRISA
	RETURN

;***************************************************
; Read  -> AN2
;***************************************************

READ_AN2

	MOVLW B'010'
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	MOVWF ADCON1
	BSF TRISA,2
	BSF ADCON1,ADFM	; Right-Justified

	MOVLW B'11010001'	; CH2
	BCF STATUS,RP0	; Bank 0
	MOVWF ADCON0
	MOVLW 5
	MOVWF SYS_TMP1

SYS_ADC_LABEL_4
	DECFSZ SYS_TMP1,F
	GOTO SYS_ADC_LABEL_4

	BSF ADCON0,GO	; Start convert

SYS_ADC_LABEL_5

	BTFSC ADCON0,GO	; ready ?
	GOTO SYS_ADC_LABEL_5	; no

	BSF STATUS,RP0	; Bank 1
	MOVFW ADRESL
	BCF STATUS,RP0	; Bank 0
	MOVWF ADC2
	MOVFW ADRESH
	MOVWF ADC2_HI

	MOVLW 6
	BSF STATUS,RP0	; Bank 1
	MOVWF ADCON1
	MOVLW B'11111111'
	MOVWF TRISA
	RETURN

;***************************************************
; Subroutines for LB1
;***************************************************

LCD_LB1_INIT
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,4	; ir-register
LCD_LB1_L1
	CALL LCD_LB1_OUT4
	DECFSZ SYS_TMP1,F
	GOTO LCD_LB1_L1

	MOVFW PORTB
	ANDLW H'F0'
	IORLW B'0011'	; Function Set
	MOVWF PORTB

	BSF PORTB,5	; write
	GOTO $+1
	BCF PORTB,5

	BSF SYS_TMP1,5	; wait
LCD_LB1_L2
	CALL LCD_LB1_OUT4
	DECFSZ SYS_TMP1,F
	GOTO LCD_LB1_L2

	BSF PORTB,5	; write
	GOTO $+1
	BCF PORTB,5

	CALL LCD_LB1_OUT4

	BSF PORTB,5	; write
	GOTO $+1
	BCF PORTB,5

	CALL LCD_LB1_OUT4

	BCF PORTB,0	; 4-Bit Interface

	BSF PORTB,5	; write
	GOTO $+1
	BCF PORTB,5

	CALL LCD_LB1_OUT4

	MOVLW B'00101000'	; Function Set 4-Bit,2-Lines
	CALL LCD_LB1_OUT

	MOVLW B'00001100'	; Display on, Cursor off, Blink off
	CALL LCD_LB1_OUT

	MOVLW B'00000110'	; Entrymode set
	CALL LCD_LB1_OUT

LCD_LB1_CLR
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,4	; ir-register
	MOVLW B'00000001'	; Display clear
	CALL LCD_LB1_OUT

	BSF SYS_TMP1,5	; wait
LCD_LB1_L3
	CALL LCD_LB1_OUT4
	DECFSZ SYS_TMP1,F
	GOTO LCD_LB1_L3
	GOTO LCD_LB1_OUT4

;***************************************************

LCD_LB1_GOTOXY
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTB,4	; ir-register
	MOVLW H'40'
	BTFSC SYS_TMP2,0	; Ypos
	ADDWF SYS_TMP1,F
	BSF SYS_TMP1,7	; select dd-ram
	GOTO LCD_LB1_OUT1

;***************************************************

LCD_LB1_WRITESTR
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF PORTB,4	; dd-ram
LCD_LB1_WRITESTR1
	CALL LCD_LB1_CHAROUT
	BSF INTCON,GIE
	ANDLW H'FF'	; last is zero
	BTFSC STATUS,ZERO
	RETURN

	MOVWF SYS_TMP1
	MOVLW HIGH LCD_LB1_OUT1	; set page
	MOVWF PCLATH
	CALL LCD_LB1_OUT1
	INCFSZ SYS_TMP4,F	; next char
	GOTO LCD_LB1_WRITESTR1
	INCF SYS_TMP5,F	; next page
	GOTO LCD_LB1_WRITESTR1

LCD_LB1_CHAROUT
	BCF INTCON,GIE
	MOVFW SYS_TMP5
	MOVWF PCLATH
	MOVFW SYS_TMP4
	MOVWF PCL

;***************************************************

LCD_LB1_DEZO10000

	MOVLW LOW 10000
	MOVWF SYS_TMP1
	MOVLW HIGH 10000
	MOVWF SYS_TMP2

	CALL LCD_LB1_CONVERTDEZ
	MOVF SYS_TMP9,F
	BTFSS STATUS,ZERO
	GOTO LCD_LB1_DEZO1000
	CALL LCD_LB1_CHECKNULL

LCD_LB1_DEZO1000

	MOVLW LOW 1000
	MOVWF SYS_TMP1
	MOVLW HIGH 1000
	MOVWF SYS_TMP2

	CALL LCD_LB1_CONVERTDEZ
	MOVF SYS_TMP9,F
	BTFSS STATUS,ZERO
	GOTO LCD_LB1_DEZO100
	CALL LCD_LB1_CHECKNULL

LCD_LB1_DEZO100

	MOVLW LOW 100
	MOVWF SYS_TMP1
	CLRF SYS_TMP2

	CALL LCD_LB1_CONVERTDEZ
	MOVF SYS_TMP9,F
	BTFSS STATUS,ZERO
	GOTO LCD_LB1_DEZO10
	CALL LCD_LB1_CHECKNULL

LCD_LB1_DEZO10

	MOVLW LOW 10
	MOVWF SYS_TMP1
	CLRF SYS_TMP2

	CALL LCD_LB1_CONVERTDEZ
	MOVF SYS_TMP9,F
	BTFSS STATUS,ZERO
	GOTO LCD_LB1_DEZO1
	CALL LCD_LB1_CHECKNULL

LCD_LB1_DEZO1
	MOVLW 48
	ADDWF SYS_TMP4,W
	GOTO LCD_LB1_WRITECHAR

;***************************************************

LCD_LB1_CONVERTDEZ
	MOVF SYS_TMP9,F
	BTFSS STATUS,ZERO
	DECF SYS_TMP9,F
	CLRF SYS_TMP6
LCD_LB1_CONVERTDEZ2
	INCF SYS_TMP6,F

	MOVFW SYS_TMP1
	SUBWF SYS_TMP4,F

	MOVFW SYS_TMP2
	BTFSS STATUS,CARRY
	INCFSZ SYS_TMP2,W
	SUBWF SYS_TMP5,F
	BTFSC STATUS,CARRY
	GOTO LCD_LB1_CONVERTDEZ2

	MOVFW SYS_TMP2
	ADDWF SYS_TMP5,F
	MOVFW SYS_TMP1
	ADDWF SYS_TMP4,F
	BTFSC STATUS,CARRY
	INCF SYS_TMP5,F

	DECF SYS_TMP6,W
	BTFSS STATUS,ZERO
	BSF SYS_TMP10,0
	RETURN

;***************************************************

LCD_LB1_CONVERTHEX
	ANDLW 15
	MOVWF SYS_TMP1
	MOVLW 48
	ADDWF SYS_TMP1,F
	MOVLW 58
	SUBWF SYS_TMP1,W
	BTFSS STATUS,CARRY
	GOTO $+3
	MOVLW 7
	ADDWF SYS_TMP1,F
	MOVFW SYS_TMP1

;***************************************************

LCD_LB1_WRITECHAR
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF PORTB,4	; dd-ram

;***************************************************

LCD_LB1_OUT
	MOVWF SYS_TMP1	; store
LCD_LB1_OUT1
	CLRF SYS_TMP3	; LCDWriteStr (first nibble)
LCD_LB1_OUT2
	SWAPF SYS_TMP1,W	;high nibble
LCD_LB1_OUT3
	ANDLW H'0F'	; mask
	MOVWF SYS_TMP2	; store
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW PORTB	; load port
	ANDLW H'F0'	; mask
	IORWF SYS_TMP2,W	; add cmd
	MOVWF PORTB	; out

	BSF PORTB,5	; E high
	GOTO $+1
	BCF PORTB,5	; E low

	BTFSC SYS_TMP3,3	; ready ?
	GOTO LCD_LB1_OUT4	; yes
	BSF SYS_TMP3,3	; second nibble
	MOVFW SYS_TMP1
	GOTO LCD_LB1_OUT3	; next nibble

LCD_LB1_OUT4
LCD_LB1_OUTV
	DECFSZ SYS_TMP3,F
	GOTO LCD_LB1_OUTV
	RETURN

;***************************************************

LCD_LB1_CHECKNULL
	BTFSS STATUS,ZERO
	DECF SYS_TMP9,F
	MOVWF SYS_TMP1
	BTFSS STATUS,ZERO
	BSF SYS_TMP10,0
	MOVLW 48
	BTFSC SYS_TMP10,0
	ADDWF SYS_TMP1,f
	MOVLW 32
	BTFSS SYS_TMP10,0
	ADDWF SYS_TMP1,F
	MOVFW SYS_TMP1
	GOTO LCD_LB1_WRITECHAR
; 016A

EEINT_WRITE
	MOVFW INDF
EEINT_WRITE_0
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVWF EEDATA
	BSF STATUS,RP0	; Bank 3
	BSF EECON1,WREN

EEINT_DISINT
	BCF INTCON,GIE
	BTFSC INTCON,GIE
	GOTO EEINT_DISINT

	MOVLW H'55'
	MOVWF EECON2
	MOVLW H'AA'
	MOVWF EECON2
	BSF EECON1,WR	; start write

	BSF INTCON,GIE

EEINT_WRITE_1
	BTFSC EECON1,WR	; ready ?
	GOTO EEINT_WRITE_1	; no
	BCF EECON1,WREN

	BCF STATUS,RP0	; Bank 2
	INCF EEADR,F
	INCF FSR,F
	DECFSZ SYS_TMP1,F
	GOTO EEINT_WRITE

	RETURN

;***************************************************

EEINT_READ
	BSF STATUS,RP0	; Bank 3
	BSF STATUS,RP1	; Bank 3
	BSF EECON1,RD
	BCF STATUS,RP0	; Bank 2
	MOVFW EEDATA
	MOVWF INDF
	INCF EEADR,F
	INCF FSR,F
	DECFSZ SYS_TMP1,F
	GOTO EEINT_READ
	RETURN

;***************************************************
; EE-Modul -> EE1
;***************************************************

WRITE_EE1
	BSF STATUS,RP0	; Bank 3
	BSF STATUS,RP1	; Bank 3
	BCF EECON1,EEPGD
	BCF STATUS,RP0	; Bank 2
	CLRF EEADRH
	MOVLW 0
	MOVWF EEADR

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 1
	MOVWF SYS_TMP1
	MOVLW LOW ZV1
	MOVWF FSR

	CALL EEINT_WRITE


	RETURN

;***************************************************
; EE-Modul -> EE1
;***************************************************

READ_EE1
	MOVLW 0
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVWF EEADR
	CLRF EEADRH
	BSF STATUS,RP0	; Bank 3
	BCF EECON1,EEPGD

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 1
	MOVWF SYS_TMP1
	MOVLW LOW ZV1
	MOVWF FSR

	CALL EEINT_READ


	RETURN

;***************************************************
;***************************************************
; EE-Modul -> EE2
;***************************************************

WRITE_EE2
	BSF STATUS,RP0	; Bank 3
	BSF STATUS,RP1	; Bank 3
	BCF EECON1,EEPGD
	BCF STATUS,RP0	; Bank 2
	CLRF EEADRH
	MOVLW 1
	MOVWF EEADR

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 1
	MOVWF SYS_TMP1
	MOVLW LOW ZV2
	MOVWF FSR

	CALL EEINT_WRITE


	RETURN

;***************************************************
; EE-Modul -> EE2
;***************************************************

READ_EE2
	MOVLW 1
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVWF EEADR
	CLRF EEADRH
	BSF STATUS,RP0	; Bank 3
	BCF EECON1,EEPGD

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 1
	MOVWF SYS_TMP1
	MOVLW LOW ZV2
	MOVWF FSR

	CALL EEINT_READ


	RETURN

;***************************************************
;***************************************************
; EE-Modul -> EE3
;***************************************************

WRITE_EE3
	BSF STATUS,RP0	; Bank 3
	BSF STATUS,RP1	; Bank 3
	BCF EECON1,EEPGD
	BCF STATUS,RP0	; Bank 2
	CLRF EEADRH
	MOVLW 2
	MOVWF EEADR

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 1
	MOVWF SYS_TMP1
	MOVLW LOW ZV3
	MOVWF FSR

	CALL EEINT_WRITE


	RETURN

;***************************************************
; EE-Modul -> EE3
;***************************************************

READ_EE3
	MOVLW 2
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVWF EEADR
	CLRF EEADRH
	BSF STATUS,RP0	; Bank 3
	BCF EECON1,EEPGD

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 1
	MOVWF SYS_TMP1
	MOVLW LOW ZV3
	MOVWF FSR

	CALL EEINT_READ


	RETURN

;***************************************************

;****************************************
;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'00000000'
	MOVWF PORTB

	MOVLW B'00001110'
	MOVWF PORTC

	MOVLW 143
	BSF STATUS,RP0	; Bank 1
	MOVWF OPTION_REG

	MOVLW 6	; all Digital
	MOVWF ADCON1

; Richtung setzen

	MOVLW B'11111111'
	MOVWF TRISA

	MOVLW B'11000000'
	MOVWF TRISB

	MOVLW B'11110001'
	MOVWF TRISC

	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 16
	MOVWF FSR
CR3
	CLRF INDF
	INCF FSR,F
	MOVLW H'70'
	SUBWF FSR,W
	BTFSS STATUS,ZERO
	GOTO CR3
	MOVLW 144
	MOVWF FSR
CR4
	CLRF INDF
	INCF FSR,F
	MOVLW H'F0'
	SUBWF FSR,W
	BTFSS STATUS,ZERO
	GOTO CR4

	MOVLW B'00000111'
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVWF S16

;***************************************************
; Init LCD -> LB1
;***************************************************

	CALL LCD_LB1_INIT


	CALL READ_EE1	; read vars from internal EE


	CALL READ_EE2	; read vars from internal EE


	CALL READ_EE3	; read vars from internal EE

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	CLRF TMR0
	BCF INTCON,T0IF
	BSF INTCON,GIE	; Interrupt freigeben

;**********************************
;******* Haupt-Programm ***********
;**********************************

MAIN

	CALL READ_AN0
	CALL READ_AN1
	CALL READ_AN2
;***************************************************
;AF1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S1
	MOVWF SYS_TMP1
	MOVFW S1_HI
	MOVWF SYS_TMP2
	MOVLW LOW 10
	MOVWF SYS_TMP3
	MOVLW HIGH 10
	MOVWF SYS_TMP4
	MOVLW HIGH SYSDIV16
	MOVWF PCLATH
	CALL SYSDIV16
	MOVLW HIGH LABEL_AF1
	MOVWF PCLATH
LABEL_AF1
	MOVFW SYS_TMP5
	MOVWF S0
	MOVFW SYS_TMP6
	MOVWF S0_HI

LABEL_AF1_EXIT
;***************************************************
;AF2
;***************************************************

	MOVFW S0
	MOVWF SYS_TMP1
	MOVFW S0_HI
	MOVWF SYS_TMP2
	MOVLW LOW 10
	MOVWF SYS_TMP3
	MOVLW HIGH 10
	MOVWF SYS_TMP4
	MOVLW HIGH SYSMUL16
	MOVWF PCLATH
	CALL SYSMUL16
	MOVLW HIGH LABEL_AF2
	MOVWF PCLATH
LABEL_AF2
	MOVFW SYS_TMP5
	MOVWF S2
	MOVFW SYS_TMP6
	MOVWF S2_HI

LABEL_AF2_EXIT
;***************************************************
; LCD -> LT1
;***************************************************

; test of positiv edge

	BTFSC LT1_FD,0
	GOTO LABEL_LT1_SETFD
	BTFSS S17,1
	GOTO LABEL_LT1_SETFD


	MOVLW 4
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S3
	MOVWF SYS_TMP4
	MOVFW S3_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 5
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT1_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT1_SETFD2
	BSF LT1_FD,0
	GOTO LABEL_LT1_END
LABEL_LT1_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT1_FD,0
LABEL_LT1_END

;***************************************************
; LCD -> LT2
;***************************************************

; test of positiv edge

	BTFSC LT2_FD,0
	GOTO LABEL_LT2_SETFD
	BTFSS S17,1
	GOTO LABEL_LT2_SETFD


	MOVLW 0
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	MOVLW LOW TAB_LT2
	MOVWF SYS_TMP4
	MOVLW HIGH TAB_LT2
	MOVWF SYS_TMP5

	MOVLW HIGH LCD_LB1_WRITESTR	; set page
	MOVWF PCLATH

	CALL LCD_LB1_WRITESTR

	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT2_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT2_SETFD2
	BSF LT2_FD,0
	GOTO LABEL_LT2_END
LABEL_LT2_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT2_FD,0
LABEL_LT2_END

;***************************************************
; LCD -> LT3
;***************************************************

; test of positiv edge

	BTFSC LT3_FD,0
	GOTO LABEL_LT3_SETFD
	BTFSS S17,1
	GOTO LABEL_LT3_SETFD


	MOVLW 7
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	MOVLW LOW TAB_LT3
	MOVWF SYS_TMP4
	MOVLW HIGH TAB_LT3
	MOVWF SYS_TMP5

	MOVLW HIGH LCD_LB1_WRITESTR	; set page
	MOVWF PCLATH

	CALL LCD_LB1_WRITESTR

	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT3_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT3_SETFD2
	BSF LT3_FD,0
	GOTO LABEL_LT3_END
LABEL_LT3_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT3_FD,0
LABEL_LT3_END

;***************************************************
; LCD -> LT4
;***************************************************

; test of positiv edge

	BTFSC LT4_FD,0
	GOTO LABEL_LT4_SETFD
	BTFSS S17,1
	GOTO LABEL_LT4_SETFD


	MOVLW 14
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	MOVLW LOW TAB_LT4
	MOVWF SYS_TMP4
	MOVLW HIGH TAB_LT4
	MOVWF SYS_TMP5

	MOVLW HIGH LCD_LB1_WRITESTR	; set page
	MOVWF PCLATH

	CALL LCD_LB1_WRITESTR

	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT4_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT4_SETFD2
	BSF LT4_FD,0
	GOTO LABEL_LT4_END
LABEL_LT4_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT4_FD,0
LABEL_LT4_END

;***************************************************
; Schmitt-Trigger 16-Bit -> ST1
;***************************************************

	MOVFW ZV1
	MOVWF SYS_TMP1
	MOVFW ZV1_HI
	MOVWF SYS_TMP2

	BTFSS S17,0	; Ausgang gesetzt ?
	GOTO LABEL_ST1_TEST	; without Hysterese

	MOVLW HIGH 1
	SUBWF SYS_TMP2,F
	MOVLW LOW 1
	SUBWF SYS_TMP1,F
	BTFSS STATUS,CARRY
	DECF SYS_TMP2,F

LABEL_ST1_TEST
	MOVFW SYS_TMP2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	SUBWF S2_HI,W

	BTFSS STATUS,ZERO
	GOTO LABEL_ST1_TEST2

	MOVFW SYS_TMP1
	SUBWF S2,W

LABEL_ST1_TEST2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,CARRY
	GOTO LABEL_ST1_RESET

LABEL_ST1_SET
	BSF S17,0	; if greater or equal
	GOTO LABEL_ST1_ENDE

LABEL_ST1_RESET
	BCF S17,0	; if less
LABEL_ST1_ENDE

;***************************************************
; Schmitt-Trigger 16-Bit -> ST2
;***************************************************

	MOVFW ZV2
	MOVWF SYS_TMP1
	MOVFW ZV2_HI
	MOVWF SYS_TMP2

	BTFSS S16,7	; Ausgang gesetzt ?
	GOTO LABEL_ST2_TEST	; without Hysterese

	MOVLW HIGH 1
	SUBWF SYS_TMP2,F
	MOVLW LOW 1
	SUBWF SYS_TMP1,F
	BTFSS STATUS,CARRY
	DECF SYS_TMP2,F

LABEL_ST2_TEST
	MOVFW SYS_TMP2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	SUBWF S7_HI,W

	BTFSS STATUS,ZERO
	GOTO LABEL_ST2_TEST2

	MOVFW SYS_TMP1
	SUBWF S7,W

LABEL_ST2_TEST2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,CARRY
	GOTO LABEL_ST2_RESET

LABEL_ST2_SET
	BSF S16,7	; if greater or equal
	GOTO LABEL_ST2_ENDE

LABEL_ST2_RESET
	BCF S16,7	; if less
LABEL_ST2_ENDE

;***************************************************
; Schmitt-Trigger 16-Bit -> ST3
;***************************************************

	MOVFW ZV3
	MOVWF SYS_TMP1
	MOVFW ZV3_HI
	MOVWF SYS_TMP2

	BTFSS S16,6	; Ausgang gesetzt ?
	GOTO LABEL_ST3_TEST	; without Hysterese

	MOVLW HIGH 1
	SUBWF SYS_TMP2,F
	MOVLW LOW 1
	SUBWF SYS_TMP1,F
	BTFSS STATUS,CARRY
	DECF SYS_TMP2,F

LABEL_ST3_TEST
	MOVFW SYS_TMP2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	SUBWF S12_HI,W

	BTFSS STATUS,ZERO
	GOTO LABEL_ST3_TEST2

	MOVFW SYS_TMP1
	SUBWF S12,W

LABEL_ST3_TEST2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,CARRY
	GOTO LABEL_ST3_RESET

LABEL_ST3_SET
	BSF S16,6	; if greater or equal
	GOTO LABEL_ST3_ENDE

LABEL_ST3_RESET
	BCF S16,6	; if less
LABEL_ST3_ENDE

;***************************************************
; Zähler -> ZV1
;***************************************************

	BTFSS S16,3	; 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 S15,3
	GOTO LABEL_ZV1_SETFD
	BTFSC ZV1_FD,0
	GOTO LABEL_ZV1_SETFD

	BSF ZV1_FD,0


	BTFSC S15,0	; 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 S15,3
	GOTO LABEL_ZV1_EXIT
	BCF ZV1_FD,0

LABEL_ZV1_EXIT

;***************************************************
; Zähler -> ZV2
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S16,4	; 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 S15,2
	GOTO LABEL_ZV2_SETFD
	BTFSC ZV2_FD,0
	GOTO LABEL_ZV2_SETFD

	BSF ZV2_FD,0


	BTFSC S15,0	; 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 S15,2
	GOTO LABEL_ZV2_EXIT
	BCF ZV2_FD,0

LABEL_ZV2_EXIT

;***************************************************
; Zähler -> ZV3
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S16,5	; 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 S15,1
	GOTO LABEL_ZV3_SETFD
	BTFSC ZV3_FD,0
	GOTO LABEL_ZV3_SETFD

	BSF ZV3_FD,0


	BTFSC S15,0	; 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 S15,1
	GOTO LABEL_ZV3_EXIT
	BCF ZV3_FD,0

LABEL_ZV3_EXIT

;***************************************************
; GND
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S15,0	; immer Low

;***************************************************
; Timer -> TR1
;***************************************************

	MOVLW 1	; Test auf >=
	SUBWF TR1_HI,W	;F-W -> W
	BTFSS STATUS,ZERO
	GOTO LABEL_TR1_CHECK
	MOVLW 232
	SUBWF TR1,W	;F-W -> W
LABEL_TR1_CHECK
	BTFSS STATUS,CARRY
	GOTO LABEL_TR1_ENDE

LABEL_TR1_RESET
	MOVLW 1	; Test auf >=
	SUBWF TR1_HI,F	;F-W -> F
	MOVLW 232
	SUBWF TR1,F	;F-W -> F
	BTFSS STATUS,CARRY
	DECF TR1_HI,F

LABEL_TR1_SET	; toggel output
	BTFSC S15,4
	GOTO LABEL_TR1_CLR
	BSF S15,4
	GOTO LABEL_TR1_ENDE
LABEL_TR1_CLR
	BCF S15,4
LABEL_TR1_ENDE

;***************************************************
; UND - Gatter -> LG1
;***************************************************

LABEL_LG1_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S15,4
	GOTO LABEL_LG1_FALSE
LABEL_LG1_2
	BTFSS S16,2
	GOTO LABEL_LG1_FALSE
LABEL_LG1_3
	BTFSS S15,5
	GOTO LABEL_LG1_FALSE

LABEL_LG1_TRUE
	BSF S15,3
	GOTO LABEL_LG1_ENDE
LABEL_LG1_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S15,3
LABEL_LG1_ENDE
;***************************************************
; UND - Gatter -> LG2
;***************************************************

LABEL_LG2_1
	BTFSS S15,4
	GOTO LABEL_LG2_FALSE
LABEL_LG2_2
	BTFSS S16,1
	GOTO LABEL_LG2_FALSE
LABEL_LG2_3
	BTFSS S15,6
	GOTO LABEL_LG2_FALSE

LABEL_LG2_TRUE
	BSF S15,2
	GOTO LABEL_LG2_ENDE
LABEL_LG2_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S15,2
LABEL_LG2_ENDE
;***************************************************
; UND - Gatter -> LG3
;***************************************************

LABEL_LG3_1
	BTFSS S15,4
	GOTO LABEL_LG3_FALSE
LABEL_LG3_2
	BTFSS S16,0
	GOTO LABEL_LG3_FALSE
LABEL_LG3_3
	BTFSS S15,7
	GOTO LABEL_LG3_FALSE

LABEL_LG3_TRUE
	BSF S15,1
	GOTO LABEL_LG3_ENDE
LABEL_LG3_FALSE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S15,1
LABEL_LG3_ENDE
;***************************************************
; Vergleich -> IF1
;***************************************************

	MOVLW HIGH 99
	SUBWF ZV1_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF1_CHECK
	MOVLW LOW 99
	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_TRUE
	BTFSS STATUS,ZERO
	GOTO LABEL_IF1_FALSE

LABEL_IF1_TRUE
	BSF S15,5
	GOTO LABEL_IF1_EXIT

LABEL_IF1_FALSE
	BCF S15,5

LABEL_IF1_EXIT
;***************************************************
; Vergleich -> IF2
;***************************************************

	MOVLW HIGH 99
	SUBWF ZV2_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF2_CHECK
	MOVLW LOW 99
	SUBWF ZV2,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_TRUE
	BTFSS STATUS,ZERO
	GOTO LABEL_IF2_FALSE

LABEL_IF2_TRUE
	BSF S15,6
	GOTO LABEL_IF2_EXIT

LABEL_IF2_FALSE
	BCF S15,6

LABEL_IF2_EXIT
;***************************************************
; Vergleich -> IF3
;***************************************************

	MOVLW HIGH 99
	SUBWF ZV3_HI,W	; F - W -> W

	BTFSS STATUS,ZERO	; Wenn ZERO gesetzt LOW-Byte testen
	GOTO LABEL_IF3_CHECK
	MOVLW LOW 99
	SUBWF ZV3,W	; F - W -> W

LABEL_IF3_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,CARRY	; Test auf -> <=
	GOTO LABEL_IF3_TRUE
	BTFSS STATUS,ZERO
	GOTO LABEL_IF3_FALSE

LABEL_IF3_TRUE
	BSF S15,7
	GOTO LABEL_IF3_EXIT

LABEL_IF3_FALSE
	BCF S15,7

LABEL_IF3_EXIT
;***************************************************
; One Shot -> OS1
;***************************************************


	BTFSS S16,2
	GOTO LABEL_OS1_1
	BTFSC OS1_FD,0
	GOTO LABEL_OS1_1
	BSF OS1_FD,0
	BSF S16,3
	GOTO LABEL_OS1_2
LABEL_OS1_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S16,3
	BTFSC S16,2
	GOTO LABEL_OS1_2
	BCF OS1_FD,0
LABEL_OS1_2
;***************************************************
; One Shot -> OS2
;***************************************************


	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S16,1
	GOTO LABEL_OS2_1
	BTFSC OS2_FD,0
	GOTO LABEL_OS2_1
	BSF OS2_FD,0
	BSF S16,4
	GOTO LABEL_OS2_2
LABEL_OS2_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S16,4
	BTFSC S16,1
	GOTO LABEL_OS2_2
	BCF OS2_FD,0
LABEL_OS2_2
;***************************************************
; One Shot -> OS3
;***************************************************


	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S16,0
	GOTO LABEL_OS3_1
	BTFSC OS3_FD,0
	GOTO LABEL_OS3_1
	BSF OS3_FD,0
	BSF S16,5
	GOTO LABEL_OS3_2
LABEL_OS3_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S16,5
	BTFSC S16,0
	GOTO LABEL_OS3_2
	BCF OS3_FD,0
LABEL_OS3_2
;***************************************************
; ODER - Gatter -> LG4
;***************************************************

LABEL_LG4_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC PORTC,4
	GOTO LABEL_LG4_TRUE

LABEL_LG4_FALSE
	BSF S16,2
	GOTO LABEL_LG4_ENDE
LABEL_LG4_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S16,2
LABEL_LG4_ENDE
;***************************************************
; ODER - Gatter -> LG5
;***************************************************

LABEL_LG5_1
	BTFSC PORTC,5
	GOTO LABEL_LG5_TRUE

LABEL_LG5_FALSE
	BSF S16,1
	GOTO LABEL_LG5_ENDE
LABEL_LG5_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S16,1
LABEL_LG5_ENDE
;***************************************************
; ODER - Gatter -> LG6
;***************************************************

LABEL_LG6_1
	BTFSC PORTC,6
	GOTO LABEL_LG6_TRUE

LABEL_LG6_FALSE
	BSF S16,0
	GOTO LABEL_LG6_ENDE
LABEL_LG6_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S16,0
LABEL_LG6_ENDE
;***************************************************
; ODER - Gatter -> LG7
;***************************************************

LABEL_LG7_1
	BTFSC S17,0
	GOTO LABEL_LG7_TRUE

LABEL_LG7_FALSE
	BSF PORTC,1
	GOTO LABEL_LG7_ENDE
LABEL_LG7_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTC,1
LABEL_LG7_ENDE
;***************************************************
; ODER - Gatter -> LG8
;***************************************************

LABEL_LG8_1
	BTFSC S16,7
	GOTO LABEL_LG8_TRUE

LABEL_LG8_FALSE
	BSF PORTC,2
	GOTO LABEL_LG8_ENDE
LABEL_LG8_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTC,2
LABEL_LG8_ENDE
;***************************************************
; ODER - Gatter -> LG9
;***************************************************

LABEL_LG9_1
	BTFSC S16,6
	GOTO LABEL_LG9_TRUE

LABEL_LG9_FALSE
	BSF PORTC,3
	GOTO LABEL_LG9_ENDE
LABEL_LG9_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF PORTC,3
LABEL_LG9_ENDE
;***************************************************
; EE-Modul -> EE1
;***************************************************


; Test of falling edge

	BTFSC S15,3
	GOTO LABEL_EE1_SETFD
	BTFSS EE1_FD,0
	GOTO LABEL_EE1_SETFD
	BCF EE1_FD,0

	MOVLW HIGH WRITE_EE1
	MOVWF PCLATH

	CALL WRITE_EE1
	MOVLW HIGH LABEL_EE1_SETFD
	MOVWF PCLATH

LABEL_EE1_SETFD

; test input

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S15,3
	GOTO LABEL_EE1_EXIT
	BSF EE1_FD,0

LABEL_EE1_EXIT

;***************************************************
; EE-Modul -> EE2
;***************************************************


; Test of falling edge

	BTFSC S15,2
	GOTO LABEL_EE2_SETFD
	BTFSS EE2_FD,0
	GOTO LABEL_EE2_SETFD
	BCF EE2_FD,0

	MOVLW HIGH WRITE_EE2
	MOVWF PCLATH

	CALL WRITE_EE2
	MOVLW HIGH LABEL_EE2_SETFD
	MOVWF PCLATH

LABEL_EE2_SETFD

; test input

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S15,2
	GOTO LABEL_EE2_EXIT
	BSF EE2_FD,0

LABEL_EE2_EXIT

;***************************************************
; EE-Modul -> EE3
;***************************************************


; Test of falling edge

	BTFSC S15,1
	GOTO LABEL_EE3_SETFD
	BTFSS EE3_FD,0
	GOTO LABEL_EE3_SETFD
	BCF EE3_FD,0

	MOVLW HIGH WRITE_EE3
	MOVWF PCLATH

	CALL WRITE_EE3
	MOVLW HIGH LABEL_EE3_SETFD
	MOVWF PCLATH

LABEL_EE3_SETFD

; test input

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S15,1
	GOTO LABEL_EE3_EXIT
	BSF EE3_FD,0

LABEL_EE3_EXIT

;***************************************************
; LCD -> LT5
;***************************************************

; test of positiv edge

	BTFSC LT5_FD,0
	GOTO LABEL_LT5_SETFD
	BTFSS S17,1
	GOTO LABEL_LT5_SETFD


	MOVLW 2
	MOVWF SYS_TMP1
	MOVLW 1
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW ZV1
	MOVWF SYS_TMP4
	MOVFW ZV1_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 3
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT5_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT5_SETFD2
	BSF LT5_FD,0
	GOTO LABEL_LT5_END
LABEL_LT5_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT5_FD,0
LABEL_LT5_END

;***************************************************
; LCD -> LT6
;***************************************************

; test of positiv edge

	BTFSC LT6_FD,0
	GOTO LABEL_LT6_SETFD
	BTFSS S17,1
	GOTO LABEL_LT6_SETFD


	MOVLW 9
	MOVWF SYS_TMP1
	MOVLW 1
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW ZV2
	MOVWF SYS_TMP4
	MOVFW ZV2_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 3
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT6_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT6_SETFD2
	BSF LT6_FD,0
	GOTO LABEL_LT6_END
LABEL_LT6_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT6_FD,0
LABEL_LT6_END

;***************************************************
; LCD -> LT7
;***************************************************

; test of positiv edge

	BTFSC LT7_FD,0
	GOTO LABEL_LT7_SETFD
	BTFSS S17,1
	GOTO LABEL_LT7_SETFD


	MOVLW 16
	MOVWF SYS_TMP1
	MOVLW 1
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW ZV3
	MOVWF SYS_TMP4
	MOVFW ZV3_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 3
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT7_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT7_SETFD2
	BSF LT7_FD,0
	GOTO LABEL_LT7_END
LABEL_LT7_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT7_FD,0
LABEL_LT7_END

;***************************************************
; Limiter -> LM1
;***************************************************

	BCF S17,2
	BCF S17,3
	MOVFW S4
	MOVWF S1
	MOVFW S4_HI
	MOVWF S1_HI

	MOVLW HIGH 100
	SUBWF S1_HI,W
	BTFSS STATUS,ZERO
	GOTO LABEL_LM1_CHECK1
	MOVLW LOW 100
	SUBWF S1,W
LABEL_LM1_CHECK1
	BTFSS STATUS,CARRY
	GOTO LABEL_LM1_EXIT
	BTFSC STATUS,ZERO
	GOTO LABEL_LM1_EXIT
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S17,2
	MOVLW LOW 100
	MOVWF S1
	MOVLW HIGH 100
	MOVWF S1_HI
LABEL_LM1_EXIT

;***************************************************
;AF3
;***************************************************

	MOVFW S2_HI
	SUBWF S1_HI,W
	MOVWF S3_HI
	MOVFW S2
	SUBWF S1,W
	MOVWF S3
	BTFSS STATUS,CARRY
	DECF S3_HI,F

LABEL_AF3_EXIT
;***************************************************
; LCD -> LT8
;***************************************************

; test of positiv edge

	BTFSC LT8_FD,0
	GOTO LABEL_LT8_SETFD
	BTFSS S17,1
	GOTO LABEL_LT8_SETFD


	MOVLW 3
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S0
	MOVWF SYS_TMP4
	MOVFW S0_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 5
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT8_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT8_SETFD2
	BSF LT8_FD,0
	GOTO LABEL_LT8_END
LABEL_LT8_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT8_FD,0
LABEL_LT8_END

;***************************************************
;AF4
;***************************************************

	MOVFW ADC0
	MOVWF SYS_TMP1
	MOVFW ADC0_HI
	MOVWF SYS_TMP2
	MOVLW LOW 2
	MOVWF SYS_TMP3
	MOVLW HIGH 2
	MOVWF SYS_TMP4
	MOVLW HIGH SYSDIV16
	MOVWF PCLATH
	CALL SYSDIV16
	MOVLW HIGH LABEL_AF4
	MOVWF PCLATH
LABEL_AF4
	MOVFW SYS_TMP5
	MOVWF S4
	MOVFW SYS_TMP6
	MOVWF S4_HI

LABEL_AF4_EXIT
;***************************************************
;AF5
;***************************************************

	MOVFW S6
	MOVWF SYS_TMP1
	MOVFW S6_HI
	MOVWF SYS_TMP2
	MOVLW LOW 10
	MOVWF SYS_TMP3
	MOVLW HIGH 10
	MOVWF SYS_TMP4
	MOVLW HIGH SYSDIV16
	MOVWF PCLATH
	CALL SYSDIV16
	MOVLW HIGH LABEL_AF5
	MOVWF PCLATH
LABEL_AF5
	MOVFW SYS_TMP5
	MOVWF S5
	MOVFW SYS_TMP6
	MOVWF S5_HI

LABEL_AF5_EXIT
;***************************************************
;AF6
;***************************************************

	MOVFW S5
	MOVWF SYS_TMP1
	MOVFW S5_HI
	MOVWF SYS_TMP2
	MOVLW LOW 10
	MOVWF SYS_TMP3
	MOVLW HIGH 10
	MOVWF SYS_TMP4
	MOVLW HIGH SYSMUL16
	MOVWF PCLATH
	CALL SYSMUL16
	MOVLW HIGH LABEL_AF6
	MOVWF PCLATH
LABEL_AF6
	MOVFW SYS_TMP5
	MOVWF S7
	MOVFW SYS_TMP6
	MOVWF S7_HI

LABEL_AF6_EXIT
;***************************************************
; LCD -> LT9
;***************************************************

; test of positiv edge

	BTFSC LT9_FD,0
	GOTO LABEL_LT9_SETFD
	BTFSS S17,1
	GOTO LABEL_LT9_SETFD


	MOVLW 11
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S8
	MOVWF SYS_TMP4
	MOVFW S8_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 5
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT9_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT9_SETFD2
	BSF LT9_FD,0
	GOTO LABEL_LT9_END
LABEL_LT9_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT9_FD,0
LABEL_LT9_END

;***************************************************
; Limiter -> LM2
;***************************************************

	BCF S17,4
	BCF S17,5
	MOVFW S9
	MOVWF S6
	MOVFW S9_HI
	MOVWF S6_HI

	MOVLW HIGH 100
	SUBWF S6_HI,W
	BTFSS STATUS,ZERO
	GOTO LABEL_LM2_CHECK1
	MOVLW LOW 100
	SUBWF S6,W
LABEL_LM2_CHECK1
	BTFSS STATUS,CARRY
	GOTO LABEL_LM2_EXIT
	BTFSC STATUS,ZERO
	GOTO LABEL_LM2_EXIT
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S17,4
	MOVLW LOW 100
	MOVWF S6
	MOVLW HIGH 100
	MOVWF S6_HI
LABEL_LM2_EXIT

;***************************************************
;AF7
;***************************************************

	MOVFW S7_HI
	SUBWF S6_HI,W
	MOVWF S8_HI
	MOVFW S7
	SUBWF S6,W
	MOVWF S8
	BTFSS STATUS,CARRY
	DECF S8_HI,F

LABEL_AF7_EXIT
;***************************************************
; LCD -> LT10
;***************************************************

; test of positiv edge

	BTFSC LT10_FD,0
	GOTO LABEL_LT10_SETFD
	BTFSS S17,1
	GOTO LABEL_LT10_SETFD


	MOVLW 10
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S5
	MOVWF SYS_TMP4
	MOVFW S5_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 5
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT10_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT10_SETFD2
	BSF LT10_FD,0
	GOTO LABEL_LT10_END
LABEL_LT10_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT10_FD,0
LABEL_LT10_END

;***************************************************
;AF8
;***************************************************

	MOVFW ADC1
	MOVWF SYS_TMP1
	MOVFW ADC1_HI
	MOVWF SYS_TMP2
	MOVLW LOW 2
	MOVWF SYS_TMP3
	MOVLW HIGH 2
	MOVWF SYS_TMP4
	MOVLW HIGH SYSDIV16
	MOVWF PCLATH
	CALL SYSDIV16
	MOVLW HIGH LABEL_AF8
	MOVWF PCLATH
LABEL_AF8
	MOVFW SYS_TMP5
	MOVWF S9
	MOVFW SYS_TMP6
	MOVWF S9_HI

LABEL_AF8_EXIT
;***************************************************
;AF9
;***************************************************

	MOVFW S11
	MOVWF SYS_TMP1
	MOVFW S11_HI
	MOVWF SYS_TMP2
	MOVLW LOW 10
	MOVWF SYS_TMP3
	MOVLW HIGH 10
	MOVWF SYS_TMP4
	MOVLW HIGH SYSDIV16
	MOVWF PCLATH
	CALL SYSDIV16
	MOVLW HIGH LABEL_AF9
	MOVWF PCLATH
LABEL_AF9
	MOVFW SYS_TMP5
	MOVWF S10
	MOVFW SYS_TMP6
	MOVWF S10_HI

LABEL_AF9_EXIT
;***************************************************
;AF10
;***************************************************

	MOVFW S10
	MOVWF SYS_TMP1
	MOVFW S10_HI
	MOVWF SYS_TMP2
	MOVLW LOW 10
	MOVWF SYS_TMP3
	MOVLW HIGH 10
	MOVWF SYS_TMP4
	MOVLW HIGH SYSMUL16
	MOVWF PCLATH
	CALL SYSMUL16
	MOVLW HIGH LABEL_AF10
	MOVWF PCLATH
LABEL_AF10
	MOVFW SYS_TMP5
	MOVWF S12
	MOVFW SYS_TMP6
	MOVWF S12_HI

LABEL_AF10_EXIT
;***************************************************
; LCD -> LT11
;***************************************************

; test of positiv edge

	BTFSC LT11_FD,0
	GOTO LABEL_LT11_SETFD
	BTFSS S17,1
	GOTO LABEL_LT11_SETFD


	MOVLW 18
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S13
	MOVWF SYS_TMP4
	MOVFW S13_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 5
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT11_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT11_SETFD2
	BSF LT11_FD,0
	GOTO LABEL_LT11_END
LABEL_LT11_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT11_FD,0
LABEL_LT11_END

;***************************************************
; Limiter -> LM3
;***************************************************

	BCF S17,6
	BCF S17,7
	MOVFW S14
	MOVWF S11
	MOVFW S14_HI
	MOVWF S11_HI

	MOVLW HIGH 100
	SUBWF S11_HI,W
	BTFSS STATUS,ZERO
	GOTO LABEL_LM3_CHECK1
	MOVLW LOW 100
	SUBWF S11,W
LABEL_LM3_CHECK1
	BTFSS STATUS,CARRY
	GOTO LABEL_LM3_EXIT
	BTFSC STATUS,ZERO
	GOTO LABEL_LM3_EXIT
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S17,6
	MOVLW LOW 100
	MOVWF S11
	MOVLW HIGH 100
	MOVWF S11_HI
LABEL_LM3_EXIT

;***************************************************
;AF11
;***************************************************

	MOVFW S12_HI
	SUBWF S11_HI,W
	MOVWF S13_HI
	MOVFW S12
	SUBWF S11,W
	MOVWF S13
	BTFSS STATUS,CARRY
	DECF S13_HI,F

LABEL_AF11_EXIT
;***************************************************
; LCD -> LT12
;***************************************************

; test of positiv edge

	BTFSC LT12_FD,0
	GOTO LABEL_LT12_SETFD
	BTFSS S17,1
	GOTO LABEL_LT12_SETFD


	MOVLW 17
	MOVWF SYS_TMP1
	MOVLW 0
	MOVWF SYS_TMP2

	MOVLW HIGH LCD_LB1_GOTOXY	; set page
	MOVWF PCLATH
	CALL LCD_LB1_GOTOXY

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW S10
	MOVWF SYS_TMP4
	MOVFW S10_HI
	MOVWF SYS_TMP5

	BCF SYS_TMP10,0
	MOVLW 5
	MOVWF SYS_TMP9
	MOVLW HIGH LCD_LB1_DEZO10000	; set page
	MOVWF PCLATH
	CALL LCD_LB1_DEZO10000
	BCF PCLATH,3	; Page 0
	BCF PCLATH,4	; Page 0
LABEL_LT12_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S17,1
	GOTO LABEL_LT12_SETFD2
	BSF LT12_FD,0
	GOTO LABEL_LT12_END
LABEL_LT12_SETFD2
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF LT12_FD,0
LABEL_LT12_END

;***************************************************
;AF12
;***************************************************

	MOVFW ADC2
	MOVWF SYS_TMP1
	MOVFW ADC2_HI
	MOVWF SYS_TMP2
	MOVLW LOW 2
	MOVWF SYS_TMP3
	MOVLW HIGH 2
	MOVWF SYS_TMP4
	MOVLW HIGH SYSDIV16
	MOVWF PCLATH
	CALL SYSDIV16
	MOVLW HIGH LABEL_AF12
	MOVWF PCLATH
LABEL_AF12
	MOVFW SYS_TMP5
	MOVWF S14
	MOVFW SYS_TMP6
	MOVWF S14_HI

LABEL_AF12_EXIT
;***************************************************
; Timer -> TR2
;***************************************************

	MOVLW 0	; Test auf >=
	SUBWF TR2_HI,W	;F-W -> W
	BTFSS STATUS,ZERO
	GOTO LABEL_TR2_CHECK
	MOVLW 8
	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 8
	SUBWF TR2,F	;F-W -> F
	BTFSS STATUS,CARRY
	DECF TR2_HI,F

LABEL_TR2_SET	; toggel output
	BTFSC S17,1
	GOTO LABEL_TR2_CLR
	BSF S17,1
	GOTO LABEL_TR2_ENDE
LABEL_TR2_CLR
	BCF S17,1
LABEL_TR2_ENDE

;****************************************

	GOTO MAIN




TAB_LT2
	RETLW 49	; 1
	RETLW 58	; :
	RETLW 0	; end


TAB_LT3
	RETLW 50	; 2
	RETLW 58	; :
	RETLW 0	; end


TAB_LT4
	RETLW 51	; 3
	RETLW 58	; :
	RETLW 0	; end

















	ORG H'2100'

	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
	DE 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0

	END

