DEVICE 16F628A                ;We gebruiken een 16F628A type
CONFIG INTRC_OSC_NOCLKOUT, WDT_OFF, PWRTE_ON, LVP_OFF, MCLRE_OFF
ALL_DIGITAL TRUE              ;Alle ingangen digitaal

DIM Servo1 as byte
dim servo2 as byte
Dim teller as byte
dim Teller1 as byte
Symbol Kniptijd1 = 350
Symbol Remtijd1 = 500

Main:
;|||||||||||||||||||||||Knipperlicht||||||||||||||||||||||

For teller = 0 to 50

    if teller = 35 then
        goto eind
    endif

    Servo1 = Pulsin Portb.1 , 1    ;Servo 1 inlezen
    Servo2 = Pulsin portb.2 , 1    ;Servo 2 inlezen

        if servo1 > 121 and servo1 < 179 then
            low portb.3
            low portb.4
        endif

        If servo1 < 120 Then
            toggle portb.3 ;Knipperlicht 1
            delayms 100
        Endif

        If servo1 > 180 Then
            toggle portb.4 ;Knipperlicht 2
            delayms 100
        endif

    if servo2 < 140 then
        high portb.5
    endif

next

Goto main

Eind:
        low portb.3
        low portb.4
        low portb.5
        low portb.6
        teller = 0

goto main

END