; Source created with Parsic Version 3.x

; at              : 2009.06.06. 15:20:10


; Project File    : C:\PICPROG\sebfut.PIC

; Project Version : 1.0.23

; Created         : 2009.06.04. 17:28:00

; Last change     : 2009.06.06. 15:17:56

	PROCESSOR 16F628A

	INCLUDE P16F628A.INC

	RADIX DEC


	__IDLOCS H'0100'

	__CONFIG _CP_OFF & _PWRTE_OFF & _WDT_OFF & _BODEN_OFF & _INTRC_OSC_NOCLKOUT & _LVP_OFF & _MCLRE_ON

; Diverses

ZERO	EQU Z	; ZERO-Flag
CARRY	 EQU C	; CARRY-Flag


; Variable

ZV3	= 32	; located in Bank 0
ZV3_FD	= 33	; located in Bank 0
ZV3_HI	= 34	; located in Bank 0
EE1_FD	= 35	; located in Bank 0
ZV1	= 36	; located in Bank 0
ZV1_FD	= 37	; located in Bank 0
S1	= 38	; located in Bank 0
S0	= 39	; located in Bank 0
TR1	= 40	; located in Bank 0
TR1_HI	= 41	; located in Bank 0
ZV2	= 42	; located in Bank 0
ZV2_HI	= 43	; located in Bank 0
ZV2_FD	= 44	; located in Bank 0
OS1_FD	= 45	; located in Bank 0
MF1	= 46	; located in Bank 0
MF1_HI	= 47	; located in Bank 0
MF1_FD	= 48	; located in Bank 0
S2	= 49	; located in Bank 0
RAM	= 50	; located in Bank 0
SYS_TMP1	= 112	; located in Bank 0, 1, 2, 3
SYS_TMP2	= 113	; located in Bank 0, 1, 2, 3
SYS_WSAV	= 114	; located in Bank 0, 1, 2, 3
SYS_SSAV	= 115	; 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

	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 MF1,F
	GOTO SYS_INT_LABEL_1
	INCF MF1_HI,F

SYS_INT_LABEL_1

EXITINT

	SWAPF SYS_SSAV,W	; Register zurück
	MOVWF STATUS
	SWAPF SYS_WSAV,F
	SWAPF SYS_WSAV,W

	RETFIE


;****************************************
; Subroutines
;****************************************

;****************************************
; Direct jump into a table
;****************************************

SYSTABJMP
	BCF INTCON,GIE
	BTFSC INTCON,GIE
	GOTO SYSTABJMP
	MOVFW SYS_TMP2
	MOVWF PCLATH
	MOVFW SYS_TMP1
	MOVWF PCL

EEINT_WRITE
	MOVFW INDF
EEINT_WRITE_0
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	MOVWF EEDATA
	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

	INCF EEADR,F
	INCF FSR,F
	DECFSZ SYS_TMP1,F
	GOTO EEINT_WRITE

	RETURN

;***************************************************

EEINT_READ
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF EECON1,RD
	MOVFW EEDATA
	MOVWF INDF
	INCF EEADR,F
	INCF FSR,F
	DECFSZ SYS_TMP1,F
	GOTO EEINT_READ
	RETURN

;***************************************************
; EE-Modul -> EE1
;***************************************************

WRITE_EE1
	MOVLW 0
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	MOVWF EEADR

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 3
	MOVWF SYS_TMP1
	MOVLW LOW ZV3
	MOVWF FSR

	CALL EEINT_WRITE


	RETURN

;***************************************************
; EE-Modul -> EE1
;***************************************************

READ_EE1
	MOVLW 0
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	MOVWF EEADR

	BCF STATUS,IRP	; vars - located in Bank 0
	MOVLW 3
	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 143
	BSF STATUS,RP0	; Bank 1
	MOVWF OPTION_REG


; Richtung setzen

	MOVLW B'11111111'
	MOVWF TRISA

	MOVLW B'11100000'
	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



	CALL READ_EE1	; 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

;***************************************************
; Zähler -> ZV1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S1,1	; Reset ?
	GOTO LABEL_ZV1_COUNT
	CLRF ZV1
	GOTO LABEL_ZV1_SETOUT

LABEL_ZV1_COUNT

