picbasic code optimaliseren

Device 16F877A 
'Config WDT_Off, PWRTE_Off, XT_OSC, LVP_off
Config WDT_OFF, PWRTE_Off, XT_OSC, LVP_OFF, CP_OFF, DEBUG_OFF, WRT_OFF, CPD_OFF, BODEN_ON

PORTB_PULLUPS On

XTAL 4 
ADIN_RES = 10 ;ADC resolutie
ADIN_TAD = FRC ;de clock voor de adc extern / intern
ADIN_STIME = 50;De conversie tijd
ALL_DIGITAL = True

Symbol EN1         = PORTC.7          ;Uitgang voor LCD Enable 1
Symbol EN2         = PORTD.5          ;Uitgang voor LCD Enable 2
Symbol dq          = PORTD.0          ; inlees poort ds1820
Symbol R0K         = PORTD.2          ; lm317 res to ground
Symbol R5K         = PORTD.3          ; lm317 res to ground
Symbol R1K         = PORTC.4          ; lm317 res to ground

        ;76543210
TRISA = %01000000
ADCON1= %11000001 ;adc instellen op de goede poorten
Print $FE,$40,$0E,$0A,$0E,$00,$00,$00,$00,$00                '' voor graden symbool

Clear
Cls

;Variabele declareren
Dim Waarde As Float
Dim VAR1 As Word
Dim VAR2 As Word
Dim TPL As Word
Dim Rpm As Float
Dim Rpm1 As Word
Dim Temp As Word              ' Holds the temperature value 
Dim C As Byte                 ' Holds the counts remaining value 
Dim CPerD As Byte             ' Holds the Counts per degree C value

Hoofdprogramma: 


;; TEMPERATURE MEASUREMENT
    
    OWrite dq, 1, [$CC, $44]      ' Send Calculate Temperature command 
    Repeat '
    ORead dq, 4, [C]              ' Keep reading low pulses until
    Until C <> 0                  ' the DS1820 is finished.
    OWrite dq, 1, [$CC, $BE]      ' Send Read ScratchPad command
    ORead dq, 2,[Temp.LowByte,Temp.HighByte, C, C, C, C, C, CPerD]
  ' Calculate the temperature in degrees Centigrade
    Temp = (((Temp >> 1) * 100) - 25) + (((CPerD - C) * 100) / CPerD)
 
;; FAN SPEED
    If  Temp < 3000  Then GoSub SPEED0
    If  Temp > 3000  Then GoSub SPEED1
    If  Temp > 4000  Then GoSub SPEED2
    If  Temp > 5000  Then GoSub SPEED3
  
    
 
; RPM MEASUREMENT
    VAR1 = PulsIn PORTC.5 , 0  
    VAR2 = PulsIn PORTC.5 , 1  
    TPL = (VAR1 * 2) + (VAR2 * 2)
    Rpm = 6000000/TPL 
    Rpm1 = Rpm
    If  TPL < 100  Then Rpm1=0

;; ADC uitlezen
    Waarde = ADIn 6
    Waarde = (Waarde * 5) / 341

 
;; Print op LCD
    GoSub Derde
    Print At 1, 1, "Heatsink Temp: ",  Dec Temp / 100, ".", DEC1 Temp," ", 0,"C " ;Zet tekst op regel 1  
    Print At 2,1, "Fan Speed:   ",  Dec Rpm1, " rpm       " 
    GoSub Eerste
    Print At 1,1, "Vout: ",DEC2 Waarde, " V " 

    GoTo Hoofdprogramma           ;Doe het voorbeeld steeds weer opnieuw

Derde:

    High EN1                             ;geef regel 1 en 2 vrij
    Low EN2                              ;blokkeer regel 3 en 4
    Return
 
Eerste:

    Low EN1                              ;blokkeer regel 1 en 2
    High EN2                             ;geef regel 3 en 4 vrij
    Return

SPEED0:

    DelayMS 1
    High R0K 
    High R5K 
    High R1K 
    DelayMS 1
    Return

SPEED1:

    DelayMS 1
    Low R0K 
    Low R5K 
    High R1K             
    DelayMS 1
    Return

SPEED2:

    DelayMS 1
    Low R0K 
    High R5K 
    Low R1K                 
    DelayMS 1
    Return

SPEED3:

    DelayMS 1
    Low R0K 
    Low R5K 
    Low R1K                 
    DelayMS 1
    Return

End