

	PROCESSOR 16F628

	INCLUDE P16F628.INC

	RADIX DEC


	__IDLOCS H'0100'

	__CONFIG _CP_OFF & _PWRTE_OFF & _WDT_OFF & _BODEN_OFF & _XT_OSC & _LVP_OFF & _MCLRE_OFF

; Diverses

ZERO	EQU Z	; ZERO-Flag
CARRY	 EQU C	; CARRY-Flag


; Variable

UD1_FD	= 32	; located in Bank 0
S0	= 33	; located in Bank 0
UD2_FD	= 34	; located in Bank 0
UA1RSFLAG	= 35	; located in Bank 0
TR1	= 36	; located in Bank 0
TR1_HI	= 37	; located in Bank 0
MF1	= 38	; located in Bank 0
MF1_HI	= 39	; located in Bank 0
VEVO	= 40	; located in Bank 0
UA1OUTBUF	= 41	; located in Bank 0
UA1OUTBUF1	= 42	; located in Bank 0
UA1OUTBUF2	= 43	; located in Bank 0
UA1OUTBUF3	= 44	; located in Bank 0
UA1INBUF	= 45	; located in Bank 0
UA1INBUF1	= 46	; located in Bank 0
UA1INBUF2	= 47	; located in Bank 0
UA1INBUF3	= 48	; located in Bank 0
UA1INBUF4	= 49	; located in Bank 0
RAM	= 50	; located in Bank 0
SYS_WSAV	= 112	; located in Bank 0, 1, 2, 3
SYS_SSAV	= 113	; 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

;***************************************************
; UART -> UA1
;***************************************************

	BSF STATUS,RP0	; Bank 1
	BTFSS PIR1,RCIF	; byte received?
	GOTO UA1CHKTX	; no

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVFW RCSTA	; error ?
	ANDLW B'110'
	BTFSS STATUS,ZERO
	GOTO UA1RCERROR	; yes

	MOVFW UA1INBUF+1	; all received ? 
	BTFSC STATUS,ZERO	; length =0 ?
	GOTO UA1RCINT2	; yes

	ERRORLEVEL -312
	BANKISEL UA1INBUF
	ERRORLEVEL +312

	MOVFW UA1INBUF
	MOVWF FSR
	INCF UA1INBUF,F	; pointer+1

	MOVFW RCREG	; store
	MOVWF INDF
	ADDWF UA1INBUF+2,F	; checksum
	DECFSZ UA1INBUF+1,F	; length-1
	GOTO EXITINT

	SUBWF UA1INBUF+2,F	; checksum
	BSF UA1RSFLAG,0		; ready
	GOTO EXITINT

UA1RCINT2
	MOVFW RCREG	; trash
	GOTO EXITINT

UA1RCERROR
	MOVFW RCREG	; reset error status
	BCF RCSTA,CREN
	BSF RCSTA,CREN
	BSF UA1RSFLAG,1	; error
	GOTO EXITINT

;---------------------------------------------------------

UA1CHKTX
	BTFSS PIR1,TXIF	; send byte ?
	GOTO UA1ENDINT	; no

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW UA1OUTBUF+1	; all transmitted ? 
	BTFSC STATUS,ZERO
	GOTO UA1TXINT1

	ERRORLEVEL -312
	BANKISEL UA1OUTBUF	; FILE INDIREKT
	ERRORLEVEL +312

	MOVFW UA1OUTBUF	; pointer
	INCF UA1OUTBUF,F	; pointer+1
	MOVWF FSR
	MOVFW INDF	; data
	BSF STATUS,RP1	; Bank 2
	MOVWF TXREG	; Transmit Register

	DECF UA1OUTBUF+1,F	; length-1
	GOTO EXITINT	; that's all

UA1TXINT1
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BTFSS TXSTA,TRMT	; last byte transmitted ?
	GOTO EXITINT	; no

	BCF TXSTA,TXEN	; transmitter off

	BSF UA1RSFLAG,2	; ready
	GOTO EXITINT

UA1ENDINT
	BCF INTCON,T0IF	; Interrupt quitieren

	INCFSZ TR1,F
	GOTO SYS_INT_LABEL_0
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	INCF TR1_HI,F