; Test auf positive Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S1,6
	GOTO LABEL_ZV1_SETFD
	BTFSC ZV1_FD,0
	GOTO LABEL_ZV1_SETFD

	BSF ZV1_FD,0


	BTFSC S1,0	; Vorwärts oder Rückwärts ?
	GOTO LABEL_ZV1_BACKWARD

	INCF ZV1,F
	GOTO LABEL_ZV1_SETOUT

LABEL_ZV1_BACKWARD
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	DECF ZV1,F

LABEL_ZV1_SETOUT


LABEL_ZV1_SETFD

; Test auf negative Flanke

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S1,6
	GOTO LABEL_ZV1_EXIT
	BCF ZV1_FD,0

LABEL_ZV1_EXIT

;***************************************************
; Schmitt-Trigger 8-Bit -> ST1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S1,1	; Ausgang gesetzt ?
	GOTO LABEL_ST1_MH	; dann mit Hysterese ?

	MOVLW 5
	GOTO LABEL_ST1_TEST

LABEL_ST1_MH

	MOVLW 5
LABEL_ST1_TEST

	SUBWF ZV1,W
	BTFSS STATUS,CARRY
	GOTO LABEL_ST1_RESET

	BSF S1,1	; if greater or equal
	GOTO LABEL_ST1_ENDE

LABEL_ST1_RESET
	BCF S1,1	; if less
LABEL_ST1_ENDE

;***************************************************
; Call subroutine TAB
;***************************************************


	MOVLW LOW TAB
	MOVWF SYS_TMP1
	MOVLW HIGH TAB
	MOVWF SYS_TMP2

	MOVFW ZV1
	ADDWF SYS_TMP1,F
	BTFSC STATUS,CARRY
	INCF SYS_TMP2,F

	CALL SYSTABJMP

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVWF S0

	BSF INTCON,GIE
;***************************************************
; Verteiler -> BV1
;***************************************************

	BTFSC S0,0
	GOTO LABEL_BV1_0
	BCF PORTB,0
	GOTO LABEL_BV1_0_END
LABEL_BV1_0
	BSF PORTB,0
LABEL_BV1_0_END

;**********************************************

	BTFSC S0,1
	GOTO LABEL_BV1_1
	BCF PORTB,1
	GOTO LABEL_BV1_1_END
LABEL_BV1_1
	BSF PORTB,1
LABEL_BV1_1_END

;**********************************************

	BTFSC S0,2
	GOTO LABEL_BV1_2
	BCF PORTB,2
	GOTO LABEL_BV1_2_END
LABEL_BV1_2
	BSF PORTB,2
LABEL_BV1_2_END

;**********************************************

	BTFSC S0,3
	GOTO LABEL_BV1_3
	BCF PORTB,3
	GOTO LABEL_BV1_3_END
LABEL_BV1_3
	BSF PORTB,3
LABEL_BV1_3_END

;**********************************************

	BTFSC S0,4
	GOTO LABEL_BV1_4
	BCF PORTB,4
	GOTO LABEL_BV1_4_END
LABEL_BV1_4
	BSF PORTB,4
LABEL_BV1_4_END

;**********************************************


;***************************************************
; RS-FLIP-FLOP -> RS1
;***************************************************

	BTFSC PORTB,0
	GOTO LABEL_RS1_RESET
	BTFSS PORTB,4
	GOTO LABEL_RS1_ENDE
	BSF S1,0	; Ausgang setzen
	GOTO LABEL_RS1_ENDE
LABEL_RS1_RESET
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,0	; Ausgang zurücksetzen
LABEL_RS1_ENDE

;***************************************************
; 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 98
	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 98
	SUBWF TR1,F	;F-W -> F
	BTFSS STATUS,CARRY
	DECF TR1_HI,F

LABEL_TR1_SET	; toggel output
	BTFSC S1,2
	GOTO LABEL_TR1_CLR
	BSF S1,2
	GOTO LABEL_TR1_ENDE
LABEL_TR1_CLR
	BCF S1,2
LABEL_TR1_ENDE

;***************************************************
; Zähler -> ZV2
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S1,7	; 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 S1,2
	GOTO LABEL_ZV2_SETFD
	BTFSC ZV2_FD,0
	GOTO LABEL_ZV2_SETFD

	BSF ZV2_FD,0


	BTFSC S1,3	; 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 S1,2
	GOTO LABEL_ZV2_EXIT
	BCF ZV2_FD,0

