Urenteller + toerenteller mbv 16F628A

Ik heb de code werkend voor alleen een urenteller en alleen een toerenteller. Nu wil ik dit combineren, m.a.w. code samenvoegen en in de PIC zetten zodat ik voor mn motor een urenteller heb en ook een toerenteller. Nou krijg ik het niet echt lekker voor elkaar dus als iemand mij een stukje op weg kan helpen.
hierbij mijn samengestelde code:

Device 16F628A ;Gebruik een 16F628A type
Config XT_OSC, WDT_OFF, PWRTE_ON, LVP_OFF, MCLRE_OFF
ALL_DIGITAL TRUE ;Alle ingangen digitaal
XTAL 4 ;Kristal van 4MHz
;EEPROM adresnamen
Symbol EE_Teller = 0 ;Adres 0 van de EEPROM bevat de tellerstand
; adresnaam spanningsdetektie
Symbol noPower = PORTA.1 ;pin 20
;Variabelen declareren
Dim Teller As Word ;Deze variabele bevat de tellerwaarde
Dim VAR1 As Word
Dim VAR2 As Word
Dim TPL As Word
Dim Toeren As Float
Symbol LED = PORTA.0 ;pin 19
;eeprom waardo op nul zetten
EData 0
;start programma
Cls ;Display allereerste keer wissen
Clear
DelayMS 500 ;LCD stabilisering
;Hoofdprogramma
Print At 2,5, " Min In Use"
Teller = ERead EE_Teller ;Lees EEPROM met adres 'EE_Teller' en geef waarde aan 'Teller'
; code voor toerenteller
VAR1 = PulsIn PORTB.0,0 ;pin 7
VAR2 = PulsIn PORTB.0,1
TPL=Var1+Var2
If TPL=0 Then
Print At 1,1, "RpM: "
EndIf
Toeren = 6000000/TPL
Print At 1,1, "RpM:", Dec Toeren , " "
If Toeren >= 3250 Then High LED ;shiftlight aanzetten KTM 560 SMR
If Toeren <= 3250 Then Low LED
;teller loop
While 1 = 1
Inc Teller ;Ophogen van de waarde van teller met 1
Print At 2,1, DEC3 (Teller/60) ;De waarde in uren op het display zetten
DelayMS 60000 ;Een minuut wachten, anders gaat alles zo snel
GoSub spanningweg ;check even of er nog spanning aanwezig is
Wend
spanningweg:
;Controleren op voedingsspanning
If noPower = 1 Then
EWrite EE_Teller, [Teller]
DelayMS 20
EndIf
Return
End