SYS_INT_LABEL_0
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BSF STATUS,RP0	; Bank 1
	INCFSZ MF1,F
	GOTO SYS_INT_LABEL_1
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	INCF MF1_HI,F

SYS_INT_LABEL_1
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0

EXITINT

	SWAPF SYS_SSAV,W	; Register zurück
	MOVWF STATUS
	SWAPF SYS_WSAV,F
	SWAPF SYS_WSAV,W

	RETURN


;****************************************
; 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'00000000'
	MOVWF TRISA

	MOVLW B'11111011'
	MOVWF TRISB

	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


;*****************************************
; initalisize UA1
;*****************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVLW B'10010000'	; serial enable,8-bit,continous-enable
	MOVWF RCSTA

	BSF STATUS,RP1	; Bank 2
	MOVLW 25
	MOVWF SPBRG	; BAUDRATE GENERATOR
	MOVLW B'00000100'	; 8-BIt,TRANSMIT DISABLED,ASYNCHRON,BRGH=1=HIGH SPEED
	MOVWF TXSTA
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PIE1,TXIE	; enable INTERRUPT for transmit
	BSF PIE1,RCIE	; enable INTERRUPT for receive

	BSF INTCON,PEIE	; PERIPHERIE INT ENABLE

	CLRF TMR0
	BCF INTCON,T0IF
	BSF INTCON,GIE	; Interrupt freigeben

;**********************************
;******* Haupt-Programm ***********
;**********************************

MAIN

;***************************************************
; UDATA -> UD1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,1	; active
	GOTO LABEL_UD1_1	; yes

; test positive edge

	BSF STATUS,RP0	; Bank 1
	BTFSS S0,0
	GOTO LABEL_UD1_SETFD
	BTFSC UD1_FD,0
	GOTO LABEL_UD1_SETFD
	BSF UD1_FD,0

	BCF UA1RSFLAG,2		; set not ready
	BSF S0,1	; active

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVLW LOW UA1OUTBUF+2	; set pointer (ADRESS)
	MOVWF UA1OUTBUF
	MOVLW H'AA'	; init checksum
	MOVWF UA1OUTBUF+3
	MOVLW 2	; 2 bytes
	MOVWF UA1OUTBUF+1
	BCF INTCON,GIE	; disable interrupts
	BTFSC INTCON,GIE	; disabled ?
	GOTO $-2	; no
	MOVFW VEVO
	MOVWF UA1OUTBUF+2
	ADDWF UA1OUTBUF+3,F
	BSF TXSTA,TXEN
	BSF INTCON,GIE	; enable interrupts
LABEL_UD1_1
	BTFSS UA1RSFLAG,2	; transmit ready ?
	GOTO LABEL_UD1_2	; no
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S0,1	; not active

LABEL_UD1_2

LABEL_UD1_SETFD

; test negative edge

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,0
	GOTO LABEL_UD1_EXIT
	BCF UD1_FD,0

LABEL_UD1_EXIT

;***************************************************
; UDATA -> UD2
;***************************************************

	BSF STATUS,RP0	; Bank 1
	BTFSC S0,3	; active
	GOTO LABEL_UD2_1	; yes

; test positive edge

	BTFSS S0,2
	GOTO LABEL_UD2_SETFD
	BTFSC UD2_FD,0
	GOTO LABEL_UD2_SETFD
	BSF UD2_FD,0
	BCF UA1RSFLAG,0	; set nothing received
	BCF UA1RSFLAG,1	; set no error
	BSF S0,3	; active
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	MOVLW LOW UA1INBUF+3	; set pointer (adress)
	MOVWF UA1INBUF
	MOVLW H'AA'	; init checksum
	MOVWF UA1INBUF+2
	MOVLW 2	; 2 bytes
	MOVWF UA1INBUF+1
	GOTO LABEL_UD2_SETFD