LABEL_ZV2_EXIT

;***************************************************
; GND
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,3	; immer Low

;***************************************************
; One Shot -> OS1
;***************************************************


	BTFSS PORTA,0
	GOTO LABEL_OS1_1
	BTFSC OS1_FD,0
	GOTO LABEL_OS1_1
	BSF OS1_FD,0
	BSF S1,4
	GOTO LABEL_OS1_2
LABEL_OS1_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,4
	BTFSC PORTA,0
	GOTO LABEL_OS1_2
	BCF OS1_FD,0
LABEL_OS1_2
;***************************************************
; Zähler -> ZV3
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S2,1	; 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 S1,4
	GOTO LABEL_ZV3_SETFD
	BTFSC ZV3_FD,0
	GOTO LABEL_ZV3_SETFD

	BSF ZV3_FD,0


	BTFSC S1,5	; 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 S1,4
	GOTO LABEL_ZV3_EXIT
	BCF ZV3_FD,0

LABEL_ZV3_EXIT

;***************************************************
; GND
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S1,5	; immer Low

;***************************************************
; Schmitt-Trigger 16-Bit -> ST2
;***************************************************

	MOVFW ZV3
	MOVWF SYS_TMP1
	MOVFW ZV3_HI
	MOVWF SYS_TMP2

	BTFSS S1,7	; Ausgang gesetzt ?
	GOTO LABEL_ST2_TEST	; without Hysterese

	MOVLW HIGH 0
	SUBWF SYS_TMP2,F
	MOVLW LOW 0
	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 ZV2_HI,W

	BTFSS STATUS,ZERO
	GOTO LABEL_ST2_TEST2

	MOVFW SYS_TMP1
	SUBWF ZV2,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 S1,7	; if greater or equal
	GOTO LABEL_ST2_ENDE

LABEL_ST2_RESET
	BCF S1,7	; if less
LABEL_ST2_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 S2,0
	GOTO LABEL_MF1_SETFD


LABEL_MF1_RESET

	CLRF MF1
	CLRF MF1_HI
	BSF MF1_FD,1
	BSF S1,6

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 78
	SUBWF MF1,W
LABEL_MF1_CHECK
	BTFSS STATUS,CARRY
	GOTO LABEL_MF1_SETFD
LABEL_MF1_TO

	BCF MF1_FD,1
	BCF S1,6

LABEL_MF1_SETFD

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S2,0
	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

;***************************************************
; ODER - Gatter -> LG1
;***************************************************

LABEL_LG1_1
	BTFSC S1,7
	GOTO LABEL_LG1_TRUE

LABEL_LG1_FALSE
	BCF S2,0
	GOTO LABEL_LG1_ENDE
LABEL_LG1_TRUE
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF S2,0
LABEL_LG1_ENDE
;***************************************************
; EE-Modul -> EE1
;***************************************************


; Test of rising edge

	BTFSS S1,4
	GOTO LABEL_EE1_SETFD
	BTFSC EE1_FD,0
	GOTO LABEL_EE1_SETFD
	BSF EE1_FD,0


	CALL WRITE_EE1

LABEL_EE1_SETFD

; test input

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S1,4
	GOTO LABEL_EE1_EXIT
	BCF EE1_FD,0

LABEL_EE1_EXIT

;***************************************************
; Vergleich -> IF1
;***************************************************

	MOVLW 6
	SUBWF ZV3,W	; F - W -> W

LABEL_IF1_CHECK
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS STATUS,ZERO	; Test auf -> =
	GOTO LABEL_IF1_FALSE

LABEL_IF1_TRUE
	BSF S2,1
	GOTO LABEL_IF1_EXIT

LABEL_IF1_FALSE
	BCF S2,1

LABEL_IF1_EXIT
;****************************************

	GOTO MAIN

;***************************************************
; Table -> TAB
;***************************************************

TAB

	RETLW 1	; // INDEX 0
	RETLW 2	; // INDEX 1
	RETLW 4	; // INDEX 2
	RETLW 8	; // INDEX 3
	RETLW 16	; // INDEX 4
	RETLW 32	; // INDEX 5
	RETLW 64	; // INDEX 6
	RETLW 128	; // INDEX 7

	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

	END