LABEL_UD2_1
	BTFSC UA1RSFLAG,1	; error ?
	GOTO LABEL_UD2_3	; break
	BTFSS UA1RSFLAG,0	; received ?
	GOTO LABEL_UD2_2	; no

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	MOVFW UA1INBUF+2	; checksum
	SUBWF UA1INBUF+4,W	; checksum
	BTFSS STATUS,ZERO
	GOTO LABEL_UD2_3	; break
	BCF INTCON,GIE	; disable interrupts
	BTFSC INTCON,GIE	; disabled ?
	GOTO $-2	; no
	BSF STATUS,RP1	; Bank 2
	MOVFW UA1INBUF+3
	MOVWF VEVO
	BSF INTCON,GIE	; enable interrupts
LABEL_UD2_3
	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BCF S0,3	; not active
LABEL_UD2_2

LABEL_UD2_SETFD

; test negative edge

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,2
	GOTO LABEL_UD2_EXIT
	BCF UD2_FD,0

LABEL_UD2_EXIT

;***************************************************
; Timer -> TR1
;***************************************************

	MOVLW 0	; Test auf >=
	BSF STATUS,RP0	; Bank 1
	SUBWF TR1_HI,W	;F-W -> W
	BTFSS STATUS,ZERO
	GOTO LABEL_TR1_CHECK
	MOVLW 39
	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 39
	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

;***************************************************
; Anzug-Verzögerung -> MF1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSS S0,3	; Eingang auf Low ?
	GOTO LABEL_MF1_CHKTIME	; Ja

; RESET

	BSF STATUS,RP0	; Bank 1
	CLRF MF1
	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	CLRF MF1_HI
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF S0,2
	GOTO LABEL_MF1_EXIT	; raus

LABEL_MF1_CHKTIME

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC S0,2	; Ausgang schon auf High ?
	GOTO LABEL_MF1_EXIT	; Ja

	MOVLW 0
	BSF STATUS,RP1	; Bank 2
	SUBWF MF1_HI,W
	BTFSS STATUS,CARRY
	GOTO LABEL_MF1_EXIT

	MOVLW 78
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	SUBWF MF1,W
	BTFSS STATUS,CARRY
	GOTO LABEL_MF1_EXIT

	BSF S0,2
LABEL_MF1_EXIT

;***************************************************
; Verteiler -> BV1
;***************************************************

	BCF STATUS,RP0	; Bank 0
	BCF STATUS,RP1	; Bank 0
	BTFSC VEVO,0
	GOTO LABEL_BV1_0
	BSF STATUS,RP0	; Bank 1
	BCF PORTA,0
	GOTO LABEL_BV1_0_END
LABEL_BV1_0
	BSF STATUS,RP0	; Bank 1
	BSF PORTA,0
LABEL_BV1_0_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,1
	GOTO LABEL_BV1_1
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,1
	GOTO LABEL_BV1_1_END
LABEL_BV1_1
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,1
LABEL_BV1_1_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,2
	GOTO LABEL_BV1_2
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,2
	GOTO LABEL_BV1_2_END
LABEL_BV1_2
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,2
LABEL_BV1_2_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,3
	GOTO LABEL_BV1_3
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,3
	GOTO LABEL_BV1_3_END
LABEL_BV1_3
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,3
LABEL_BV1_3_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,4
	GOTO LABEL_BV1_4
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,4
	GOTO LABEL_BV1_4_END
LABEL_BV1_4
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,4
LABEL_BV1_4_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,5
	GOTO LABEL_BV1_5
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,5
	GOTO LABEL_BV1_5_END
LABEL_BV1_5
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,5
LABEL_BV1_5_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,6
	GOTO LABEL_BV1_6
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,6
	GOTO LABEL_BV1_6_END
LABEL_BV1_6
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,6
LABEL_BV1_6_END

;**********************************************

	BCF STATUS,RP0	; Bank 2
	BSF STATUS,RP1	; Bank 2
	BTFSC VEVO,7
	GOTO LABEL_BV1_7
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BCF PORTA,7
	GOTO LABEL_BV1_7_END
LABEL_BV1_7
	BSF STATUS,RP0	; Bank 1
	BCF STATUS,RP1	; Bank 1
	BSF PORTA,7
LABEL_BV1_7_END

;**********************************************


;****************************************

	GOTO MAIN


	END

